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