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 <sys/uio.h>
  15 #include <netinet/in.h>
  16 #include <arpa/inet.h>
  17 #include <netdb.h>
  18 #include <syslog.h>
  19 #include <signal.h>
  20 #ifdef CONFIG_ZLIB
  21 #include <zlib.h>
  22 #endif
  23
  24 #include "fio.h"
  25 #include "server.h"
  26 #include "crc/crc16.h"
  27 #include "lib/ieee754.h"
  28
  29 int fio_net_port = FIO_NET_PORT;
  30
  31 int exit_backend = 0;
  32
  33 static int server_fd = -1;
  34 static char *fio_server_arg;
  35 static char *bind_sock;
  36 static struct sockaddr_in saddr_in;
  37 static struct sockaddr_in6 saddr_in6;
  38 static int use_ipv6;
  39 #ifdef CONFIG_ZLIB
  40 static unsigned int has_zlib = 1;
  41 #else
  42 static unsigned int has_zlib = 0;
  43 #endif
  44 static unsigned int use_zlib;
  45
  46 struct fio_fork_item {
  47         struct flist_head list;
  48         int exitval;
  49         int signal;
  50         int exited;
  51         pid_t pid;
  52 };
  53
  54 static const char *fio_server_ops[FIO_NET_CMD_NR] = {
  55         "",
  56         "QUIT",
  57         "EXIT",
  58         "JOB",
  59         "JOBLINE",
  60         "TEXT",
  61         "TS",
  62         "GS",
  63         "SEND_ETA",
  64         "ETA",
  65         "PROBE",
  66         "START",
  67         "STOP",
  68         "DISK_UTIL",
  69         "SERVER_START",
  70         "ADD_JOB",
  71         "CMD_RUN"
  72         "CMD_IOLOG",
  73 };
  74
  75 const char *fio_server_op(unsigned int op)
  76 {
  77         static char buf[32];
  78
  79         if (op < FIO_NET_CMD_NR)
  80                 return fio_server_ops[op];
  81
  82         sprintf(buf, "UNKNOWN/%d", op);
  83         return buf;
  84 }
  85
  86 static ssize_t iov_total_len(const struct iovec *iov, int count)
  87 {
  88         ssize_t ret = 0;
  89
  90         while (count--) {
  91                 ret += iov->iov_len;
  92                 iov++;
  93         }
  94
  95         return ret;
  96 }
  97
  98 static int fio_sendv_data(int sk, struct iovec *iov, int count)
  99 {
 100         ssize_t total_len = iov_total_len(iov, count);
 101         ssize_t ret;
 102
 103         do {
 104                 ret = writev(sk, iov, count);
 105                 if (ret > 0) {
 106                         total_len -= ret;
 107                         if (!total_len)
 108                                 break;
 109
 110                         while (ret) {
 111                                 if (ret >= iov->iov_len) {
 112                                         ret -= iov->iov_len;
 113                                         iov++;
 114                                         continue;
 115                                 }
 116                                 iov->iov_base += ret;
 117                                 iov->iov_len -= ret;
 118                                 ret = 0;
 119                         }
 120                 } else if (!ret)
 121                         break;
 122                 else if (errno == EAGAIN || errno == EINTR)
 123                         continue;
 124                 else
 125                         break;
 126         } while (!exit_backend);
 127
 128         if (!total_len)
 129                 return 0;
 130
 131         if (errno)
 132                 return -errno;
 133
 134         return 1;
 135 }
 136
 137 int fio_send_data(int sk, const void *p, unsigned int len)
 138 {
 139         struct iovec iov = { .iov_base = (void *) p, .iov_len = len };
 140
 141         assert(len <= sizeof(struct fio_net_cmd) + FIO_SERVER_MAX_FRAGMENT_PDU);
 142
 143         return fio_sendv_data(sk, &iov, 1);
 144 }
 145
 146 int fio_recv_data(int sk, void *p, unsigned int len)
 147 {
 148         do {
 149                 int ret = recv(sk, p, len, MSG_WAITALL);
 150
 151                 if (ret > 0) {
 152                         len -= ret;
 153                         if (!len)
 154                                 break;
 155                         p += ret;
 156                         continue;
 157                 } else if (!ret)
 158                         break;
 159                 else if (errno == EAGAIN || errno == EINTR)
 160                         continue;
 161                 else
 162                         break;
 163         } while (!exit_backend);
 164
 165         if (!len)
 166                 return 0;
 167
 168         return -1;
 169 }
 170
 171 static int verify_convert_cmd(struct fio_net_cmd *cmd)
 172 {
 173         uint16_t crc;
 174
 175         cmd->cmd_crc16 = le16_to_cpu(cmd->cmd_crc16);
 176         cmd->pdu_crc16 = le16_to_cpu(cmd->pdu_crc16);
 177
 178         crc = fio_crc16(cmd, FIO_NET_CMD_CRC_SZ);
 179         if (crc != cmd->cmd_crc16) {
 180                 log_err("fio: server bad crc on command (got %x, wanted %x)\n",
 181                                 cmd->cmd_crc16, crc);
 182                 return 1;
 183         }
 184
 185         cmd->version    = le16_to_cpu(cmd->version);
 186         cmd->opcode     = le16_to_cpu(cmd->opcode);
 187         cmd->flags      = le32_to_cpu(cmd->flags);
 188         cmd->tag        = le64_to_cpu(cmd->tag);
 189         cmd->pdu_len    = le32_to_cpu(cmd->pdu_len);
 190
 191         switch (cmd->version) {
 192         case FIO_SERVER_VER:
 193                 break;
 194         default:
 195                 log_err("fio: bad server cmd version %d\n", cmd->version);
 196                 return 1;
 197         }
 198
 199         if (cmd->pdu_len > FIO_SERVER_MAX_FRAGMENT_PDU) {
 200                 log_err("fio: command payload too large: %u\n", cmd->pdu_len);
 201                 return 1;
 202         }
 203
 204         return 0;
 205 }
 206
 207 /*
 208  * Read (and defragment, if necessary) incoming commands
 209  */
 210 struct fio_net_cmd *fio_net_recv_cmd(int sk)
 211 {
 212         struct fio_net_cmd cmd, *cmdret = NULL;
 213         size_t cmd_size = 0, pdu_offset = 0;
 214         uint16_t crc;
 215         int ret, first = 1;
 216         void *pdu = NULL;
 217
 218         do {
 219                 ret = fio_recv_data(sk, &cmd, sizeof(cmd));
 220                 if (ret)
 221                         break;
 222
 223                 /* We have a command, verify it and swap if need be */
 224                 ret = verify_convert_cmd(&cmd);
 225                 if (ret)
 226                         break;
 227
 228                 if (first) {
 229                         /* if this is text, add room for \0 at the end */
 230                         cmd_size = sizeof(cmd) + cmd.pdu_len + 1;
 231                         assert(!cmdret);
 232                 } else
 233                         cmd_size += cmd.pdu_len;
 234
 235                 cmdret = realloc(cmdret, cmd_size);
 236
 237                 if (first)
 238                         memcpy(cmdret, &cmd, sizeof(cmd));
 239                 else if (cmdret->opcode != cmd.opcode) {
 240                         log_err("fio: fragment opcode mismatch (%d != %d)\n",
 241                                         cmdret->opcode, cmd.opcode);
 242                         ret = 1;
 243                         break;
 244                 }
 245
 246                 if (!cmd.pdu_len)
 247                         break;
 248
 249                 /* There's payload, get it */
 250                 pdu = (void *) cmdret->payload + pdu_offset;
 251                 ret = fio_recv_data(sk, pdu, cmd.pdu_len);
 252                 if (ret)
 253                         break;
 254
 255                 /* Verify payload crc */
 256                 crc = fio_crc16(pdu, cmd.pdu_len);
 257                 if (crc != cmd.pdu_crc16) {
 258                         log_err("fio: server bad crc on payload ");
 259                         log_err("(got %x, wanted %x)\n", cmd.pdu_crc16, crc);
 260                         ret = 1;
 261                         break;
 262                 }
 263
 264                 pdu_offset += cmd.pdu_len;
 265                 if (!first)
 266                         cmdret->pdu_len += cmd.pdu_len;
 267                 first = 0;
 268         } while (cmd.flags & FIO_NET_CMD_F_MORE);
 269
 270         if (ret) {
 271                 free(cmdret);
 272                 cmdret = NULL;
 273         } else if (cmdret) {
 274                 /* zero-terminate text input */
 275                 if (cmdret->pdu_len) {
 276                         if (cmdret->opcode == FIO_NET_CMD_TEXT) {
 277                                 struct cmd_text_pdu *pdu = (struct cmd_text_pdu *) cmdret->payload;
 278                                 char *buf = (char *) pdu->buf;
 279
 280                                 buf[pdu->buf_len] = '\0';
 281                         } else if (cmdret->opcode == FIO_NET_CMD_JOB) {
 282                                 struct cmd_job_pdu *pdu = (struct cmd_job_pdu *) cmdret->payload;
 283                                 char *buf = (char *) pdu->buf;
 284                                 int len = le32_to_cpu(pdu->buf_len);
 285
 286                                 buf[len] = '\0';
 287                         }
 288                 }
 289
 290                 /* frag flag is internal */
 291                 cmdret->flags &= ~FIO_NET_CMD_F_MORE;
 292         }
 293
 294         return cmdret;
 295 }
 296
 297 static void add_reply(uint64_t tag, struct flist_head *list)
 298 {
 299         struct fio_net_cmd_reply *reply;
 300
 301         reply = (struct fio_net_cmd_reply *) (uintptr_t) tag;
 302         flist_add_tail(&reply->list, list);
 303 }
 304
 305 static uint64_t alloc_reply(uint64_t tag, uint16_t opcode)
 306 {
 307         struct fio_net_cmd_reply *reply;
 308
 309         reply = calloc(1, sizeof(*reply));
 310         INIT_FLIST_HEAD(&reply->list);
 311         gettimeofday(&reply->tv, NULL);
 312         reply->saved_tag = tag;
 313         reply->opcode = opcode;
 314
 315         return (uintptr_t) reply;
 316 }
 317
 318 static void free_reply(uint64_t tag)
 319 {
 320         struct fio_net_cmd_reply *reply;
 321
 322         reply = (struct fio_net_cmd_reply *) (uintptr_t) tag;
 323         free(reply);
 324 }
 325
 326 void fio_net_cmd_crc_pdu(struct fio_net_cmd *cmd, const void *pdu)
 327 {
 328         uint32_t pdu_len;
 329
 330         cmd->cmd_crc16 = __cpu_to_le16(fio_crc16(cmd, FIO_NET_CMD_CRC_SZ));
 331
 332         pdu_len = le32_to_cpu(cmd->pdu_len);
 333         cmd->pdu_crc16 = __cpu_to_le16(fio_crc16(pdu, pdu_len));
 334 }
 335
 336 void fio_net_cmd_crc(struct fio_net_cmd *cmd)
 337 {
 338         fio_net_cmd_crc_pdu(cmd, cmd->payload);
 339 }
 340
 341 int fio_net_send_cmd(int fd, uint16_t opcode, const void *buf, off_t size,
 342                      uint64_t *tagptr, struct flist_head *list)
 343 {
 344         struct fio_net_cmd *cmd = NULL;
 345         size_t this_len, cur_len = 0;
 346         uint64_t tag;
 347         int ret;
 348
 349         if (list) {
 350                 assert(tagptr);
 351                 tag = *tagptr = alloc_reply(*tagptr, opcode);
 352         } else
 353                 tag = tagptr ? *tagptr : 0;
 354
 355         do {
 356                 this_len = size;
 357                 if (this_len > FIO_SERVER_MAX_FRAGMENT_PDU)
 358                         this_len = FIO_SERVER_MAX_FRAGMENT_PDU;
 359
 360                 if (!cmd || cur_len < sizeof(*cmd) + this_len) {
 361                         if (cmd)
 362                                 free(cmd);
 363
 364                         cur_len = sizeof(*cmd) + this_len;
 365                         cmd = malloc(cur_len);
 366                 }
 367
 368                 fio_init_net_cmd(cmd, opcode, buf, this_len, tag);
 369
 370                 if (this_len < size)
 371                         cmd->flags = __cpu_to_le32(FIO_NET_CMD_F_MORE);
 372
 373                 fio_net_cmd_crc(cmd);
 374
 375                 ret = fio_send_data(fd, cmd, sizeof(*cmd) + this_len);
 376                 size -= this_len;
 377                 buf += this_len;
 378         } while (!ret && size);
 379
 380         if (list) {
 381                 if (ret)
 382                         free_reply(tag);
 383                 else
 384                         add_reply(tag, list);
 385         }
 386
 387         if (cmd)
 388                 free(cmd);
 389
 390         return ret;
 391 }
 392
 393 static int fio_net_send_simple_stack_cmd(int sk, uint16_t opcode, uint64_t tag)
 394 {
 395         struct fio_net_cmd cmd;
 396
 397         fio_init_net_cmd(&cmd, opcode, NULL, 0, tag);
 398         fio_net_cmd_crc(&cmd);
 399
 400         return fio_send_data(sk, &cmd, sizeof(cmd));
 401 }
 402
 403 /*
 404  * If 'list' is non-NULL, then allocate and store the sent command for
 405  * later verification.
 406  */
 407 int fio_net_send_simple_cmd(int sk, uint16_t opcode, uint64_t tag,
 408                             struct flist_head *list)
 409 {
 410         int ret;
 411
 412         if (list)
 413                 tag = alloc_reply(tag, opcode);
 414
 415         ret = fio_net_send_simple_stack_cmd(sk, opcode, tag);
 416         if (ret) {
 417                 if (list)
 418                         free_reply(tag);
 419
 420                 return ret;
 421         }
 422
 423         if (list)
 424                 add_reply(tag, list);
 425
 426         return 0;
 427 }
 428
 429 int fio_net_send_quit(int sk)
 430 {
 431         dprint(FD_NET, "server: sending quit\n");
 432
 433         return fio_net_send_simple_cmd(sk, FIO_NET_CMD_QUIT, 0, NULL);
 434 }
 435
 436 static int fio_net_send_ack(int sk, struct fio_net_cmd *cmd, int error,
 437                             int signal)
 438 {
 439         struct cmd_end_pdu epdu;
 440         uint64_t tag = 0;
 441
 442         if (cmd)
 443                 tag = cmd->tag;
 444
 445         epdu.error = __cpu_to_le32(error);
 446         epdu.signal = __cpu_to_le32(signal);
 447         return fio_net_send_cmd(sk, FIO_NET_CMD_STOP, &epdu, sizeof(epdu), &tag, NULL);
 448 }
 449
 450 int fio_net_send_stop(int sk, int error, int signal)
 451 {
 452         dprint(FD_NET, "server: sending stop (%d, %d)\n", error, signal);
 453         return fio_net_send_ack(sk, NULL, error, signal);
 454 }
 455
 456 static void fio_server_add_fork_item(pid_t pid, struct flist_head *list)
 457 {
 458         struct fio_fork_item *ffi;
 459
 460         ffi = malloc(sizeof(*ffi));
 461         ffi->exitval = 0;
 462         ffi->signal = 0;
 463         ffi->exited = 0;
 464         ffi->pid = pid;
 465         flist_add_tail(&ffi->list, list);
 466 }
 467
 468 static void fio_server_add_conn_pid(struct flist_head *conn_list, pid_t pid)
 469 {
 470         dprint(FD_NET, "server: forked off connection job (pid=%u)\n", (int) pid);
 471         fio_server_add_fork_item(pid, conn_list);
 472 }
 473
 474 static void fio_server_add_job_pid(struct flist_head *job_list, pid_t pid)
 475 {
 476         dprint(FD_NET, "server: forked off job job (pid=%u)\n", (int) pid);
 477         fio_server_add_fork_item(pid, job_list);
 478 }
 479
 480 static void fio_server_check_fork_item(struct fio_fork_item *ffi)
 481 {
 482         int ret, status;
 483
 484         ret = waitpid(ffi->pid, &status, WNOHANG);
 485         if (ret < 0) {
 486                 if (errno == ECHILD) {
 487                         log_err("fio: connection pid %u disappeared\n", (int) ffi->pid);
 488                         ffi->exited = 1;
 489                 } else
 490                         log_err("fio: waitpid: %s\n", strerror(errno));
 491         } else if (ret == ffi->pid) {
 492                 if (WIFSIGNALED(status)) {
 493                         ffi->signal = WTERMSIG(status);
 494                         ffi->exited = 1;
 495                 }
 496                 if (WIFEXITED(status)) {
 497                         if (WEXITSTATUS(status))
 498                                 ffi->exitval = WEXITSTATUS(status);
 499                         ffi->exited = 1;
 500                 }
 501         }
 502 }
 503
 504 static void fio_server_fork_item_done(struct fio_fork_item *ffi)
 505 {
 506         dprint(FD_NET, "pid %u exited, sig=%u, exitval=%d\n", (int) ffi->pid, ffi->signal, ffi->exitval);
 507
 508         /*
 509          * Fold STOP and QUIT...
 510          */
 511         fio_net_send_stop(server_fd, ffi->exitval, ffi->signal);
 512         fio_net_send_quit(server_fd);
 513         flist_del(&ffi->list);
 514         free(ffi);
 515 }
 516
 517 static void fio_server_check_fork_items(struct flist_head *list)
 518 {
 519         struct flist_head *entry, *tmp;
 520         struct fio_fork_item *ffi;
 521
 522         flist_for_each_safe(entry, tmp, list) {
 523                 ffi = flist_entry(entry, struct fio_fork_item, list);
 524
 525                 fio_server_check_fork_item(ffi);
 526
 527                 if (ffi->exited)
 528                         fio_server_fork_item_done(ffi);
 529         }
 530 }
 531
 532 static void fio_server_check_jobs(struct flist_head *job_list)
 533 {
 534         fio_server_check_fork_items(job_list);
 535 }
 536
 537 static void fio_server_check_conns(struct flist_head *conn_list)
 538 {
 539         fio_server_check_fork_items(conn_list);
 540 }
 541
 542 static int handle_run_cmd(struct flist_head *job_list, struct fio_net_cmd *cmd)
 543 {
 544         pid_t pid;
 545         int ret;
 546
 547         set_genesis_time();
 548
 549         pid = fork();
 550         if (pid) {
 551                 fio_server_add_job_pid(job_list, pid);
 552                 return 0;
 553         }
 554
 555         ret = fio_backend();
 556         free_threads_shm();
 557         _exit(ret);
 558 }
 559
 560 static int handle_job_cmd(struct fio_net_cmd *cmd)
 561 {
 562         struct cmd_job_pdu *pdu = (struct cmd_job_pdu *) cmd->payload;
 563         void *buf = pdu->buf;
 564         struct cmd_start_pdu spdu;
 565
 566         pdu->buf_len = le32_to_cpu(pdu->buf_len);
 567         pdu->client_type = le32_to_cpu(pdu->client_type);
 568
 569         if (parse_jobs_ini(buf, 1, 0, pdu->client_type)) {
 570                 fio_net_send_quit(server_fd);
 571                 return -1;
 572         }
 573
 574         spdu.jobs = cpu_to_le32(thread_number);
 575         spdu.stat_outputs = cpu_to_le32(stat_number);
 576         fio_net_send_cmd(server_fd, FIO_NET_CMD_START, &spdu, sizeof(spdu), NULL, NULL);
 577         return 0;
 578 }
 579
 580 static int handle_jobline_cmd(struct fio_net_cmd *cmd)
 581 {
 582         void *pdu = cmd->payload;
 583         struct cmd_single_line_pdu *cslp;
 584         struct cmd_line_pdu *clp;
 585         unsigned long offset;
 586         struct cmd_start_pdu spdu;
 587         char **argv;
 588         int i;
 589
 590         clp = pdu;
 591         clp->lines = le16_to_cpu(clp->lines);
 592         clp->client_type = le16_to_cpu(clp->client_type);
 593         argv = malloc(clp->lines * sizeof(char *));
 594         offset = sizeof(*clp);
 595
 596         dprint(FD_NET, "server: %d command line args\n", clp->lines);
 597
 598         for (i = 0; i < clp->lines; i++) {
 599                 cslp = pdu + offset;
 600                 argv[i] = (char *) cslp->text;
 601
 602                 offset += sizeof(*cslp) + le16_to_cpu(cslp->len);
 603                 dprint(FD_NET, "server: %d: %s\n", i, argv[i]);
 604         }
 605
 606         if (parse_cmd_line(clp->lines, argv, clp->client_type)) {
 607                 fio_net_send_quit(server_fd);
 608                 free(argv);
 609                 return -1;
 610         }
 611
 612         free(argv);
 613
 614         spdu.jobs = cpu_to_le32(thread_number);
 615         spdu.stat_outputs = cpu_to_le32(stat_number);
 616         fio_net_send_cmd(server_fd, FIO_NET_CMD_START, &spdu, sizeof(spdu), NULL, NULL);
 617         return 0;
 618 }
 619
 620 static int handle_probe_cmd(struct fio_net_cmd *cmd)
 621 {
 622         struct cmd_client_probe_pdu *pdu = (struct cmd_client_probe_pdu *) cmd->payload;
 623         struct cmd_probe_reply_pdu probe;
 624         uint64_t tag = cmd->tag;
 625
 626         dprint(FD_NET, "server: sending probe reply\n");
 627
 628         memset(&probe, 0, sizeof(probe));
 629         gethostname((char *) probe.hostname, sizeof(probe.hostname));
 630 #ifdef CONFIG_BIG_ENDIAN
 631         probe.bigendian = 1;
 632 #endif
 633         strncpy((char *) probe.fio_version, fio_version_string, sizeof(probe.fio_version));
 634
 635         probe.os        = FIO_OS;
 636         probe.arch      = FIO_ARCH;
 637         probe.bpp       = sizeof(void *);
 638         probe.cpus      = __cpu_to_le32(cpus_online());
 639
 640         /*
 641          * If the client supports compression and we do too, then enable it
 642          */
 643         if (has_zlib && le64_to_cpu(pdu->flags) & FIO_PROBE_FLAG_ZLIB) {
 644                 probe.flags = __cpu_to_le64(FIO_PROBE_FLAG_ZLIB);
 645                 use_zlib = 1;
 646         } else {
 647                 probe.flags = 0;
 648                 use_zlib = 0;
 649         }
 650
 651         return fio_net_send_cmd(server_fd, FIO_NET_CMD_PROBE, &probe, sizeof(probe), &tag, NULL);
 652 }
 653
 654 static int handle_send_eta_cmd(struct fio_net_cmd *cmd)
 655 {
 656         struct jobs_eta *je;
 657         size_t size;
 658         uint64_t tag = cmd->tag;
 659         int i;
 660
 661         if (!thread_number)
 662                 return 0;
 663
 664         size = sizeof(*je) + thread_number * sizeof(char) + 1;
 665         je = malloc(size);
 666         memset(je, 0, size);
 667
 668         if (!calc_thread_status(je, 1)) {
 669                 free(je);
 670                 return 0;
 671         }
 672
 673         dprint(FD_NET, "server sending status\n");
 674
 675         je->nr_running          = cpu_to_le32(je->nr_running);
 676         je->nr_ramp             = cpu_to_le32(je->nr_ramp);
 677         je->nr_pending          = cpu_to_le32(je->nr_pending);
 678         je->nr_setting_up       = cpu_to_le32(je->nr_setting_up);
 679         je->files_open          = cpu_to_le32(je->files_open);
 680
 681         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 682                 je->m_rate[i]   = cpu_to_le32(je->m_rate[i]);
 683                 je->t_rate[i]   = cpu_to_le32(je->t_rate[i]);
 684                 je->m_iops[i]   = cpu_to_le32(je->m_iops[i]);
 685                 je->t_iops[i]   = cpu_to_le32(je->t_iops[i]);
 686                 je->rate[i]     = cpu_to_le32(je->rate[i]);
 687                 je->iops[i]     = cpu_to_le32(je->iops[i]);
 688         }
 689
 690         je->elapsed_sec         = cpu_to_le64(je->elapsed_sec);
 691         je->eta_sec             = cpu_to_le64(je->eta_sec);
 692         je->nr_threads          = cpu_to_le32(je->nr_threads);
 693         je->is_pow2             = cpu_to_le32(je->is_pow2);
 694         je->unit_base           = cpu_to_le32(je->unit_base);
 695
 696         fio_net_send_cmd(server_fd, FIO_NET_CMD_ETA, je, size, &tag, NULL);
 697         free(je);
 698         return 0;
 699 }
 700
 701 static int send_update_job_reply(int fd, uint64_t __tag, int error)
 702 {
 703         uint64_t tag = __tag;
 704         uint32_t pdu_error;
 705
 706         pdu_error = __cpu_to_le32(error);
 707         return fio_net_send_cmd(fd, FIO_NET_CMD_UPDATE_JOB, &pdu_error, sizeof(pdu_error), &tag, NULL);
 708 }
 709
 710 static int handle_update_job_cmd(struct fio_net_cmd *cmd)
 711 {
 712         struct cmd_add_job_pdu *pdu = (struct cmd_add_job_pdu *) cmd->payload;
 713         struct thread_data *td;
 714         uint32_t tnumber;
 715
 716         tnumber = le32_to_cpu(pdu->thread_number);
 717
 718         dprint(FD_NET, "server: updating options for job %u\n", tnumber);
 719
 720         if (!tnumber || tnumber > thread_number) {
 721                 send_update_job_reply(server_fd, cmd->tag, ENODEV);
 722                 return 0;
 723         }
 724
 725         td = &threads[tnumber - 1];
 726         convert_thread_options_to_cpu(&td->o, &pdu->top);
 727         send_update_job_reply(server_fd, cmd->tag, 0);
 728         return 0;
 729 }
 730
 731 static int handle_command(struct flist_head *job_list, struct fio_net_cmd *cmd)
 732 {
 733         int ret;
 734
 735         dprint(FD_NET, "server: got op [%s], pdu=%u, tag=%llx\n",
 736                         fio_server_op(cmd->opcode), cmd->pdu_len,
 737                         (unsigned long long) cmd->tag);
 738
 739         switch (cmd->opcode) {
 740         case FIO_NET_CMD_QUIT:
 741                 fio_terminate_threads(TERMINATE_ALL);
 742                 return -1;
 743         case FIO_NET_CMD_EXIT:
 744                 exit_backend = 1;
 745                 return -1;
 746         case FIO_NET_CMD_JOB:
 747                 ret = handle_job_cmd(cmd);
 748                 break;
 749         case FIO_NET_CMD_JOBLINE:
 750                 ret = handle_jobline_cmd(cmd);
 751                 break;
 752         case FIO_NET_CMD_PROBE:
 753                 ret = handle_probe_cmd(cmd);
 754                 break;
 755         case FIO_NET_CMD_SEND_ETA:
 756                 ret = handle_send_eta_cmd(cmd);
 757                 break;
 758         case FIO_NET_CMD_RUN:
 759                 ret = handle_run_cmd(job_list, cmd);
 760                 break;
 761         case FIO_NET_CMD_UPDATE_JOB:
 762                 ret = handle_update_job_cmd(cmd);
 763                 break;
 764         default:
 765                 log_err("fio: unknown opcode: %s\n", fio_server_op(cmd->opcode));
 766                 ret = 1;
 767         }
 768
 769         return ret;
 770 }
 771
 772 static int handle_connection(int sk)
 773 {
 774         struct fio_net_cmd *cmd = NULL;
 775         FLIST_HEAD(job_list);
 776         int ret = 0;
 777
 778         reset_fio_state();
 779         server_fd = sk;
 780
 781         /* read forever */
 782         while (!exit_backend) {
 783                 struct pollfd pfd = {
 784                         .fd     = sk,
 785                         .events = POLLIN,
 786                 };
 787
 788                 ret = 0;
 789                 do {
 790                         int timeout = 1000;
 791
 792                         if (!flist_empty(&job_list))
 793                                 timeout = 100;
 794
 795                         ret = poll(&pfd, 1, timeout);
 796                         if (ret < 0) {
 797                                 if (errno == EINTR)
 798                                         break;
 799                                 log_err("fio: poll: %s\n", strerror(errno));
 800                                 break;
 801                         } else if (!ret) {
 802                                 fio_server_check_jobs(&job_list);
 803                                 continue;
 804                         }
 805
 806                         if (pfd.revents & POLLIN)
 807                                 break;
 808                         if (pfd.revents & (POLLERR|POLLHUP)) {
 809                                 ret = 1;
 810                                 break;
 811                         }
 812                 } while (!exit_backend);
 813
 814                 fio_server_check_jobs(&job_list);
 815
 816                 if (ret < 0)
 817                         break;
 818
 819                 cmd = fio_net_recv_cmd(sk);
 820                 if (!cmd) {
 821                         ret = -1;
 822                         break;
 823                 }
 824
 825                 ret = handle_command(&job_list, cmd);
 826                 if (ret)
 827                         break;
 828
 829                 free(cmd);
 830                 cmd = NULL;
 831         }
 832
 833         if (cmd)
 834                 free(cmd);
 835
 836         close(sk);
 837         _exit(ret);
 838 }
 839
 840 static int accept_loop(int listen_sk)
 841 {
 842         struct sockaddr_in addr;
 843         socklen_t len = sizeof(addr);
 844         struct pollfd pfd;
 845         int ret = 0, sk, flags, exitval = 0;
 846         FLIST_HEAD(conn_list);
 847
 848         dprint(FD_NET, "server enter accept loop\n");
 849
 850         flags = fcntl(listen_sk, F_GETFL);
 851         flags |= O_NONBLOCK;
 852         fcntl(listen_sk, F_SETFL, flags);
 853
 854         while (!exit_backend) {
 855                 pid_t pid;
 856
 857                 pfd.fd = listen_sk;
 858                 pfd.events = POLLIN;
 859                 do {
 860                         int timeout = 1000;
 861
 862                         if (!flist_empty(&conn_list))
 863                                 timeout = 100;
 864
 865                         ret = poll(&pfd, 1, timeout);
 866                         if (ret < 0) {
 867                                 if (errno == EINTR)
 868                                         break;
 869                                 log_err("fio: poll: %s\n", strerror(errno));
 870                                 break;
 871                         } else if (!ret) {
 872                                 fio_server_check_conns(&conn_list);
 873                                 continue;
 874                         }
 875
 876                         if (pfd.revents & POLLIN)
 877                                 break;
 878                 } while (!exit_backend);
 879
 880                 fio_server_check_conns(&conn_list);
 881
 882                 if (exit_backend || ret < 0)
 883                         break;
 884
 885                 sk = accept(listen_sk, (struct sockaddr *) &addr, &len);
 886                 if (sk < 0) {
 887                         log_err("fio: accept: %s\n", strerror(errno));
 888                         return -1;
 889                 }
 890
 891                 dprint(FD_NET, "server: connect from %s\n", inet_ntoa(addr.sin_addr));
 892
 893                 pid = fork();
 894                 if (pid) {
 895                         close(sk);
 896                         fio_server_add_conn_pid(&conn_list, pid);
 897                         continue;
 898                 }
 899
 900                 /* exits */
 901                 handle_connection(sk);
 902         }
 903
 904         return exitval;
 905 }
 906
 907 int fio_server_text_output(int level, const char *buf, size_t len)
 908 {
 909         struct cmd_text_pdu *pdu;
 910         unsigned int tlen;
 911         struct timeval tv;
 912
 913         if (server_fd == -1)
 914                 return log_local_buf(buf, len);
 915
 916         tlen = sizeof(*pdu) + len;
 917         pdu = malloc(tlen);
 918
 919         pdu->level      = __cpu_to_le32(level);
 920         pdu->buf_len    = __cpu_to_le32(len);
 921
 922         gettimeofday(&tv, NULL);
 923         pdu->log_sec    = __cpu_to_le64(tv.tv_sec);
 924         pdu->log_usec   = __cpu_to_le64(tv.tv_usec);
 925
 926         memcpy(pdu->buf, buf, len);
 927
 928         fio_net_send_cmd(server_fd, FIO_NET_CMD_TEXT, pdu, tlen, NULL, NULL);
 929         free(pdu);
 930         return len;
 931 }
 932
 933 static void convert_io_stat(struct io_stat *dst, struct io_stat *src)
 934 {
 935         dst->max_val    = cpu_to_le64(src->max_val);
 936         dst->min_val    = cpu_to_le64(src->min_val);
 937         dst->samples    = cpu_to_le64(src->samples);
 938
 939         /*
 940          * Encode to IEEE 754 for network transfer
 941          */
 942         dst->mean.u.i   = __cpu_to_le64(fio_double_to_uint64(src->mean.u.f));
 943         dst->S.u.i      = __cpu_to_le64(fio_double_to_uint64(src->S.u.f));
 944 }
 945
 946 static void convert_gs(struct group_run_stats *dst, struct group_run_stats *src)
 947 {
 948         int i;
 949
 950         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 951                 dst->max_run[i]         = cpu_to_le64(src->max_run[i]);
 952                 dst->min_run[i]         = cpu_to_le64(src->min_run[i]);
 953                 dst->max_bw[i]          = cpu_to_le64(src->max_bw[i]);
 954                 dst->min_bw[i]          = cpu_to_le64(src->min_bw[i]);
 955                 dst->io_kb[i]           = cpu_to_le64(src->io_kb[i]);
 956                 dst->agg[i]             = cpu_to_le64(src->agg[i]);
 957         }
 958
 959         dst->kb_base    = cpu_to_le32(src->kb_base);
 960         dst->unit_base  = cpu_to_le32(src->unit_base);
 961         dst->groupid    = cpu_to_le32(src->groupid);
 962         dst->unified_rw_rep     = cpu_to_le32(src->unified_rw_rep);
 963 }
 964
 965 /*
 966  * Send a CMD_TS, which packs struct thread_stat and group_run_stats
 967  * into a single payload.
 968  */
 969 void fio_server_send_ts(struct thread_stat *ts, struct group_run_stats *rs)
 970 {
 971         struct cmd_ts_pdu p;
 972         int i, j;
 973
 974         dprint(FD_NET, "server sending end stats\n");
 975
 976         memset(&p, 0, sizeof(p));
 977
 978         strcpy(p.ts.name, ts->name);
 979         strcpy(p.ts.verror, ts->verror);
 980         strcpy(p.ts.description, ts->description);
 981
 982         p.ts.error              = cpu_to_le32(ts->error);
 983         p.ts.thread_number      = cpu_to_le32(ts->thread_number);
 984         p.ts.groupid            = cpu_to_le32(ts->groupid);
 985         p.ts.pid                = cpu_to_le32(ts->pid);
 986         p.ts.members            = cpu_to_le32(ts->members);
 987         p.ts.unified_rw_rep     = cpu_to_le32(ts->unified_rw_rep);
 988
 989         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 990                 convert_io_stat(&p.ts.clat_stat[i], &ts->clat_stat[i]);
 991                 convert_io_stat(&p.ts.slat_stat[i], &ts->slat_stat[i]);
 992                 convert_io_stat(&p.ts.lat_stat[i], &ts->lat_stat[i]);
 993                 convert_io_stat(&p.ts.bw_stat[i], &ts->bw_stat[i]);
 994         }
 995
 996         p.ts.usr_time           = cpu_to_le64(ts->usr_time);
 997         p.ts.sys_time           = cpu_to_le64(ts->sys_time);
 998         p.ts.ctx                = cpu_to_le64(ts->ctx);
 999         p.ts.minf               = cpu_to_le64(ts->minf);
