Fix off-by-one in jobs_eta allocation
[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 *fp = &p.ts.percentile_list[i];
675
676                 fp->u.i = __cpu_to_le64(fio_double_to_uint64(fp->u.f));
677         }
678
679         for (i = 0; i < FIO_IO_U_MAP_NR; i++) {
680                 p.ts.io_u_map[i]        = cpu_to_le32(ts->io_u_map[i]);
681                 p.ts.io_u_submit[i]     = cpu_to_le32(ts->io_u_submit[i]);
682                 p.ts.io_u_complete[i]   = cpu_to_le32(ts->io_u_complete[i]);
683         }
684
685         for (i = 0; i < FIO_IO_U_LAT_U_NR; i++) {
686                 p.ts.io_u_lat_u[i]      = cpu_to_le32(ts->io_u_lat_u[i]);
687                 p.ts.io_u_lat_m[i]      = cpu_to_le32(ts->io_u_lat_m[i]);
688         }
689
690         for (i = 0; i < 2; i++)
691                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++)
692                         p.ts.io_u_plat[i][j] = cpu_to_le32(ts->io_u_plat[i][j]);
693
694         for (i = 0; i < 3; i++) {
695                 p.ts.total_io_u[i]      = cpu_to_le64(ts->total_io_u[i]);
696                 p.ts.short_io_u[i]      = cpu_to_le64(ts->short_io_u[i]);
697         }
698
699         p.ts.total_submit       = cpu_to_le64(ts->total_submit);
700         p.ts.total_complete     = cpu_to_le64(ts->total_complete);
701
702         for (i = 0; i < 2; i++) {
703                 p.ts.io_bytes[i]        = cpu_to_le64(ts->io_bytes[i]);
704                 p.ts.runtime[i]         = cpu_to_le64(ts->runtime[i]);
705         }
706
707         p.ts.total_run_time     = cpu_to_le64(ts->total_run_time);
708         p.ts.continue_on_error  = cpu_to_le16(ts->continue_on_error);
709         p.ts.total_err_count    = cpu_to_le64(ts->total_err_count);
710         p.ts.first_error        = cpu_to_le32(ts->first_error);
711         p.ts.kb_base            = cpu_to_le32(ts->kb_base);
712
713         convert_gs(&p.rs, rs);
714
715         fio_net_send_cmd(server_fd, FIO_NET_CMD_TS, &p, sizeof(p), 0);
716 }
717
718 void fio_server_send_gs(struct group_run_stats *rs)
719 {
720         struct group_run_stats gs;
721
722         dprint(FD_NET, "server sending group run stats\n");
723
724         convert_gs(&gs, rs);
725         fio_net_send_cmd(server_fd, FIO_NET_CMD_GS, &gs, sizeof(gs), 0);
726 }
727
728 int fio_server_log(const char *format, ...)
729 {
730         char buffer[1024];
731         va_list args;
732         size_t len;
733
734         dprint(FD_NET, "server log\n");
735
736         va_start(args, format);
737         len = vsnprintf(buffer, sizeof(buffer), format, args);
738         va_end(args);
739
740         return fio_server_text_output(buffer, len);
741 }
742
743 static int fio_init_server_ip(void)
744 {
745         int sk, opt;
746
747         sk = socket(AF_INET, SOCK_STREAM, 0);
748         if (sk < 0) {
749                 log_err("fio: socket: %s\n", strerror(errno));
750                 return -1;
751         }
752
753         opt = 1;
754         if (setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &opt, sizeof(opt)) < 0) {
755                 log_err("fio: setsockopt: %s\n", strerror(errno));
756                 close(sk);
757                 return -1;
758         }
759 #ifdef SO_REUSEPORT
760         if (setsockopt(sk, SOL_SOCKET, SO_REUSEPORT, &opt, sizeof(opt)) < 0) {
761                 log_err("fio: setsockopt: %s\n", strerror(errno));
762                 close(sk);
763                 return -1;
764         }
765 #endif
766
767         saddr_in.sin_family = AF_INET;
768
769         if (bind(sk, (struct sockaddr *) &saddr_in, sizeof(saddr_in)) < 0) {
770                 log_err("fio: bind: %s\n", strerror(errno));
771                 close(sk);
772                 return -1;
773         }
774
775         return sk;
776 }
777
778 static int fio_init_server_sock(void)
779 {
780         struct sockaddr_un addr;
781         fio_socklen_t len;
782         mode_t mode;
783         int sk;
784
785         sk = socket(AF_UNIX, SOCK_STREAM, 0);
786         if (sk < 0) {
787                 log_err("fio: socket: %s\n", strerror(errno));
788                 return -1;
789         }
790
791         mode = umask(000);
792
793         memset(&addr, 0, sizeof(addr));
794         addr.sun_family = AF_UNIX;
795         strcpy(addr.sun_path, bind_sock);
796         unlink(bind_sock);
797
798         len = sizeof(addr.sun_family) + strlen(bind_sock) + 1;
799
800         if (bind(sk, (struct sockaddr *) &addr, len) < 0) {
801                 log_err("fio: bind: %s\n", strerror(errno));
802                 close(sk);
803                 return -1;
804         }
805
806         umask(mode);
807         return sk;
808 }
809
810 static int fio_init_server_connection(void)
811 {
812         char bind_str[128];
813         int sk;
814
815         dprint(FD_NET, "starting server\n");
816
817         if (!bind_sock)
818                 sk = fio_init_server_ip();
819         else
820                 sk = fio_init_server_sock();
821
822         if (sk < 0)
823                 return sk;
824
825         if (!bind_sock)
826                 sprintf(bind_str, "%s:%u", inet_ntoa(saddr_in.sin_addr), fio_net_port);
827         else
828                 strcpy(bind_str, bind_sock);
829
830         log_info("fio: server listening on %s\n", bind_str);
831
832         if (listen(sk, 0) < 0) {
833                 log_err("fio: listen: %s\n", strerror(errno));
834                 return -1;
835         }
836
837         return sk;
838 }
839
840 int fio_server_parse_string(const char *str, char **ptr, int *is_sock,
841                             int *port, struct in_addr *inp)
842 {
843         *ptr = NULL;
844         *is_sock = 0;
845         *port = fio_net_port;
846
847         if (!strncmp(str, "sock:", 5)) {
848                 *ptr = strdup(str + 5);
849                 *is_sock = 1;
850         } else {
851                 const char *host = str;
852                 char *portp;
853                 int lport = 0;
854
855                 /*
856                  * Is it ip:<ip or host>:port
857                  */
858                 if (!strncmp(host, "ip:", 3))
859                         host += 3;
860                 else if (host[0] == ':') {
861                         /* String is :port */
862                         host++;
863                         lport = atoi(host);
864                         if (!lport || lport > 65535) {
865                                 log_err("fio: bad server port %u\n", port);
866                                 return 1;
867                         }
868                         /* no hostname given, we are done */
869                         *port = lport;
870                         return 0;
871                 }
872
873                 /*
874                  * If no port seen yet, check if there's a last ':' at the end
875                  */
876                 if (!lport) {
877                         portp = strchr(host, ':');
878                         if (portp) {
879                                 *portp = '\0';
880                                 portp++;
881                                 lport = atoi(portp);
882                                 if (!lport || lport > 65535) {
883                                         log_err("fio: bad server port %u\n", port);
884                                         return 1;
885                                 }
886                         }
887                 }
888
889                 if (lport)
890                         *port = lport;
891
892                 *ptr = strdup(host);
893
894                 if (inet_aton(host, inp) != 1) {
895                         struct hostent *hent;
896
897                         hent = gethostbyname(host);
898                         if (!hent) {
899                                 free(*ptr);
900                                 *ptr = NULL;
901                                 return 1;
902                         }
903
904                         memcpy(inp, hent->h_addr, 4);
905                 }
906         }
907
908         if (*port == 0)
909                 *port = fio_net_port;
910
911         return 0;
912 }
913
914 /*
915  * Server arg should be one of:
916  *
917  * sock:/path/to/socket
918  *   ip:1.2.3.4
919  *      1.2.3.4
920  *
921  * Where sock uses unix domain sockets, and ip binds the server to
922  * a specific interface. If no arguments are given to the server, it
923  * uses IP and binds to 0.0.0.0.
924  *
925  */
926 static int fio_handle_server_arg(void)
927 {
928         int port = fio_net_port;
929         int is_sock, ret = 0;
930
931         saddr_in.sin_addr.s_addr = htonl(INADDR_ANY);
932
933         if (!fio_server_arg)
934                 goto out;
935
936         ret = fio_server_parse_string(fio_server_arg, &bind_sock, &is_sock,
937                                         &port, &saddr_in.sin_addr);
938
939         if (!is_sock && bind_sock) {
940                 free(bind_sock);
941                 bind_sock = NULL;
942         }
943
944 out:
945         fio_net_port = port;
946         saddr_in.sin_port = htons(port);
947         return ret;
948 }
949
950 static int fio_server(void)
951 {
952         int sk, ret;
953
954         dprint(FD_NET, "starting server\n");
955
956         if (fio_handle_server_arg())
957                 return -1;
958
959         sk = fio_init_server_connection();
960         if (sk < 0)
961                 return -1;
962
963         ret = accept_loop(sk);
964
965         close(sk);
966
967         if (fio_server_arg) {
968                 free(fio_server_arg);
969                 fio_server_arg = NULL;
970         }
971         if (bind_sock)
972                 free(bind_sock);
973
974         return ret;
975 }
976
977 void fio_server_got_signal(int signal)
978 {
979         if (signal == SIGPIPE)
980                 server_fd = -1;
981         else {
982                 log_info("\nfio: terminating on signal %d\n", signal);
983                 exit_backend = 1;
984         }
985 }
986
987 static int check_existing_pidfile(const char *pidfile)
988 {
989         struct stat sb;
990         char buf[16];
991         pid_t pid;
992         FILE *f;
993
994         if (stat(pidfile, &sb))
995                 return 0;
996
997         f = fopen(pidfile, "r");
998         if (!f)
999                 return 0;
1000
1001         if (fread(buf, sb.st_size, 1, f) <= 0) {
1002                 fclose(f);
1003                 return 1;
1004         }
1005         fclose(f);
1006
1007         pid = atoi(buf);
1008         if (kill(pid, SIGCONT) < 0)
1009                 return errno != ESRCH;
1010
1011         return 1;
1012 }
1013
1014 static int write_pid(pid_t pid, const char *pidfile)
1015 {
1016         FILE *fpid;
1017
1018         fpid = fopen(pidfile, "w");
1019         if (!fpid) {
1020                 log_err("fio: failed opening pid file %s\n", pidfile);
1021                 return 1;
1022         }
1023
1024         fprintf(fpid, "%u\n", (unsigned int) pid);
1025         fclose(fpid);
1026         return 0;
1027 }
1028
1029 /*
1030  * If pidfile is specified, background us.
1031  */
1032 int fio_start_server(char *pidfile)
1033 {
1034         pid_t pid;
1035         int ret;
1036
1037         if (!pidfile)
1038                 return fio_server();
1039
1040         if (check_existing_pidfile(pidfile)) {
1041                 log_err("fio: pidfile %s exists and server appears alive\n",
1042                                                                 pidfile);
1043                 return -1;
1044         }
1045
1046         pid = fork();
1047         if (pid < 0) {
1048                 log_err("fio: failed server fork: %s", strerror(errno));
1049                 free(pidfile);
1050                 return -1;
1051         } else if (pid) {
1052                 int ret = write_pid(pid, pidfile);
1053
1054                 exit(ret);
1055         }
1056
1057         setsid();
1058         openlog("fio", LOG_NDELAY|LOG_NOWAIT|LOG_PID, LOG_USER);
1059         log_syslog = 1;
1060         close(STDIN_FILENO);
1061         close(STDOUT_FILENO);
1062         close(STDERR_FILENO);
1063         f_out = NULL;
1064         f_err = NULL;
1065
1066         ret = fio_server();
1067
1068         closelog();
1069         unlink(pidfile);
1070         free(pidfile);
1071         return ret;
1072 }
1073
1074 void fio_server_set_arg(const char *arg)
1075 {
1076         fio_server_arg = strdup(arg);
1077 }