12 #include <netinet/in.h>
13 #include <arpa/inet.h>
18 #include "crc/crc16.h"
20 int fio_net_port = 8765;
25 static unsigned int job_cur_len;
26 static unsigned int job_max_len;
30 int fio_send_data(int sk, const void *p, unsigned int len)
33 int ret = send(sk, p, len, 0);
43 else if (errno == EAGAIN || errno == EINTR)
45 } while (!exit_backend);
53 int fio_recv_data(int sk, void *p, unsigned int len)
56 int ret = recv(sk, p, len, MSG_WAITALL);
66 else if (errno == EAGAIN || errno == EINTR)
68 } while (!exit_backend);
76 static int verify_convert_cmd(struct fio_net_cmd *cmd)
80 cmd->cmd_crc16 = le16_to_cpu(cmd->cmd_crc16);
81 cmd->pdu_crc16 = le16_to_cpu(cmd->pdu_crc16);
83 crc = crc16(cmd, FIO_NET_CMD_CRC_SZ);
84 if (crc != cmd->cmd_crc16) {
85 log_err("fio: server bad crc on command (got %x, wanted %x)\n",
90 cmd->version = le16_to_cpu(cmd->version);
91 cmd->opcode = le16_to_cpu(cmd->opcode);
92 cmd->flags = le32_to_cpu(cmd->flags);
93 cmd->serial = le64_to_cpu(cmd->serial);
94 cmd->pdu_len = le32_to_cpu(cmd->pdu_len);
96 switch (cmd->version) {
100 log_err("fio: bad server cmd version %d\n", cmd->version);
104 if (cmd->pdu_len > FIO_SERVER_MAX_PDU) {
105 log_err("fio: command payload too large: %u\n", cmd->pdu_len);
112 struct fio_net_cmd *fio_net_cmd_read(int sk)
114 struct fio_net_cmd cmd, *ret = NULL;
117 if (fio_recv_data(sk, &cmd, sizeof(cmd)))
120 /* We have a command, verify it and swap if need be */
121 if (verify_convert_cmd(&cmd))
124 /* Command checks out, alloc real command and fill in */
125 ret = malloc(sizeof(cmd) + cmd.pdu_len);
126 memcpy(ret, &cmd, sizeof(cmd));
131 /* There's payload, get it */
132 if (fio_recv_data(sk, (void *) ret + sizeof(*ret), ret->pdu_len)) {
137 /* Verify payload crc */
138 crc = crc16(ret->payload, ret->pdu_len);
139 if (crc != ret->pdu_crc16) {
140 log_err("fio: server bad crc on payload (got %x, wanted %x)\n",
141 ret->pdu_crc16, crc);
149 void fio_net_cmd_crc(struct fio_net_cmd *cmd)
153 cmd->cmd_crc16 = cpu_to_le16(crc16(cmd, FIO_NET_CMD_CRC_SZ));
155 pdu_len = le32_to_cpu(cmd->pdu_len);
157 cmd->pdu_crc16 = cpu_to_le16(crc16(cmd->payload, pdu_len));
160 static int send_simple_command(int sk, uint16_t opcode, uint64_t serial)
162 struct fio_net_cmd cmd = {
163 .version = cpu_to_le16(FIO_SERVER_VER1),
164 .opcode = cpu_to_le16(opcode),
165 .serial = cpu_to_le16(serial),
168 fio_net_cmd_crc(&cmd);
170 return fio_send_data(sk, &cmd, sizeof(cmd));
174 * Send an ack for this command
176 static int ack_command(int sk, struct fio_net_cmd *cmd)
179 return send_simple_command(sk, FIO_NET_CMD_ACK, cmd->serial);
186 static int nak_command(int sk, struct fio_net_cmd *cmd)
188 return send_simple_command(sk, FIO_NET_CMD_NAK, cmd->serial);
192 static int handle_cur_job(struct fio_net_cmd *cmd, int done)
194 unsigned int left = job_max_len - job_cur_len;
197 if (left < cmd->pdu_len) {
198 job_buf = realloc(job_buf, job_max_len + 2 * cmd->pdu_len);
199 job_max_len += 2 * cmd->pdu_len;
202 memcpy(job_buf + job_cur_len, cmd->payload, cmd->pdu_len);
203 job_cur_len += cmd->pdu_len;
206 parse_jobs_ini(job_buf, 1, 0);
211 job_cur_len = job_max_len = 0;
217 static int handle_command(struct fio_net_cmd *cmd)
221 switch (cmd->opcode) {
222 case FIO_NET_CMD_QUIT:
225 case FIO_NET_CMD_ACK:
227 case FIO_NET_CMD_NAK:
229 case FIO_NET_CMD_JOB:
230 ret = handle_cur_job(cmd, 0);
232 case FIO_NET_CMD_JOB_END:
233 ret = handle_cur_job(cmd, 1);
236 log_err("fio: unknown opcode: %d\n", cmd->opcode);
243 static int handle_connection(int sk)
245 struct fio_net_cmd *cmd = NULL;
249 while (!exit_backend) {
250 cmd = fio_net_cmd_read(sk);
256 ret = ack_command(sk, cmd);
260 ret = handle_command(cmd);
273 static int accept_loop(int listen_sk)
275 struct sockaddr addr;
276 unsigned int len = sizeof(addr);
278 int ret, sk, flags, exitval = 0;
280 flags = fcntl(listen_sk, F_GETFL);
282 fcntl(listen_sk, F_SETFL, flags);
287 ret = poll(&pfd, 1, 100);
291 log_err("fio: poll: %s\n", strerror(errno));
296 if (pfd.revents & POLLIN)
298 } while (!exit_backend);
303 sk = accept(listen_sk, &addr, &len);
305 log_err("fio: accept: %s\n", strerror(errno));
311 exitval = handle_connection(sk);
325 struct sockaddr_in saddr_in;
326 struct sockaddr addr;
330 sk = socket(AF_INET, SOCK_STREAM, 0);
332 log_err("fio: socket: %s\n", strerror(errno));
337 if (setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &opt, sizeof(opt)) < 0) {
338 log_err("fio: setsockopt: %s\n", strerror(errno));
342 if (setsockopt(fd, SOL_SOCKET, SO_REUSEPORT, &opt, sizeof(opt)) < 0) {
343 log_err("fio: setsockopt: %s\n", strerror(errno));
348 saddr_in.sin_family = AF_INET;
349 saddr_in.sin_addr.s_addr = htonl(INADDR_ANY);
350 saddr_in.sin_port = htons(fio_net_port);
352 if (bind(sk, (struct sockaddr *) &saddr_in, sizeof(saddr_in)) < 0) {
353 log_err("fio: bind: %s\n", strerror(errno));
357 if (listen(sk, 1) < 0) {
358 log_err("fio: listen: %s\n", strerror(errno));
363 if (getsockname(sk, &addr, &len) < 0) {
364 log_err("fio: getsockname: %s\n", strerror(errno));
368 ret = accept_loop(sk);
373 int fio_server_text_output(const char *buf, unsigned int len)
375 struct fio_net_cmd *cmd;
376 int size = sizeof(*cmd) + len;
379 fio_init_net_cmd(cmd, FIO_NET_CMD_TEXT, buf, len);
380 fio_net_cmd_crc(cmd);
382 fio_send_data(server_fd, cmd, size);
387 int fio_server_log(const char *format, ...)
393 va_start(args, format);
394 len = vsnprintf(buffer, sizeof(buffer), format, args);
397 return fio_server_text_output(buffer, len);