1000         p.ts.majf               = cpu_to_le64(ts->majf);
1001         p.ts.clat_percentiles   = cpu_to_le64(ts->clat_percentiles);
1002
1003         for (i = 0; i < FIO_IO_U_LIST_MAX_LEN; i++) {
1004                 fio_fp64_t *src = &ts->percentile_list[i];
1005                 fio_fp64_t *dst = &p.ts.percentile_list[i];
1006
1007                 dst->u.i = __cpu_to_le64(fio_double_to_uint64(src->u.f));
1008         }
1009
1010         for (i = 0; i < FIO_IO_U_MAP_NR; i++) {
1011                 p.ts.io_u_map[i]        = cpu_to_le32(ts->io_u_map[i]);
1012                 p.ts.io_u_submit[i]     = cpu_to_le32(ts->io_u_submit[i]);
1013                 p.ts.io_u_complete[i]   = cpu_to_le32(ts->io_u_complete[i]);
1014         }
1015
1016         for (i = 0; i < FIO_IO_U_LAT_U_NR; i++) {
1017                 p.ts.io_u_lat_u[i]      = cpu_to_le32(ts->io_u_lat_u[i]);
1018                 p.ts.io_u_lat_m[i]      = cpu_to_le32(ts->io_u_lat_m[i]);
1019         }
1020
1021         for (i = 0; i < DDIR_RWDIR_CNT; i++)
1022                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++)
1023                         p.ts.io_u_plat[i][j] = cpu_to_le32(ts->io_u_plat[i][j]);
1024
1025         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1026                 p.ts.total_io_u[i]      = cpu_to_le64(ts->total_io_u[i]);
1027                 p.ts.short_io_u[i]      = cpu_to_le64(ts->short_io_u[i]);
1028         }
1029
1030         p.ts.total_submit       = cpu_to_le64(ts->total_submit);
1031         p.ts.total_complete     = cpu_to_le64(ts->total_complete);
1032
1033         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1034                 p.ts.io_bytes[i]        = cpu_to_le64(ts->io_bytes[i]);
1035                 p.ts.runtime[i]         = cpu_to_le64(ts->runtime[i]);
1036         }
1037
1038         p.ts.total_run_time     = cpu_to_le64(ts->total_run_time);
1039         p.ts.continue_on_error  = cpu_to_le16(ts->continue_on_error);
1040         p.ts.total_err_count    = cpu_to_le64(ts->total_err_count);
1041         p.ts.first_error        = cpu_to_le32(ts->first_error);
1042         p.ts.kb_base            = cpu_to_le32(ts->kb_base);
1043         p.ts.unit_base          = cpu_to_le32(ts->unit_base);
1044
1045         p.ts.latency_depth      = cpu_to_le32(ts->latency_depth);
1046         p.ts.latency_target     = cpu_to_le64(ts->latency_target);
1047         p.ts.latency_window     = cpu_to_le64(ts->latency_window);
1048         p.ts.latency_percentile.u.i = __cpu_to_le64(fio_double_to_uint64(ts->latency_percentile.u.f));
1049
1050         convert_gs(&p.rs, rs);
1051
1052         fio_net_send_cmd(server_fd, FIO_NET_CMD_TS, &p, sizeof(p), NULL, NULL);
1053 }
1054
1055 void fio_server_send_gs(struct group_run_stats *rs)
1056 {
1057         struct group_run_stats gs;
1058
1059         dprint(FD_NET, "server sending group run stats\n");
1060
1061         convert_gs(&gs, rs);
1062         fio_net_send_cmd(server_fd, FIO_NET_CMD_GS, &gs, sizeof(gs), NULL, NULL);
1063 }
1064
1065 static void convert_agg(struct disk_util_agg *dst, struct disk_util_agg *src)
1066 {
1067         int i;
1068
1069         for (i = 0; i < 2; i++) {
1070                 dst->ios[i]     = cpu_to_le32(src->ios[i]);
1071                 dst->merges[i]  = cpu_to_le32(src->merges[i]);
1072                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
1073                 dst->ticks[i]   = cpu_to_le32(src->ticks[i]);
1074         }
1075
1076         dst->io_ticks           = cpu_to_le32(src->io_ticks);
1077         dst->time_in_queue      = cpu_to_le32(src->time_in_queue);
1078         dst->slavecount         = cpu_to_le32(src->slavecount);
1079         dst->max_util.u.i       = __cpu_to_le64(fio_double_to_uint64(src->max_util.u.f));
1080 }
1081
1082 static void convert_dus(struct disk_util_stat *dst, struct disk_util_stat *src)
1083 {
1084         int i;
1085
1086         strcpy((char *) dst->name, (char *) src->name);
1087
1088         for (i = 0; i < 2; i++) {
1089                 dst->ios[i]     = cpu_to_le32(src->ios[i]);
1090                 dst->merges[i]  = cpu_to_le32(src->merges[i]);
1091                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
1092                 dst->ticks[i]   = cpu_to_le32(src->ticks[i]);
1093         }
1094
1095         dst->io_ticks           = cpu_to_le32(src->io_ticks);
1096         dst->time_in_queue      = cpu_to_le32(src->time_in_queue);
1097         dst->msec               = cpu_to_le64(src->msec);
1098 }
1099
1100 void fio_server_send_du(void)
1101 {
1102         struct disk_util *du;
1103         struct flist_head *entry;
1104         struct cmd_du_pdu pdu;
1105
1106         dprint(FD_NET, "server: sending disk_util %d\n", !flist_empty(&disk_list));
1107
1108         memset(&pdu, 0, sizeof(pdu));
1109
1110         flist_for_each(entry, &disk_list) {
1111                 du = flist_entry(entry, struct disk_util, list);
1112
1113                 convert_dus(&pdu.dus, &du->dus);
1114                 convert_agg(&pdu.agg, &du->agg);
1115
1116                 fio_net_send_cmd(server_fd, FIO_NET_CMD_DU, &pdu, sizeof(pdu), NULL, NULL);
1117         }
1118 }
1119
1120 /*
1121  * Send a command with a separate PDU, not inlined in the command
1122  */
1123 static int fio_send_cmd_ext_pdu(int sk, uint16_t opcode, const void *buf,
1124                                 off_t size, uint64_t tag, uint32_t flags)
1125 {
1126         struct fio_net_cmd cmd;
1127         struct iovec iov[2];
1128
1129         iov[0].iov_base = &cmd;
1130         iov[0].iov_len = sizeof(cmd);
1131         iov[1].iov_base = (void *) buf;
1132         iov[1].iov_len = size;
1133
1134         __fio_init_net_cmd(&cmd, opcode, size, tag);
1135         cmd.flags = __cpu_to_le32(flags);
1136         fio_net_cmd_crc_pdu(&cmd, buf);
1137
1138         return fio_sendv_data(sk, iov, 2);
1139 }
1140
1141 static int fio_send_iolog_gz(struct cmd_iolog_pdu *pdu, struct io_log *log)
1142 {
1143         int ret = 0;
1144 #ifdef CONFIG_ZLIB
1145         z_stream stream;
1146         void *out_pdu;
1147
1148         /*
1149          * Dirty - since the log is potentially huge, compress it into
1150          * FIO_SERVER_MAX_FRAGMENT_PDU chunks and let the receiving
1151          * side defragment it.
1152          */
1153         out_pdu = malloc(FIO_SERVER_MAX_FRAGMENT_PDU);
1154
1155         stream.zalloc = Z_NULL;
1156         stream.zfree = Z_NULL;
1157         stream.opaque = Z_NULL;
1158
1159         if (deflateInit(&stream, Z_DEFAULT_COMPRESSION) != Z_OK) {
1160                 ret = 1;
1161                 goto err;
1162         }
1163
1164         stream.next_in = (void *) log->log;
1165         stream.avail_in = log->nr_samples * sizeof(struct io_sample);
1166
1167         do {
1168                 unsigned int this_len, flags = 0;
1169                 int ret;
1170
1171                 stream.avail_out = FIO_SERVER_MAX_FRAGMENT_PDU;
1172                 stream.next_out = out_pdu;
1173                 ret = deflate(&stream, Z_FINISH);
1174                 /* may be Z_OK, or Z_STREAM_END */
1175                 if (ret < 0)
1176                         goto err_zlib;
1177
1178                 this_len = FIO_SERVER_MAX_FRAGMENT_PDU - stream.avail_out;
1179
1180                 if (stream.avail_in)
1181                         flags = FIO_NET_CMD_F_MORE;
1182
1183                 ret = fio_send_cmd_ext_pdu(server_fd, FIO_NET_CMD_IOLOG,
1184                                            out_pdu, this_len, 0, flags);
1185                 if (ret)
1186                         goto err_zlib;
1187         } while (stream.avail_in);
1188
1189 err_zlib:
1190         deflateEnd(&stream);
1191 err:
1192         free(out_pdu);
1193 #endif
1194         return ret;
1195 }
1196
1197 int fio_send_iolog(struct thread_data *td, struct io_log *log, const char *name)
1198 {
1199         struct cmd_iolog_pdu pdu;
1200         int i, ret = 0;
1201
1202         pdu.thread_number = cpu_to_le32(td->thread_number);
1203         pdu.nr_samples = __cpu_to_le32(log->nr_samples);
1204         pdu.log_type = cpu_to_le32(log->log_type);
1205         pdu.compressed = cpu_to_le32(use_zlib);
1206         strcpy((char *) pdu.name, name);
1207
1208         for (i = 0; i < log->nr_samples; i++) {
1209                 struct io_sample *s = &log->log[i];
1210
1211                 s->time = cpu_to_le64(s->time);
1212                 s->val  = cpu_to_le64(s->val);
1213                 s->ddir = cpu_to_le32(s->ddir);
1214                 s->bs   = cpu_to_le32(s->bs);
1215         }
1216
1217         /*
1218          * Send header first, it's not compressed.
1219          */
1220         ret = fio_send_cmd_ext_pdu(server_fd, FIO_NET_CMD_IOLOG, &pdu,
1221                                         sizeof(pdu), 0, FIO_NET_CMD_F_MORE);
1222         if (ret)
1223                 return ret;
1224
1225         /*
1226          * Now send actual log, compress if we can, otherwise just plain
1227          */
1228         if (use_zlib)
1229                 return fio_send_iolog_gz(&pdu, log);
1230
1231         return fio_send_cmd_ext_pdu(server_fd, FIO_NET_CMD_IOLOG, log->log,
1232                         log->nr_samples * sizeof(struct io_sample), 0, 0);
1233 }
1234
1235 void fio_server_send_add_job(struct thread_data *td)
1236 {
1237         struct cmd_add_job_pdu pdu;
1238
1239         memset(&pdu, 0, sizeof(pdu));
1240         pdu.thread_number = cpu_to_le32(td->thread_number);
1241         pdu.groupid = cpu_to_le32(td->groupid);
1242         convert_thread_options_to_net(&pdu.top, &td->o);
1243
1244         fio_net_send_cmd(server_fd, FIO_NET_CMD_ADD_JOB, &pdu, sizeof(pdu), NULL, NULL);
1245 }
1246
1247 void fio_server_send_start(struct thread_data *td)
1248 {
1249         assert(server_fd != -1);
1250
1251         fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_SERVER_START, 0, NULL);
1252 }
1253
1254 static int fio_init_server_ip(void)
1255 {
1256         struct sockaddr *addr;
1257         socklen_t socklen;
1258         int sk, opt;
1259
1260         if (use_ipv6)
1261                 sk = socket(AF_INET6, SOCK_STREAM, 0);
1262         else
1263                 sk = socket(AF_INET, SOCK_STREAM, 0);
1264
1265         if (sk < 0) {
1266                 log_err("fio: socket: %s\n", strerror(errno));
1267                 return -1;
1268         }
1269
1270         opt = 1;
1271         if (setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, (void *)&opt, sizeof(opt)) < 0) {
1272                 log_err("fio: setsockopt: %s\n", strerror(errno));
1273                 close(sk);
1274                 return -1;
1275         }
1276 #ifdef SO_REUSEPORT
1277         if (setsockopt(sk, SOL_SOCKET, SO_REUSEPORT, &opt, sizeof(opt)) < 0) {
1278                 log_err("fio: setsockopt: %s\n", strerror(errno));
1279                 close(sk);
1280                 return -1;
1281         }
1282 #endif
1283
1284         if (use_ipv6) {
1285                 addr = (struct sockaddr *) &saddr_in6;
1286                 socklen = sizeof(saddr_in6);
1287                 saddr_in6.sin6_family = AF_INET6;
1288         } else {
1289                 addr = (struct sockaddr *) &saddr_in;
1290                 socklen = sizeof(saddr_in);
1291                 saddr_in.sin_family = AF_INET;
1292         }
1293
1294         if (bind(sk, addr, socklen) < 0) {
1295                 log_err("fio: bind: %s\n", strerror(errno));
1296                 close(sk);
1297                 return -1;
1298         }
1299
1300         return sk;
1301 }
1302
1303 static int fio_init_server_sock(void)
1304 {
1305         struct sockaddr_un addr;
1306         socklen_t len;
1307         mode_t mode;
1308         int sk;
1309
1310         sk = socket(AF_UNIX, SOCK_STREAM, 0);
1311         if (sk < 0) {
1312                 log_err("fio: socket: %s\n", strerror(errno));
1313                 return -1;
1314         }
1315
1316         mode = umask(000);
1317
1318         memset(&addr, 0, sizeof(addr));
1319         addr.sun_family = AF_UNIX;
1320         strcpy(addr.sun_path, bind_sock);
1321         unlink(bind_sock);
1322
1323         len = sizeof(addr.sun_family) + strlen(bind_sock) + 1;
1324
1325         if (bind(sk, (struct sockaddr *) &addr, len) < 0) {
1326                 log_err("fio: bind: %s\n", strerror(errno));
1327                 close(sk);
1328                 return -1;
1329         }
1330
1331         umask(mode);
1332         return sk;
1333 }
1334
1335 static int fio_init_server_connection(void)
1336 {
1337         char bind_str[128];
1338         int sk;
1339
1340         dprint(FD_NET, "starting server\n");
1341
1342         if (!bind_sock)
1343                 sk = fio_init_server_ip();
1344         else
1345                 sk = fio_init_server_sock();
1346
1347         if (sk < 0)
1348                 return sk;
1349
1350         if (!bind_sock) {
1351                 char *p, port[16];
1352                 const void *src;
1353                 int af;
1354
1355                 if (use_ipv6) {
1356                         af = AF_INET6;
1357                         src = &saddr_in6.sin6_addr;
1358                 } else {
1359                         af = AF_INET;
1360                         src = &saddr_in.sin_addr;
1361                 }
1362
1363                 p = (char *) inet_ntop(af, src, bind_str, sizeof(bind_str));
1364
1365                 sprintf(port, ",%u", fio_net_port);
1366                 if (p)
1367                         strcat(p, port);
1368                 else
1369                         strcpy(bind_str, port);
1370         } else
1371                 strcpy(bind_str, bind_sock);
1372
1373         log_info("fio: server listening on %s\n", bind_str);
1374
1375         if (listen(sk, 0) < 0) {
1376                 log_err("fio: listen: %s\n", strerror(errno));
1377                 return -1;
1378         }
1379
1380         return sk;
1381 }
1382
1383 int fio_server_parse_host(const char *host, int *ipv6, struct in_addr *inp,
1384                           struct in6_addr *inp6)
1385
1386 {
1387         int ret = 0;
1388
1389         if (*ipv6)
1390                 ret = inet_pton(AF_INET6, host, inp6);
1391         else
1392                 ret = inet_pton(AF_INET, host, inp);
1393
1394         if (ret != 1) {
1395                 struct hostent *hent;
1396
1397                 hent = gethostbyname(host);
1398                 if (!hent) {
1399                         log_err("fio: failed to resolve <%s>\n", host);
1400                         return 0;
1401                 }
1402
1403                 if (*ipv6) {
1404                         if (hent->h_addrtype != AF_INET6) {
1405                                 log_info("fio: falling back to IPv4\n");
1406                                 *ipv6 = 0;
1407                         } else
1408                                 memcpy(inp6, hent->h_addr_list[0], 16);
1409                 }
1410                 if (!*ipv6) {
1411                         if (hent->h_addrtype != AF_INET) {
1412                                 log_err("fio: lookup type mismatch\n");
1413                                 return 0;
1414                         }
1415                         memcpy(inp, hent->h_addr_list[0], 4);
1416                 }
1417                 ret = 1;
1418         }
1419
1420         return !(ret == 1);
1421 }
1422
1423 /*
1424  * Parse a host/ip/port string. Reads from 'str'.
1425  *
1426  * Outputs:
1427  *
1428  * For IPv4:
1429  *      *ptr is the host, *port is the port, inp is the destination.
1430  * For IPv6:
1431  *      *ptr is the host, *port is the port, inp6 is the dest, and *ipv6 is 1.
1432  * For local domain sockets:
1433  *      *ptr is the filename, *is_sock is 1.
1434  */
1435 int fio_server_parse_string(const char *str, char **ptr, int *is_sock,
1436                             int *port, struct in_addr *inp,
1437                             struct in6_addr *inp6, int *ipv6)
1438 {
1439         const char *host = str;
1440         char *portp;
1441         int lport = 0;
1442
1443         *ptr = NULL;
1444         *is_sock = 0;
1445         *port = fio_net_port;
1446         *ipv6 = 0;
1447
1448         if (!strncmp(str, "sock:", 5)) {
1449                 *ptr = strdup(str + 5);
1450                 *is_sock = 1;
1451
1452                 return 0;
1453         }
1454
1455         /*
1456          * Is it ip:<ip or host>:port
1457          */
1458         if (!strncmp(host, "ip:", 3))
1459                 host += 3;
1460         else if (!strncmp(host, "ip4:", 4))
1461                 host += 4;
1462         else if (!strncmp(host, "ip6:", 4)) {
1463                 host += 4;
1464                 *ipv6 = 1;
1465         } else if (host[0] == ':') {
1466                 /* String is :port */
1467                 host++;
1468                 lport = atoi(host);
1469                 if (!lport || lport > 65535) {
1470                         log_err("fio: bad server port %u\n", lport);
1471                         return 1;
1472                 }
1473                 /* no hostname given, we are done */
1474                 *port = lport;
1475                 return 0;
1476         }
1477
1478         /*
1479          * If no port seen yet, check if there's a last ':' at the end
1480          */
1481         if (!lport) {
1482                 portp = strchr(host, ',');
1483                 if (portp) {
1484                         *portp = '\0';
1485                         portp++;
1486                         lport = atoi(portp);
1487                         if (!lport || lport > 65535) {
1488                                 log_err("fio: bad server port %u\n", lport);
1489                                 return 1;
1490                         }
1491                 }
1492         }
1493
1494         if (lport)
1495                 *port = lport;
1496
1497         if (!strlen(host))
1498                 return 0;
1499
1500         *ptr = strdup(host);
1501
1502         if (fio_server_parse_host(*ptr, ipv6, inp, inp6)) {
1503                 free(*ptr);
1504                 *ptr = NULL;
1505                 return 1;
1506         }
1507
1508         if (*port == 0)
1509                 *port = fio_net_port;
1510
1511         return 0;
1512 }
1513
1514 /*
1515  * Server arg should be one of:
1516  *
1517  * sock:/path/to/socket
1518  *   ip:1.2.3.4
1519  *      1.2.3.4
1520  *
1521  * Where sock uses unix domain sockets, and ip binds the server to
1522  * a specific interface. If no arguments are given to the server, it
1523  * uses IP and binds to 0.0.0.0.
1524  *
1525  */
1526 static int fio_handle_server_arg(void)
1527 {
1528         int port = fio_net_port;
1529         int is_sock, ret = 0;
1530
1531         saddr_in.sin_addr.s_addr = htonl(INADDR_ANY);
1532
1533         if (!fio_server_arg)
1534                 goto out;
1535
1536         ret = fio_server_parse_string(fio_server_arg, &bind_sock, &is_sock,
1537                                         &port, &saddr_in.sin_addr,
1538                                         &saddr_in6.sin6_addr, &use_ipv6);
1539
1540         if (!is_sock && bind_sock) {
1541                 free(bind_sock);
1542                 bind_sock = NULL;
1543         }
1544
1545 out:
1546         fio_net_port = port;
1547         saddr_in.sin_port = htons(port);
1548         saddr_in6.sin6_port = htons(port);
1549         return ret;
1550 }
1551
1552 static int fio_server(void)
1553 {
1554         int sk, ret;
1555
1556         dprint(FD_NET, "starting server\n");
1557
1558         if (fio_handle_server_arg())
1559                 return -1;
1560
1561         sk = fio_init_server_connection();
1562         if (sk < 0)
1563                 return -1;
1564
1565         ret = accept_loop(sk);
1566
1567         close(sk);
1568
1569         if (fio_server_arg) {
1570                 free(fio_server_arg);
1571                 fio_server_arg = NULL;
1572         }
1573         if (bind_sock)
1574                 free(bind_sock);
1575
1576         return ret;
1577 }
1578
1579 void fio_server_got_signal(int signal)
1580 {
1581         if (signal == SIGPIPE)
1582                 server_fd = -1;
1583         else {
1584                 log_info("\nfio: terminating on signal %d\n", signal);
1585                 exit_backend = 1;
1586         }
1587 }
1588
1589 static int check_existing_pidfile(const char *pidfile)
1590 {
1591         struct stat sb;
1592         char buf[16];
1593         pid_t pid;
1594         FILE *f;
1595
1596         if (stat(pidfile, &sb))
1597                 return 0;
1598
1599         f = fopen(pidfile, "r");
1600         if (!f)
1601                 return 0;
1602
1603         if (fread(buf, sb.st_size, 1, f) <= 0) {
1604                 fclose(f);
1605                 return 1;
1606         }
1607         fclose(f);
1608
1609         pid = atoi(buf);
1610         if (kill(pid, SIGCONT) < 0)
1611                 return errno != ESRCH;
1612
1613         return 1;
1614 }
1615
1616 static int write_pid(pid_t pid, const char *pidfile)
1617 {
1618         FILE *fpid;
1619
1620         fpid = fopen(pidfile, "w");
1621         if (!fpid) {
1622                 log_err("fio: failed opening pid file %s\n", pidfile);
1623                 return 1;
1624         }
1625
1626         fprintf(fpid, "%u\n", (unsigned int) pid);
1627         fclose(fpid);
1628         return 0;
1629 }
1630
1631 /*
1632  * If pidfile is specified, background us.
1633  */
1634 int fio_start_server(char *pidfile)
1635 {
1636         pid_t pid;
1637         int ret;
1638
1639 #if defined(WIN32)
1640         WSADATA wsd;
1641         WSAStartup(MAKEWORD(2, 2), &wsd);
1642 #endif
1643
1644         if (!pidfile)
1645                 return fio_server();
1646
1647         if (check_existing_pidfile(pidfile)) {
1648                 log_err("fio: pidfile %s exists and server appears alive\n",
1649                                                                 pidfile);
1650                 return -1;
1651         }
1652
1653         pid = fork();
1654         if (pid < 0) {
1655                 log_err("fio: failed server fork: %s", strerror(errno));
1656                 free(pidfile);
1657                 return -1;
1658         } else if (pid) {
1659                 int ret = write_pid(pid, pidfile);
1660
1661                 exit(ret);
1662         }
1663
1664         setsid();
1665         openlog("fio", LOG_NDELAY|LOG_NOWAIT|LOG_PID, LOG_USER);
1666         log_syslog = 1;
1667         close(STDIN_FILENO);
1668         close(STDOUT_FILENO);
1669         close(STDERR_FILENO);
1670         f_out = NULL;
1671         f_err = NULL;
1672
1673         ret = fio_server();
1674
1675         closelog();
1676         unlink(pidfile);
1677         free(pidfile);
1678         return ret;
1679 }
1680
1681 void fio_server_set_arg(const char *arg)
1682 {
1683         fio_server_arg = strdup(arg);
1684 }