server.c

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