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