Fix _SC_NPROCESSORS_ONLN on Windows
[fio.git] / server.c
1 #include <stdio.h>
2 #include <stdlib.h>
3 #include <stdarg.h>
4 #include <unistd.h>
5 #include <limits.h>
6 #include <errno.h>
7 #include <fcntl.h>
8 #include <sys/poll.h>
9 #include <sys/types.h>
10 #include <sys/wait.h>
11 #include <sys/socket.h>
12 #include <sys/stat.h>
13 #include <sys/un.h>
14 #include <netinet/in.h>
15 #include <arpa/inet.h>
16 #include <netdb.h>
17 #include <syslog.h>
18 #include <signal.h>
19
20 #include "fio.h"
21 #include "server.h"
22 #include "crc/crc16.h"
23 #include "lib/ieee754.h"
24
25 int fio_net_port = 8765;
26
27 int exit_backend = 0;
28
29 static int server_fd = -1;
30 static char *fio_server_arg;
31 static char *bind_sock;
32 static struct sockaddr_in saddr_in;
33 static struct sockaddr_in6 saddr_in6;
34 static int first_cmd_check;
35 static int use_ipv6;
36
37 static const char *fio_server_ops[FIO_NET_CMD_NR] = {
38         "",
39         "QUIT",
40         "EXIT",
41         "JOB",
42         "JOBLINE",
43         "TEXT",
44         "TS",
45         "GS",
46         "SEND_ETA",
47         "ETA",
48         "PROBE",
49         "START",
50         "STOP",
51         "DISK_UTIL",
52         "RUN",
53 };
54
55 const char *fio_server_op(unsigned int op)
56 {
57         static char buf[32];
58
59         if (op < FIO_NET_CMD_NR)
60                 return fio_server_ops[op];
61
62         sprintf(buf, "UNKNOWN/%d", op);
63         return buf;
64 }
65
66 int fio_send_data(int sk, const void *p, unsigned int len)
67 {
68         assert(len <= sizeof(struct fio_net_cmd) + FIO_SERVER_MAX_PDU);
69
70         do {
71                 int ret = send(sk, p, len, 0);
72
73                 if (ret > 0) {
74                         len -= ret;
75                         if (!len)
76                                 break;
77                         p += ret;
78                         continue;
79                 } else if (!ret)
80                         break;
81                 else if (errno == EAGAIN || errno == EINTR)
82                         continue;
83                 else
84                         break;
85         } while (!exit_backend);
86
87         if (!len)
88                 return 0;
89
90         return 1;
91 }
92
93 int fio_recv_data(int sk, void *p, unsigned int len)
94 {
95         do {
96                 int ret = recv(sk, p, len, MSG_WAITALL);
97
98                 if (ret > 0) {
99                         len -= ret;
100                         if (!len)
101                                 break;
102                         p += ret;
103                         continue;
104                 } else if (!ret)
105                         break;
106                 else if (errno == EAGAIN || errno == EINTR)
107                         continue;
108                 else
109                         break;
110         } while (!exit_backend);
111
112         if (!len)
113                 return 0;
114
115         return -1;
116 }
117
118 static int verify_convert_cmd(struct fio_net_cmd *cmd)
119 {
120         uint16_t crc;
121
122         cmd->cmd_crc16 = le16_to_cpu(cmd->cmd_crc16);
123         cmd->pdu_crc16 = le16_to_cpu(cmd->pdu_crc16);
124
125         crc = fio_crc16(cmd, FIO_NET_CMD_CRC_SZ);
126         if (crc != cmd->cmd_crc16) {
127                 log_err("fio: server bad crc on command (got %x, wanted %x)\n",
128                                 cmd->cmd_crc16, crc);
129                 return 1;
130         }
131
132         cmd->version    = le16_to_cpu(cmd->version);
133         cmd->opcode     = le16_to_cpu(cmd->opcode);
134         cmd->flags      = le32_to_cpu(cmd->flags);
135         cmd->tag        = le64_to_cpu(cmd->tag);
136         cmd->pdu_len    = le32_to_cpu(cmd->pdu_len);
137
138         switch (cmd->version) {
139         case FIO_SERVER_VER:
140                 break;
141         default:
142                 log_err("fio: bad server cmd version %d\n", cmd->version);
143                 return 1;
144         }
145
146         if (cmd->pdu_len > FIO_SERVER_MAX_PDU) {
147                 log_err("fio: command payload too large: %u\n", cmd->pdu_len);
148                 return 1;
149         }
150
151         return 0;
152 }
153
154 /*
155  * Read (and defragment, if necessary) incoming commands
156  */
157 struct fio_net_cmd *fio_net_recv_cmd(int sk)
158 {
159         struct fio_net_cmd cmd, *cmdret = NULL;
160         size_t cmd_size = 0, pdu_offset = 0;
161         uint16_t crc;
162         int ret, first = 1;
163         void *pdu = NULL;
164
165         do {
166                 ret = fio_recv_data(sk, &cmd, sizeof(cmd));
167                 if (ret)
168                         break;
169
170                 /* We have a command, verify it and swap if need be */
171                 ret = verify_convert_cmd(&cmd);
172                 if (ret)
173                         break;
174
175                 if (first) {
176                         /* if this is text, add room for \0 at the end */
177                         cmd_size = sizeof(cmd) + cmd.pdu_len + 1;
178                         assert(!cmdret);
179                 } else
180                         cmd_size += cmd.pdu_len;
181
182                 cmdret = realloc(cmdret, cmd_size);
183
184                 if (first)
185                         memcpy(cmdret, &cmd, sizeof(cmd));
186                 else if (cmdret->opcode != cmd.opcode) {
187                         log_err("fio: fragment opcode mismatch (%d != %d)\n",
188                                         cmdret->opcode, cmd.opcode);
189                         ret = 1;
190                         break;
191                 }
192
193                 if (!cmd.pdu_len)
194                         break;
195
196                 /* There's payload, get it */
197                 pdu = (void *) cmdret->payload + pdu_offset;
198                 ret = fio_recv_data(sk, pdu, cmd.pdu_len);
199                 if (ret)
200                         break;
201
202                 /* Verify payload crc */
203                 crc = fio_crc16(pdu, cmd.pdu_len);
204                 if (crc != cmd.pdu_crc16) {
205                         log_err("fio: server bad crc on payload ");
206                         log_err("(got %x, wanted %x)\n", cmd.pdu_crc16, crc);
207                         ret = 1;
208                         break;
209                 }
210
211                 pdu_offset += cmd.pdu_len;
212                 if (!first)
213                         cmdret->pdu_len += cmd.pdu_len;
214                 first = 0;
215         } while (cmd.flags & FIO_NET_CMD_F_MORE);
216
217         if (ret) {
218                 free(cmdret);
219                 cmdret = NULL;
220         } else if (cmdret) {
221                 /* zero-terminate text input */
222                 if (cmdret->pdu_len && (cmdret->opcode == FIO_NET_CMD_TEXT ||
223                     cmdret->opcode == FIO_NET_CMD_JOB)) {
224                         char *buf = (char *) cmdret->payload;
225
226                         buf[cmdret->pdu_len ] = '\0';
227                 }
228                 /* frag flag is internal */
229                 cmdret->flags &= ~FIO_NET_CMD_F_MORE;
230         }
231
232         return cmdret;
233 }
234
235 void fio_net_cmd_crc(struct fio_net_cmd *cmd)
236 {
237         uint32_t pdu_len;
238
239         cmd->cmd_crc16 = __cpu_to_le16(fio_crc16(cmd, FIO_NET_CMD_CRC_SZ));
240
241         pdu_len = le32_to_cpu(cmd->pdu_len);
242         if (pdu_len)
243                 cmd->pdu_crc16 = __cpu_to_le16(fio_crc16(cmd->payload, pdu_len));
244 }
245
246 int fio_net_send_cmd(int fd, uint16_t opcode, const void *buf, off_t size,
247                      uint64_t tag)
248 {
249         struct fio_net_cmd *cmd = NULL;
250         size_t this_len, cur_len = 0;
251         int ret;
252
253         do {
254                 this_len = size;
255                 if (this_len > FIO_SERVER_MAX_PDU)
256                         this_len = FIO_SERVER_MAX_PDU;
257
258                 if (!cmd || cur_len < sizeof(*cmd) + this_len) {
259                         if (cmd)
260                                 free(cmd);
261
262                         cur_len = sizeof(*cmd) + this_len;
263                         cmd = malloc(cur_len);
264                 }
265
266                 fio_init_net_cmd(cmd, opcode, buf, this_len, tag);
267
268                 if (this_len < size)
269                         cmd->flags = __cpu_to_le32(FIO_NET_CMD_F_MORE);
270
271                 fio_net_cmd_crc(cmd);
272
273                 ret = fio_send_data(fd, cmd, sizeof(*cmd) + this_len);
274                 size -= this_len;
275                 buf += this_len;
276         } while (!ret && size);
277
278         if (cmd)
279                 free(cmd);
280
281         return ret;
282 }
283
284 static int fio_net_send_simple_stack_cmd(int sk, uint16_t opcode, uint64_t tag)
285 {
286         struct fio_net_cmd cmd;
287
288         fio_init_net_cmd(&cmd, opcode, NULL, 0, tag);
289         fio_net_cmd_crc(&cmd);
290
291         return fio_send_data(sk, &cmd, sizeof(cmd));
292 }
293
294 /*
295  * If 'list' is non-NULL, then allocate and store the sent command for
296  * later verification.
297  */
298 int fio_net_send_simple_cmd(int sk, uint16_t opcode, uint64_t tag,
299                             struct flist_head *list)
300 {
301         struct fio_net_int_cmd *cmd;
302         int ret;
303
304         if (!list)
305                 return fio_net_send_simple_stack_cmd(sk, opcode, tag);
306
307         cmd = malloc(sizeof(*cmd));
308
309         fio_init_net_cmd(&cmd->cmd, opcode, NULL, 0, (uintptr_t) cmd);
310         fio_net_cmd_crc(&cmd->cmd);
311
312         INIT_FLIST_HEAD(&cmd->list);
313         fio_gettime(&cmd->tv, NULL);
314         cmd->saved_tag = tag;
315
316         ret = fio_send_data(sk, &cmd->cmd, sizeof(cmd->cmd));
317         if (ret) {
318                 free(cmd);
319                 return ret;
320         }
321
322         flist_add_tail(&cmd->list, list);
323         return 0;
324 }
325
326 static int fio_server_send_quit_cmd(void)
327 {
328         dprint(FD_NET, "server: sending quit\n");
329         return fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_QUIT, 0, NULL);
330 }
331
332 static int handle_job_cmd(struct fio_net_cmd *cmd)
333 {
334         char *buf = (char *) cmd->payload;
335         struct cmd_start_pdu spdu;
336         struct cmd_end_pdu epdu;
337         int ret;
338
339         if (parse_jobs_ini(buf, 1, 0)) {
340                 fio_server_send_quit_cmd();
341                 return -1;
342         }
343
344         spdu.jobs = cpu_to_le32(thread_number);
345         spdu.stat_outputs = cpu_to_le32(stat_number);
346         fio_net_send_cmd(server_fd, FIO_NET_CMD_START, &spdu, sizeof(spdu), 0);
347
348         ret = fio_backend();
349
350         epdu.error = ret;
351         fio_net_send_cmd(server_fd, FIO_NET_CMD_STOP, &epdu, sizeof(epdu), 0);
352
353         fio_server_send_quit_cmd();
354         reset_fio_state();
355         return ret;
356 }
357
358 static int handle_jobline_cmd(struct fio_net_cmd *cmd)
359 {
360         void *pdu = cmd->payload;
361         struct cmd_single_line_pdu *cslp;
362         struct cmd_line_pdu *clp;
363         unsigned long offset;
364         char **argv;
365         int ret, i;
366
367         clp = pdu;
368         clp->lines = le16_to_cpu(clp->lines);
369         argv = malloc(clp->lines * sizeof(char *));
370         offset = sizeof(*clp);
371
372         dprint(FD_NET, "server: %d command line args\n", clp->lines);
373
374         for (i = 0; i < clp->lines; i++) {
375                 cslp = pdu + offset;
376                 argv[i] = (char *) cslp->text;
377
378                 offset += sizeof(*cslp) + le16_to_cpu(cslp->len);
379                 dprint(FD_NET, "server: %d: %s\n", i, argv[i]);
380         }
381
382         if (parse_cmd_line(clp->lines, argv)) {
383                 fio_server_send_quit_cmd();
384                 free(argv);
385                 return -1;
386         }
387
388         free(argv);
389
390         fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_START, 0, NULL);
391
392         ret = fio_backend();
393         fio_server_send_quit_cmd();
394         reset_fio_state();
395         return ret;
396 }
397
398 static int handle_probe_cmd(struct fio_net_cmd *cmd)
399 {
400         struct cmd_probe_pdu probe;
401
402         dprint(FD_NET, "server: sending probe reply\n");
403
404         memset(&probe, 0, sizeof(probe));
405         gethostname((char *) probe.hostname, sizeof(probe.hostname));
406 #ifdef FIO_BIG_ENDIAN
407         probe.bigendian = 1;
408 #endif
409         strncpy((char *) probe.fio_version, fio_version_string, sizeof(probe.fio_version));
410
411         probe.os        = FIO_OS;
412         probe.arch      = FIO_ARCH;
413
414         probe.bpp       = sizeof(void *);
415
416         return fio_net_send_cmd(server_fd, FIO_NET_CMD_PROBE, &probe, sizeof(probe), cmd->tag);
417 }
418
419 static int handle_send_eta_cmd(struct fio_net_cmd *cmd)
420 {
421         struct jobs_eta *je;
422         size_t size;
423         int i;
424
425         if (!thread_number)
426                 return 0;
427
428         size = sizeof(*je) + thread_number * sizeof(char) + 1;
429         je = malloc(size);
430         memset(je, 0, size);
431
432         if (!calc_thread_status(je, 1)) {
433                 free(je);
434                 return 0;
435         }
436
437         dprint(FD_NET, "server sending status\n");
438
439         je->nr_running          = cpu_to_le32(je->nr_running);
440         je->nr_ramp             = cpu_to_le32(je->nr_ramp);
441         je->nr_pending          = cpu_to_le32(je->nr_pending);
442         je->files_open          = cpu_to_le32(je->files_open);
443         je->m_rate              = cpu_to_le32(je->m_rate);
444         je->t_rate              = cpu_to_le32(je->t_rate);
445         je->m_iops              = cpu_to_le32(je->m_iops);
446         je->t_iops              = cpu_to_le32(je->t_iops);
447
448         for (i = 0; i < 2; i++) {
449                 je->rate[i]     = cpu_to_le32(je->rate[i]);
450                 je->iops[i]     = cpu_to_le32(je->iops[i]);
451         }
452
453         je->elapsed_sec         = cpu_to_le64(je->elapsed_sec);
454         je->eta_sec             = cpu_to_le64(je->eta_sec);
455         je->is_pow2             = cpu_to_le32(je->is_pow2);
456
457         fio_net_send_cmd(server_fd, FIO_NET_CMD_ETA, je, size, cmd->tag);
458         free(je);
459         return 0;
460 }
461
462 static int handle_command(struct fio_net_cmd *cmd)
463 {
464         int ret;
465
466         dprint(FD_NET, "server: got op [%s], pdu=%u, tag=%lx\n",
467                         fio_server_op(cmd->opcode), cmd->pdu_len, cmd->tag);
468
469         switch (cmd->opcode) {
470         case FIO_NET_CMD_QUIT:
471                 fio_terminate_threads(TERMINATE_ALL);
472                 return -1;
473         case FIO_NET_CMD_EXIT:
474                 exit_backend = 1;
475                 return -1;
476         case FIO_NET_CMD_JOB:
477                 ret = handle_job_cmd(cmd);
478                 break;
479         case FIO_NET_CMD_JOBLINE:
480                 ret = handle_jobline_cmd(cmd);
481                 break;
482         case FIO_NET_CMD_PROBE:
483                 ret = handle_probe_cmd(cmd);
484                 break;
485         case FIO_NET_CMD_SEND_ETA:
486                 ret = handle_send_eta_cmd(cmd);
487                 break;
488         default:
489                 log_err("fio: unknown opcode: %s\n",fio_server_op(cmd->opcode));
490                 ret = 1;
491         }
492
493         return ret;
494 }
495
496 static int handle_connection(int sk, int block)
497 {
498         struct fio_net_cmd *cmd = NULL;
499         int ret = 0;
500
501         /* read forever */
502         while (!exit_backend) {
503                 struct pollfd pfd = {
504                         .fd     = sk,
505                         .events = POLLIN,
506                 };
507
508                 ret = 0;
509                 do {
510                         ret = poll(&pfd, 1, 100);
511                         if (ret < 0) {
512                                 if (errno == EINTR)
513                                         break;
514                                 log_err("fio: poll: %s\n", strerror(errno));
515                                 break;
516                         } else if (!ret) {
517                                 if (!block)
518                                         return 0;
519                                 continue;
520                         }
521
522                         if (pfd.revents & POLLIN)
523                                 break;
524                         if (pfd.revents & (POLLERR|POLLHUP)) {
525                                 ret = 1;
526                                 break;
527                         }
528                 } while (!exit_backend);
529
530                 if (ret < 0)
531                         break;
532
533                 cmd = fio_net_recv_cmd(sk);
534                 if (!cmd) {
535                         ret = -1;
536                         break;
537                 }
538
539                 ret = handle_command(cmd);
540                 if (ret)
541                         break;
542
543                 free(cmd);
544                 cmd = NULL;
545         }
546
547         if (cmd)
548                 free(cmd);
549
550         return ret;
551 }
552
553 void fio_server_idle_loop(void)
554 {
555         if (!first_cmd_check)
556                 fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_RUN, 0, NULL);
557         if (server_fd != -1)
558                 handle_connection(server_fd, 0);
559 }
560
561 static int accept_loop(int listen_sk)
562 {
563         struct sockaddr_in addr;
564         socklen_t len = sizeof(addr);
565         struct pollfd pfd;
566         int ret, sk, flags, exitval = 0;
567
568         dprint(FD_NET, "server enter accept loop\n");
569
570         flags = fcntl(listen_sk, F_GETFL);
571         flags |= O_NONBLOCK;
572         fcntl(listen_sk, F_SETFL, flags);
573 again:
574         pfd.fd = listen_sk;
575         pfd.events = POLLIN;
576         do {
577                 ret = poll(&pfd, 1, 100);
578                 if (ret < 0) {
579                         if (errno == EINTR)
580                                 break;
581                         log_err("fio: poll: %s\n", strerror(errno));
582                         goto out;
583                 } else if (!ret)
584                         continue;
585
586                 if (pfd.revents & POLLIN)
587                         break;
588         } while (!exit_backend);
589
590         if (exit_backend)
591                 goto out;
592
593         sk = accept(listen_sk, (struct sockaddr *) &addr, &len);
594         if (sk < 0) {
595                 log_err("fio: accept: %s\n", strerror(errno));
596                 return -1;
597         }
598
599         dprint(FD_NET, "server: connect from %s\n", inet_ntoa(addr.sin_addr));
600
601         server_fd = sk;
602
603         exitval = handle_connection(sk, 1);
604
605         server_fd = -1;
606         close(sk);
607
608         if (!exit_backend)
609                 goto again;
610
611 out:
612         return exitval;
613 }
614
615 int fio_server_text_output(const char *buf, size_t len)
616 {
617         if (server_fd != -1)
618                 return fio_net_send_cmd(server_fd, FIO_NET_CMD_TEXT, buf, len, 0);
619
620         return log_local_buf(buf, len);
621 }
622
623 static void convert_io_stat(struct io_stat *dst, struct io_stat *src)
624 {
625         dst->max_val    = cpu_to_le64(src->max_val);
626         dst->min_val    = cpu_to_le64(src->min_val);
627         dst->samples    = cpu_to_le64(src->samples);
628
629         /*
630          * Encode to IEEE 754 for network transfer
631          */
632         dst->mean.u.i   = __cpu_to_le64(fio_double_to_uint64(src->mean.u.f));
633         dst->S.u.i      = __cpu_to_le64(fio_double_to_uint64(src->S.u.f));
634 }
635
636 static void convert_gs(struct group_run_stats *dst, struct group_run_stats *src)
637 {
638         int i;
639
640         for (i = 0; i < 2; i++) {
641                 dst->max_run[i]         = cpu_to_le64(src->max_run[i]);
642                 dst->min_run[i]         = cpu_to_le64(src->min_run[i]);
643                 dst->max_bw[i]          = cpu_to_le64(src->max_bw[i]);
644                 dst->min_bw[i]          = cpu_to_le64(src->min_bw[i]);
645                 dst->io_kb[i]           = cpu_to_le64(src->io_kb[i]);
646                 dst->agg[i]             = cpu_to_le64(src->agg[i]);
647         }
648
649         dst->kb_base    = cpu_to_le32(src->kb_base);
650         dst->groupid    = cpu_to_le32(src->groupid);
651 }
652
653 /*
654  * Send a CMD_TS, which packs struct thread_stat and group_run_stats
655  * into a single payload.
656  */
657 void fio_server_send_ts(struct thread_stat *ts, struct group_run_stats *rs)
658 {
659         struct cmd_ts_pdu p;
660         int i, j;
661
662         dprint(FD_NET, "server sending end stats\n");
663
664         memset(&p, 0, sizeof(p));
665
666         strcpy(p.ts.name, ts->name);
667         strcpy(p.ts.verror, ts->verror);
668         strcpy(p.ts.description, ts->description);
669
670         p.ts.error      = cpu_to_le32(ts->error);
671         p.ts.groupid    = cpu_to_le32(ts->groupid);
672         p.ts.pid        = cpu_to_le32(ts->pid);
673         p.ts.members    = cpu_to_le32(ts->members);
674
675         for (i = 0; i < 2; i++) {
676                 convert_io_stat(&p.ts.clat_stat[i], &ts->clat_stat[i]);
677                 convert_io_stat(&p.ts.slat_stat[i], &ts->slat_stat[i]);
678                 convert_io_stat(&p.ts.lat_stat[i], &ts->lat_stat[i]);
679                 convert_io_stat(&p.ts.bw_stat[i], &ts->bw_stat[i]);
680         }
681
682         p.ts.usr_time           = cpu_to_le64(ts->usr_time);
683         p.ts.sys_time           = cpu_to_le64(ts->sys_time);
684         p.ts.ctx                = cpu_to_le64(ts->ctx);
685         p.ts.minf               = cpu_to_le64(ts->minf);
686         p.ts.majf               = cpu_to_le64(ts->majf);
687         p.ts.clat_percentiles   = cpu_to_le64(ts->clat_percentiles);
688
689         for (i = 0; i < FIO_IO_U_LIST_MAX_LEN; i++) {
690                 fio_fp64_t *src = &ts->percentile_list[i];
691                 fio_fp64_t *dst = &p.ts.percentile_list[i];
692
693                 dst->u.i = __cpu_to_le64(fio_double_to_uint64(src->u.f));
694         }
695
696         for (i = 0; i < FIO_IO_U_MAP_NR; i++) {
697                 p.ts.io_u_map[i]        = cpu_to_le32(ts->io_u_map[i]);
698                 p.ts.io_u_submit[i]     = cpu_to_le32(ts->io_u_submit[i]);
699                 p.ts.io_u_complete[i]   = cpu_to_le32(ts->io_u_complete[i]);
700         }
701
702         for (i = 0; i < FIO_IO_U_LAT_U_NR; i++) {
703                 p.ts.io_u_lat_u[i]      = cpu_to_le32(ts->io_u_lat_u[i]);
704                 p.ts.io_u_lat_m[i]      = cpu_to_le32(ts->io_u_lat_m[i]);
705         }
706
707         for (i = 0; i < 2; i++)
708                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++)
709                         p.ts.io_u_plat[i][j] = cpu_to_le32(ts->io_u_plat[i][j]);
710
711         for (i = 0; i < 3; i++) {
712                 p.ts.total_io_u[i]      = cpu_to_le64(ts->total_io_u[i]);
713                 p.ts.short_io_u[i]      = cpu_to_le64(ts->short_io_u[i]);
714         }
715
716         p.ts.total_submit       = cpu_to_le64(ts->total_submit);
717         p.ts.total_complete     = cpu_to_le64(ts->total_complete);
718
719         for (i = 0; i < 2; i++) {
720                 p.ts.io_bytes[i]        = cpu_to_le64(ts->io_bytes[i]);
721                 p.ts.runtime[i]         = cpu_to_le64(ts->runtime[i]);
722         }
723
724         p.ts.total_run_time     = cpu_to_le64(ts->total_run_time);
725         p.ts.continue_on_error  = cpu_to_le16(ts->continue_on_error);
726         p.ts.total_err_count    = cpu_to_le64(ts->total_err_count);
727         p.ts.first_error        = cpu_to_le32(ts->first_error);
728         p.ts.kb_base            = cpu_to_le32(ts->kb_base);
729
730         convert_gs(&p.rs, rs);
731
732         fio_net_send_cmd(server_fd, FIO_NET_CMD_TS, &p, sizeof(p), 0);
733 }
734
735 void fio_server_send_gs(struct group_run_stats *rs)
736 {
737         struct group_run_stats gs;
738
739         dprint(FD_NET, "server sending group run stats\n");
740
741         convert_gs(&gs, rs);
742         fio_net_send_cmd(server_fd, FIO_NET_CMD_GS, &gs, sizeof(gs), 0);
743 }
744
745 static void convert_agg(struct disk_util_agg *dst, struct disk_util_agg *src)
746 {
747         int i;
748
749         for (i = 0; i < 2; i++) {
750                 dst->ios[i]     = cpu_to_le32(src->ios[i]);
751                 dst->merges[i]  = cpu_to_le32(src->merges[i]);
752                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
753                 dst->ticks[i]   = cpu_to_le32(src->ticks[i]);
754         }
755
756         dst->io_ticks           = cpu_to_le32(src->io_ticks);
757         dst->time_in_queue      = cpu_to_le32(src->time_in_queue);
758         dst->slavecount         = cpu_to_le32(src->slavecount);
759         dst->max_util.u.i       = __cpu_to_le64(fio_double_to_uint64(src->max_util.u.f));
760 }
761
762 static void convert_dus(struct disk_util_stat *dst, struct disk_util_stat *src)
763 {
764         int i;
765
766         strcpy((char *) dst->name, (char *) src->name);
767
768         for (i = 0; i < 2; i++) {
769                 dst->ios[i]     = cpu_to_le32(src->ios[i]);
770                 dst->merges[i]  = cpu_to_le32(src->merges[i]);
771                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
772                 dst->ticks[i]   = cpu_to_le32(src->ticks[i]);
773         }
774
775         dst->io_ticks           = cpu_to_le32(src->io_ticks);
776         dst->time_in_queue      = cpu_to_le32(src->time_in_queue);
777         dst->msec               = cpu_to_le64(src->msec);
778 }
779
780 void fio_server_send_du(void)
781 {
782         struct disk_util *du;
783         struct flist_head *entry;
784         struct cmd_du_pdu pdu;
785
786         dprint(FD_NET, "server: sending disk_util %d\n", !flist_empty(&disk_list));
787
788         memset(&pdu, 0, sizeof(pdu));
789
790         flist_for_each(entry, &disk_list) {
791                 du = flist_entry(entry, struct disk_util, list);
792
793                 convert_dus(&pdu.dus, &du->dus);
794                 convert_agg(&pdu.agg, &du->agg);
795
796                 fio_net_send_cmd(server_fd, FIO_NET_CMD_DU, &pdu, sizeof(pdu), 0);
797         }
798 }
799
800 int fio_server_log(const char *format, ...)
801 {
802         char buffer[1024];
803         va_list args;
804         size_t len;
805
806         dprint(FD_NET, "server log\n");
807
808         va_start(args, format);
809         len = vsnprintf(buffer, sizeof(buffer), format, args);
810         va_end(args);
811
812         return fio_server_text_output(buffer, len);
813 }
814
815 static int fio_init_server_ip(void)
816 {
817         struct sockaddr *addr;
818         socklen_t socklen;
819         int sk, opt;
820
821         if (use_ipv6)
822                 sk = socket(AF_INET6, SOCK_STREAM, 0);
823         else
824                 sk = socket(AF_INET, SOCK_STREAM, 0);
825
826         if (sk < 0) {
827                 log_err("fio: socket: %s\n", strerror(errno));
828                 return -1;
829         }
830
831         opt = 1;
832         if (setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &opt, sizeof(opt)) < 0) {
833                 log_err("fio: setsockopt: %s\n", strerror(errno));
834                 close(sk);
835                 return -1;
836         }
837 #ifdef SO_REUSEPORT
838         if (setsockopt(sk, SOL_SOCKET, SO_REUSEPORT, &opt, sizeof(opt)) < 0) {
839                 log_err("fio: setsockopt: %s\n", strerror(errno));
840                 close(sk);
841                 return -1;
842         }
843 #endif
844
845         if (use_ipv6) {
846                 addr = (struct sockaddr *) &saddr_in6;
847                 socklen = sizeof(saddr_in6);
848                 saddr_in6.sin6_family = AF_INET6;
849         } else {
850                 addr = (struct sockaddr *) &saddr_in;
851                 socklen = sizeof(saddr_in);
852                 saddr_in.sin_family = AF_INET;
853         }
854
855         if (bind(sk, addr, socklen) < 0) {
856                 log_err("fio: bind: %s\n", strerror(errno));
857                 close(sk);
858                 return -1;
859         }
860
861         return sk;
862 }
863
864 static int fio_init_server_sock(void)
865 {
866         struct sockaddr_un addr;
867         socklen_t len;
868         mode_t mode;
869         int sk;
870
871         sk = socket(AF_UNIX, SOCK_STREAM, 0);
872         if (sk < 0) {
873                 log_err("fio: socket: %s\n", strerror(errno));
874                 return -1;
875         }
876
877         mode = umask(000);
878
879         memset(&addr, 0, sizeof(addr));
880         addr.sun_family = AF_UNIX;
881         strcpy(addr.sun_path, bind_sock);
882         unlink(bind_sock);
883
884         len = sizeof(addr.sun_family) + strlen(bind_sock) + 1;
885
886         if (bind(sk, (struct sockaddr *) &addr, len) < 0) {
887                 log_err("fio: bind: %s\n", strerror(errno));
888                 close(sk);
889                 return -1;
890         }
891
892         umask(mode);
893         return sk;
894 }
895
896 static int fio_init_server_connection(void)
897 {
898         char bind_str[128];
899         int sk;
900
901         dprint(FD_NET, "starting server\n");
902
903         if (!bind_sock)
904                 sk = fio_init_server_ip();
905         else
906                 sk = fio_init_server_sock();
907
908         if (sk < 0)
909                 return sk;
910
911         if (!bind_sock) {
912                 char *p, port[16];
913                 const void *src;
914                 int af;
915
916                 if (use_ipv6) {
917                         af = AF_INET6;
918                         src = &saddr_in6.sin6_addr;
919                 } else {
920                         af = AF_INET;
921                         src = &saddr_in.sin_addr;
922                 }
923
924                 p = (char *) inet_ntop(af, src, bind_str, sizeof(bind_str));
925
926                 sprintf(port, ",%u", fio_net_port);
927                 if (p)
928                         strcat(p, port);
929                 else
930                         strcpy(bind_str, port);
931         } else
932                 strcpy(bind_str, bind_sock);
933
934         log_info("fio: server listening on %s\n", bind_str);
935
936         if (listen(sk, 0) < 0) {
937                 log_err("fio: listen: %s\n", strerror(errno));
938                 return -1;
939         }
940
941         return sk;
942 }
943
944 /*
945  * Parse a host/ip/port string. Reads from 'str'.
946  *
947  * Outputs:
948  *
949  * For IPv4:
950  *      *ptr is the host, *port is the port, inp is the destination.
951  * For IPv6:
952  *      *ptr is the host, *port is the port, inp6 is the dest, and *ipv6 is 1.
953  * For local domain sockets:
954  *      *ptr is the filename, *is_sock is 1.
955  */
956 int fio_server_parse_string(const char *str, char **ptr, int *is_sock,
957                             int *port, struct in_addr *inp,
958                             struct in6_addr *inp6, int *ipv6)
959 {
960         const char *host = str;
961         char *portp;
962         int ret, lport = 0;
963
964         *ptr = NULL;
965         *is_sock = 0;
966         *port = fio_net_port;
967         *ipv6 = 0;
968
969         if (!strncmp(str, "sock:", 5)) {
970                 *ptr = strdup(str + 5);
971                 *is_sock = 1;
972
973                 return 0;
974         }
975
976         /*
977          * Is it ip:<ip or host>:port
978          */
979         if (!strncmp(host, "ip:", 3))
980                 host += 3;
981         else if (!strncmp(host, "ip4:", 4))
982                 host += 4;
983         else if (!strncmp(host, "ip6:", 4)) {
984                 host += 4;
985                 *ipv6 = 1;
986         } else if (host[0] == ':') {
987                 /* String is :port */
988                 host++;
989                 lport = atoi(host);
990                 if (!lport || lport > 65535) {
991                         log_err("fio: bad server port %u\n", port);
992                         return 1;
993                 }
994                 /* no hostname given, we are done */
995                 *port = lport;
996                 return 0;
997         }
998
999         /*
1000          * If no port seen yet, check if there's a last ':' at the end
1001          */
1002         if (!lport) {
1003                 portp = strchr(host, ',');
1004                 if (portp) {
1005                         *portp = '\0';
1006                         portp++;
1007                         lport = atoi(portp);
1008                         if (!lport || lport > 65535) {
1009                                 log_err("fio: bad server port %u\n", port);
1010                                 return 1;
1011                         }
1012                 }
1013         }
1014
1015         if (lport)
1016                 *port = lport;
1017
1018         if (!strlen(host))
1019                 return 0;
1020
1021         *ptr = strdup(host);
1022
1023         if (*ipv6)
1024                 ret = inet_pton(AF_INET6, host, inp6);
1025         else
1026                 ret = inet_pton(AF_INET, host, inp);
1027
1028         if (ret != 1) {
1029                 struct hostent *hent;
1030
1031                 hent = gethostbyname(host);
1032                 if (!hent) {
1033                         log_err("fio: failed to resolve <%s>\n", host);
1034                         free(*ptr);
1035                         *ptr = NULL;
1036                         return 1;
1037                 }
1038
1039                 if (*ipv6) {
1040                         if (hent->h_addrtype != AF_INET6) {
1041                                 log_info("fio: falling back to IPv4\n");
1042                                 *ipv6 = 0;
1043                         } else
1044                                 memcpy(inp6, hent->h_addr_list[0], 16);
1045                 }
1046                 if (!*ipv6) {
1047                         if (hent->h_addrtype != AF_INET) {
1048                                 log_err("fio: lookup type mismatch\n");
1049                                 free(*ptr);
1050                                 *ptr = NULL;
1051                                 return 1;
1052                         }
1053                         memcpy(inp, hent->h_addr_list[0], 4);
1054                 }
1055         }
1056
1057         if (*port == 0)
1058                 *port = fio_net_port;
1059
1060         return 0;
1061 }
1062
1063 /*
1064  * Server arg should be one of:
1065  *
1066  * sock:/path/to/socket
1067  *   ip:1.2.3.4
1068  *      1.2.3.4
1069  *
1070  * Where sock uses unix domain sockets, and ip binds the server to
1071  * a specific interface. If no arguments are given to the server, it
1072  * uses IP and binds to 0.0.0.0.
1073  *
1074  */
1075 static int fio_handle_server_arg(void)
1076 {
1077         int port = fio_net_port;
1078         int is_sock, ret = 0;
1079
1080         saddr_in.sin_addr.s_addr = htonl(INADDR_ANY);
1081
1082         if (!fio_server_arg)
1083                 goto out;
1084
1085         ret = fio_server_parse_string(fio_server_arg, &bind_sock, &is_sock,
1086                                         &port, &saddr_in.sin_addr,
1087                                         &saddr_in6.sin6_addr, &use_ipv6);
1088
1089         if (!is_sock && bind_sock) {
1090                 free(bind_sock);
1091                 bind_sock = NULL;
1092         }
1093
1094 out:
1095         fio_net_port = port;
1096         saddr_in.sin_port = htons(port);
1097         saddr_in6.sin6_port = htons(port);
1098         return ret;
1099 }
1100
1101 static int fio_server(void)
1102 {
1103         int sk, ret;
1104
1105         dprint(FD_NET, "starting server\n");
1106
1107         if (fio_handle_server_arg())
1108                 return -1;
1109
1110         sk = fio_init_server_connection();
1111         if (sk < 0)
1112                 return -1;
1113
1114         ret = accept_loop(sk);
1115
1116         close(sk);
1117
1118         if (fio_server_arg) {
1119                 free(fio_server_arg);
1120                 fio_server_arg = NULL;
1121         }
1122         if (bind_sock)
1123                 free(bind_sock);
1124
1125         return ret;
1126 }
1127
1128 void fio_server_got_signal(int signal)
1129 {
1130         if (signal == SIGPIPE)
1131                 server_fd = -1;
1132         else {
1133                 log_info("\nfio: terminating on signal %d\n", signal);
1134                 exit_backend = 1;
1135         }
1136 }
1137
1138 static int check_existing_pidfile(const char *pidfile)
1139 {
1140         struct stat sb;
1141         char buf[16];
1142         pid_t pid;
1143         FILE *f;
1144
1145         if (stat(pidfile, &sb))
1146                 return 0;
1147
1148         f = fopen(pidfile, "r");
1149         if (!f)
1150                 return 0;
1151
1152         if (fread(buf, sb.st_size, 1, f) <= 0) {
1153                 fclose(f);
1154                 return 1;
1155         }
1156         fclose(f);
1157
1158         pid = atoi(buf);
1159         if (kill(pid, SIGCONT) < 0)
1160                 return errno != ESRCH;
1161
1162         return 1;
1163 }
1164
1165 static int write_pid(pid_t pid, const char *pidfile)
1166 {
1167         FILE *fpid;
1168
1169         fpid = fopen(pidfile, "w");
1170         if (!fpid) {
1171                 log_err("fio: failed opening pid file %s\n", pidfile);
1172                 return 1;
1173         }
1174
1175         fprintf(fpid, "%u\n", (unsigned int) pid);
1176         fclose(fpid);
1177         return 0;
1178 }
1179
1180 /*
1181  * If pidfile is specified, background us.
1182  */
1183 int fio_start_server(char *pidfile)
1184 {
1185         pid_t pid;
1186         int ret;
1187
1188 #if defined(WIN32)
1189         WSADATA wsd;
1190         WSAStartup(MAKEWORD(2,2), &wsd);
1191 #endif
1192
1193         if (!pidfile)
1194                 return fio_server();
1195
1196         if (check_existing_pidfile(pidfile)) {
1197                 log_err("fio: pidfile %s exists and server appears alive\n",
1198                                                                 pidfile);
1199                 return -1;
1200         }
1201
1202         pid = fork();
1203         if (pid < 0) {
1204                 log_err("fio: failed server fork: %s", strerror(errno));
1205                 free(pidfile);
1206                 return -1;
1207         } else if (pid) {
1208                 int ret = write_pid(pid, pidfile);
1209
1210                 exit(ret);
1211         }
1212
1213         setsid();
1214         openlog("fio", LOG_NDELAY|LOG_NOWAIT|LOG_PID, LOG_USER);
1215         log_syslog = 1;
1216         close(STDIN_FILENO);
1217         close(STDOUT_FILENO);
1218         close(STDERR_FILENO);
1219         f_out = NULL;
1220         f_err = NULL;
1221
1222         ret = fio_server();
1223
1224         closelog();
1225         unlink(pidfile);
1226         free(pidfile);
1227         return ret;
1228 }
1229
1230 void fio_server_set_arg(const char *arg)
1231 {
1232         fio_server_arg = strdup(arg);
1233 }