server.c

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