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