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
  20 #include "fio.h"
  21 #include "server.h"
  22 #include "crc/crc16.h"
  23 #include "lib/ieee754.h"
  24
  25 int fio_net_port = 8765;
  26
  27 int exit_backend = 0;
  28
  29 static int server_fd = -1;
  30 static char *fio_server_arg;
  31 static char *bind_sock;
  32 static struct sockaddr_in saddr_in;
  33 static struct sockaddr_in6 saddr_in6;
  34 static int first_cmd_check;
  35 static int use_ipv6;
  36
  37 static const char *fio_server_ops[FIO_NET_CMD_NR] = {
  38         "",
  39         "QUIT",
  40         "EXIT",
  41         "JOB",
  42         "JOBLINE",
  43         "TEXT",
  44         "TS",
  45         "GS",
  46         "SEND_ETA",
  47         "ETA",
  48         "PROBE",
  49         "START",
  50         "STOP",
  51         "DISK_UTIL",
  52         "RUN",
  53 };
  54
  55 const char *fio_server_op(unsigned int op)
  56 {
  57         static char buf[32];
  58
  59         if (op < FIO_NET_CMD_NR)
  60                 return fio_server_ops[op];
  61
  62         sprintf(buf, "UNKNOWN/%d", op);
  63         return buf;
  64 }
  65
  66 int fio_send_data(int sk, const void *p, unsigned int len)
  67 {
  68         assert(len <= sizeof(struct fio_net_cmd) + FIO_SERVER_MAX_PDU);
  69
  70         do {
  71                 int ret = send(sk, p, len, 0);
  72
  73                 if (ret > 0) {
  74                         len -= ret;
  75                         if (!len)
  76                                 break;
  77                         p += ret;
  78                         continue;
  79                 } else if (!ret)
  80                         break;
  81                 else if (errno == EAGAIN || errno == EINTR)
  82                         continue;
  83                 else
  84                         break;
  85         } while (!exit_backend);
  86
  87         if (!len)
  88                 return 0;
  89
  90         return 1;
  91 }
  92
  93 int fio_recv_data(int sk, void *p, unsigned int len)
  94 {
  95         do {
  96                 int ret = recv(sk, p, len, MSG_WAITALL);
  97
  98                 if (ret > 0) {
  99                         len -= ret;
 100                         if (!len)
 101                                 break;
 102                         p += ret;
 103                         continue;
 104                 } else if (!ret)
 105                         break;
 106                 else if (errno == EAGAIN || errno == EINTR)
 107                         continue;
 108                 else
 109                         break;
 110         } while (!exit_backend);
 111
 112         if (!len)
 113                 return 0;
 114
 115         return -1;
 116 }
 117
 118 static int verify_convert_cmd(struct fio_net_cmd *cmd)
 119 {
 120         uint16_t crc;
 121
 122         cmd->cmd_crc16 = le16_to_cpu(cmd->cmd_crc16);
 123         cmd->pdu_crc16 = le16_to_cpu(cmd->pdu_crc16);
 124
 125         crc = fio_crc16(cmd, FIO_NET_CMD_CRC_SZ);
 126         if (crc != cmd->cmd_crc16) {
 127                 log_err("fio: server bad crc on command (got %x, wanted %x)\n",
 128                                 cmd->cmd_crc16, crc);
 129                 return 1;
 130         }
 131
 132         cmd->version    = le16_to_cpu(cmd->version);
 133         cmd->opcode     = le16_to_cpu(cmd->opcode);
 134         cmd->flags      = le32_to_cpu(cmd->flags);
 135         cmd->tag        = le64_to_cpu(cmd->tag);
 136         cmd->pdu_len    = le32_to_cpu(cmd->pdu_len);
 137
 138         switch (cmd->version) {
 139         case FIO_SERVER_VER:
 140                 break;
 141         default:
 142                 log_err("fio: bad server cmd version %d\n", cmd->version);
 143                 return 1;
 144         }
 145
 146         if (cmd->pdu_len > FIO_SERVER_MAX_PDU) {
 147                 log_err("fio: command payload too large: %u\n", cmd->pdu_len);
 148                 return 1;
 149         }
 150
 151         return 0;
 152 }
 153
 154 /*
 155  * Read (and defragment, if necessary) incoming commands
 156  */
 157 struct fio_net_cmd *fio_net_recv_cmd(int sk)
 158 {
 159         struct fio_net_cmd cmd, *cmdret = NULL;
 160         size_t cmd_size = 0, pdu_offset = 0;
 161         uint16_t crc;
 162         int ret, first = 1;
 163         void *pdu = NULL;
 164
 165         do {
 166                 ret = fio_recv_data(sk, &cmd, sizeof(cmd));
 167                 if (ret)
 168                         break;
 169
 170                 /* We have a command, verify it and swap if need be */
 171                 ret = verify_convert_cmd(&cmd);
 172                 if (ret)
 173                         break;
 174
 175                 if (first) {
 176                         /* if this is text, add room for \0 at the end */
 177                         cmd_size = sizeof(cmd) + cmd.pdu_len + 1;
 178                         assert(!cmdret);
 179                 } else
 180                         cmd_size += cmd.pdu_len;
 181
 182                 cmdret = realloc(cmdret, cmd_size);
 183
 184                 if (first)
 185                         memcpy(cmdret, &cmd, sizeof(cmd));
 186                 else if (cmdret->opcode != cmd.opcode) {
 187                         log_err("fio: fragment opcode mismatch (%d != %d)\n",
 188                                         cmdret->opcode, cmd.opcode);
 189                         ret = 1;
 190                         break;
 191                 }
 192
 193                 if (!cmd.pdu_len)
 194                         break;
 195
 196                 /* There's payload, get it */
 197                 pdu = (void *) cmdret->payload + pdu_offset;
 198                 ret = fio_recv_data(sk, pdu, cmd.pdu_len);
 199                 if (ret)
 200                         break;
 201
 202                 /* Verify payload crc */
 203                 crc = fio_crc16(pdu, cmd.pdu_len);
 204                 if (crc != cmd.pdu_crc16) {
 205                         log_err("fio: server bad crc on payload ");
 206                         log_err("(got %x, wanted %x)\n", cmd.pdu_crc16, crc);
 207                         ret = 1;
 208                         break;
 209                 }
 210
 211                 pdu_offset += cmd.pdu_len;
 212                 if (!first)
 213                         cmdret->pdu_len += cmd.pdu_len;
 214                 first = 0;
 215         } while (cmd.flags & FIO_NET_CMD_F_MORE);
 216
 217         if (ret) {
 218                 free(cmdret);
 219                 cmdret = NULL;
 220         } else if (cmdret) {
 221                 /* zero-terminate text input */
 222                 if (cmdret->pdu_len && (cmdret->opcode == FIO_NET_CMD_TEXT ||
 223                     cmdret->opcode == FIO_NET_CMD_JOB)) {
 224                         char *buf = (char *) cmdret->payload;
 225
 226                         buf[cmdret->pdu_len ] = '\0';
 227                 }
 228                 /* frag flag is internal */
 229                 cmdret->flags &= ~FIO_NET_CMD_F_MORE;
 230         }
 231
 232         return cmdret;
 233 }
 234
 235 void fio_net_cmd_crc(struct fio_net_cmd *cmd)
 236 {
 237         uint32_t pdu_len;
 238
 239         cmd->cmd_crc16 = __cpu_to_le16(fio_crc16(cmd, FIO_NET_CMD_CRC_SZ));
 240
 241         pdu_len = le32_to_cpu(cmd->pdu_len);
 242         if (pdu_len)
 243                 cmd->pdu_crc16 = __cpu_to_le16(fio_crc16(cmd->payload, pdu_len));
 244 }
 245
 246 int fio_net_send_cmd(int fd, uint16_t opcode, const void *buf, off_t size,
 247                      uint64_t tag)
 248 {
 249         struct fio_net_cmd *cmd = NULL;
 250         size_t this_len, cur_len = 0;
 251         int ret;
 252
 253         do {
 254                 this_len = size;
 255                 if (this_len > FIO_SERVER_MAX_PDU)
 256                         this_len = FIO_SERVER_MAX_PDU;
 257
 258                 if (!cmd || cur_len < sizeof(*cmd) + this_len) {
 259                         if (cmd)
 260                                 free(cmd);
 261
 262                         cur_len = sizeof(*cmd) + this_len;
 263                         cmd = malloc(cur_len);
 264                 }
 265
 266                 fio_init_net_cmd(cmd, opcode, buf, this_len, tag);
 267
 268                 if (this_len < size)
 269                         cmd->flags = __cpu_to_le32(FIO_NET_CMD_F_MORE);
 270
 271                 fio_net_cmd_crc(cmd);
 272
 273                 ret = fio_send_data(fd, cmd, sizeof(*cmd) + this_len);
 274                 size -= this_len;
 275                 buf += this_len;
 276         } while (!ret && size);
 277
 278         if (cmd)
 279                 free(cmd);
 280
 281         return ret;
 282 }
 283
 284 static int fio_net_send_simple_stack_cmd(int sk, uint16_t opcode, uint64_t tag)
 285 {
 286         struct fio_net_cmd cmd;
 287
 288         fio_init_net_cmd(&cmd, opcode, NULL, 0, tag);
 289         fio_net_cmd_crc(&cmd);
 290
 291         return fio_send_data(sk, &cmd, sizeof(cmd));
 292 }
 293
 294 /*
 295  * If 'list' is non-NULL, then allocate and store the sent command for
 296  * later verification.
 297  */
 298 int fio_net_send_simple_cmd(int sk, uint16_t opcode, uint64_t tag,
 299                             struct flist_head *list)
 300 {
 301         struct fio_net_int_cmd *cmd;
 302         int ret;
 303
 304         if (!list)
 305                 return fio_net_send_simple_stack_cmd(sk, opcode, tag);
 306
 307         cmd = malloc(sizeof(*cmd));
 308
 309         fio_init_net_cmd(&cmd->cmd, opcode, NULL, 0, (uintptr_t) cmd);
 310         fio_net_cmd_crc(&cmd->cmd);
 311
 312         INIT_FLIST_HEAD(&cmd->list);
 313         fio_gettime(&cmd->tv, NULL);
 314         cmd->saved_tag = tag;
 315
 316         ret = fio_send_data(sk, &cmd->cmd, sizeof(cmd->cmd));
 317         if (ret) {
 318                 free(cmd);
 319                 return ret;
 320         }
 321
 322         flist_add_tail(&cmd->list, list);
 323         return 0;
 324 }
 325
 326 static int fio_server_send_quit_cmd(void)
 327 {
 328         dprint(FD_NET, "server: sending quit\n");
 329         return fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_QUIT, 0, NULL);
 330 }
 331
 332 static int handle_job_cmd(struct fio_net_cmd *cmd)
 333 {
 334         char *buf = (char *) cmd->payload;
 335         struct cmd_start_pdu spdu;
 336         struct cmd_end_pdu epdu;
 337         int ret;
 338
 339         if (parse_jobs_ini(buf, 1, 0)) {
 340                 fio_server_send_quit_cmd();
 341                 return -1;
 342         }
 343
 344         spdu.jobs = cpu_to_le32(thread_number);
 345         spdu.stat_outputs = cpu_to_le32(stat_number);
 346         fio_net_send_cmd(server_fd, FIO_NET_CMD_START, &spdu, sizeof(spdu), 0);
 347
 348         ret = fio_backend();
 349
 350         epdu.error = ret;
 351         fio_net_send_cmd(server_fd, FIO_NET_CMD_STOP, &epdu, sizeof(epdu), 0);
 352
 353         fio_server_send_quit_cmd();
 354         reset_fio_state();
 355         return ret;
 356 }
 357
 358 static int handle_jobline_cmd(struct fio_net_cmd *cmd)
 359 {
 360         void *pdu = cmd->payload;
 361         struct cmd_single_line_pdu *cslp;
 362         struct cmd_line_pdu *clp;
 363         unsigned long offset;
 364         char **argv;
 365         int ret, i;
 366
 367         clp = pdu;
 368         clp->lines = le16_to_cpu(clp->lines);
 369         argv = malloc(clp->lines * sizeof(char *));
 370         offset = sizeof(*clp);
 371
 372         dprint(FD_NET, "server: %d command line args\n", clp->lines);
 373
 374         for (i = 0; i < clp->lines; i++) {
 375                 cslp = pdu + offset;
 376                 argv[i] = (char *) cslp->text;
 377
 378                 offset += sizeof(*cslp) + le16_to_cpu(cslp->len);
 379                 dprint(FD_NET, "server: %d: %s\n", i, argv[i]);
 380         }
 381
 382         if (parse_cmd_line(clp->lines, argv)) {
 383                 fio_server_send_quit_cmd();
 384                 free(argv);
 385                 return -1;
 386         }
 387
 388         free(argv);
 389
 390         fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_START, 0, NULL);
 391
 392         ret = fio_backend();
 393         fio_server_send_quit_cmd();
 394         reset_fio_state();
 395         return ret;
 396 }
 397
 398 static int handle_probe_cmd(struct fio_net_cmd *cmd)
 399 {
 400         struct cmd_probe_pdu probe;
 401
 402         dprint(FD_NET, "server: sending probe reply\n");
 403
 404         memset(&probe, 0, sizeof(probe));
 405         gethostname((char *) probe.hostname, sizeof(probe.hostname));
 406 #ifdef CONFIG_BIG_ENDIAN
 407         probe.bigendian = 1;
 408 #endif
 409         strncpy((char *) probe.fio_version, fio_version_string, sizeof(probe.fio_version));
 410
 411         probe.os        = FIO_OS;
 412         probe.arch      = FIO_ARCH;
 413
 414         probe.bpp       = sizeof(void *);
 415
 416         return fio_net_send_cmd(server_fd, FIO_NET_CMD_PROBE, &probe, sizeof(probe), cmd->tag);
 417 }
 418
 419 static int handle_send_eta_cmd(struct fio_net_cmd *cmd)
 420 {
 421         struct jobs_eta *je;
 422         size_t size;
 423         int i;
 424
 425         if (!thread_number)
 426                 return 0;
 427
 428         size = sizeof(*je) + thread_number * sizeof(char) + 1;
 429         je = malloc(size);
 430         memset(je, 0, size);
 431
 432         if (!calc_thread_status(je, 1)) {
 433                 free(je);
 434                 return 0;
 435         }
 436
 437         dprint(FD_NET, "server sending status\n");
 438
 439         je->nr_running          = cpu_to_le32(je->nr_running);
 440         je->nr_ramp             = cpu_to_le32(je->nr_ramp);
 441         je->nr_pending          = cpu_to_le32(je->nr_pending);
 442         je->files_open          = cpu_to_le32(je->files_open);
 443         je->m_rate              = cpu_to_le32(je->m_rate);
 444         je->t_rate              = cpu_to_le32(je->t_rate);
 445         je->m_iops              = cpu_to_le32(je->m_iops);
 446         je->t_iops              = cpu_to_le32(je->t_iops);
 447
 448         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 449                 je->rate[i]     = cpu_to_le32(je->rate[i]);
 450                 je->iops[i]     = cpu_to_le32(je->iops[i]);
 451         }
 452
 453         je->elapsed_sec         = cpu_to_le64(je->elapsed_sec);
 454         je->eta_sec             = cpu_to_le64(je->eta_sec);
 455         je->is_pow2             = cpu_to_le32(je->is_pow2);
 456
 457         fio_net_send_cmd(server_fd, FIO_NET_CMD_ETA, je, size, cmd->tag);
 458         free(je);
 459         return 0;
 460 }
 461
 462 static int handle_command(struct fio_net_cmd *cmd)
 463 {
 464         int ret;
 465
 466         dprint(FD_NET, "server: got op [%s], pdu=%u, tag=%llx\n",
 467                         fio_server_op(cmd->opcode), cmd->pdu_len,
 468                         (unsigned long long) cmd->tag);
 469
 470         switch (cmd->opcode) {
 471         case FIO_NET_CMD_QUIT:
 472                 fio_terminate_threads(TERMINATE_ALL);
 473                 return -1;
 474         case FIO_NET_CMD_EXIT:
 475                 exit_backend = 1;
 476                 return -1;
 477         case FIO_NET_CMD_JOB:
 478                 ret = handle_job_cmd(cmd);
 479                 break;
 480         case FIO_NET_CMD_JOBLINE:
 481                 ret = handle_jobline_cmd(cmd);
 482                 break;
 483         case FIO_NET_CMD_PROBE:
 484                 ret = handle_probe_cmd(cmd);
 485                 break;
 486         case FIO_NET_CMD_SEND_ETA:
 487                 ret = handle_send_eta_cmd(cmd);
 488                 break;
 489         default:
 490                 log_err("fio: unknown opcode: %s\n",fio_server_op(cmd->opcode));
 491                 ret = 1;
 492         }
 493
 494         return ret;
 495 }
 496
 497 static int handle_connection(int sk, int block)
 498 {
 499         struct fio_net_cmd *cmd = NULL;
 500         int ret = 0;
 501
 502         /* read forever */
 503         while (!exit_backend) {
 504                 struct pollfd pfd = {
 505                         .fd     = sk,
 506                         .events = POLLIN,
 507                 };
 508
 509                 ret = 0;
 510                 do {
 511                         ret = poll(&pfd, 1, 100);
 512                         if (ret < 0) {
 513                                 if (errno == EINTR)
 514                                         break;
 515                                 log_err("fio: poll: %s\n", strerror(errno));
 516                                 break;
 517                         } else if (!ret) {
 518                                 if (!block)
 519                                         return 0;
 520                                 continue;
 521                         }
 522
 523                         if (pfd.revents & POLLIN)
 524                                 break;
 525                         if (pfd.revents & (POLLERR|POLLHUP)) {
 526                                 ret = 1;
 527                                 break;
 528                         }
 529                 } while (!exit_backend);
 530
 531                 if (ret < 0)
 532                         break;
 533
 534                 cmd = fio_net_recv_cmd(sk);
 535                 if (!cmd) {
 536                         ret = -1;
 537                         break;
 538                 }
 539
 540                 ret = handle_command(cmd);
 541                 if (ret)
 542                         break;
 543
 544                 free(cmd);
 545                 cmd = NULL;
 546         }
 547
 548         if (cmd)
 549                 free(cmd);
 550
 551         return ret;
 552 }
 553
 554 void fio_server_idle_loop(void)
 555 {
 556         if (!first_cmd_check)
 557                 fio_net_send_simple_cmd(server_fd, FIO_NET_CMD_RUN, 0, NULL);
 558         if (server_fd != -1)
 559                 handle_connection(server_fd, 0);
 560 }
 561
 562 static int accept_loop(int listen_sk)
 563 {
 564         struct sockaddr_in addr;
 565         socklen_t len = sizeof(addr);
 566         struct pollfd pfd;
 567         int ret, sk, flags, exitval = 0;
 568
 569         dprint(FD_NET, "server enter accept loop\n");
 570
 571         flags = fcntl(listen_sk, F_GETFL);
 572         flags |= O_NONBLOCK;
 573         fcntl(listen_sk, F_SETFL, flags);
 574 again:
 575         pfd.fd = listen_sk;
 576         pfd.events = POLLIN;
 577         do {
 578                 ret = poll(&pfd, 1, 100);
 579                 if (ret < 0) {
 580                         if (errno == EINTR)
 581                                 break;
 582                         log_err("fio: poll: %s\n", strerror(errno));
 583                         goto out;
 584                 } else if (!ret)
 585                         continue;
 586
 587                 if (pfd.revents & POLLIN)
 588                         break;
 589         } while (!exit_backend);
 590
 591         if (exit_backend)
 592                 goto out;
 593
 594         sk = accept(listen_sk, (struct sockaddr *) &addr, &len);
 595         if (sk < 0) {
 596                 log_err("fio: accept: %s\n", strerror(errno));
 597                 return -1;
 598         }
 599
 600         dprint(FD_NET, "server: connect from %s\n", inet_ntoa(addr.sin_addr));
 601
 602         server_fd = sk;
 603
 604         exitval = handle_connection(sk, 1);
 605
 606         server_fd = -1;
 607         close(sk);
 608
 609         if (!exit_backend)
 610                 goto again;
 611
 612 out:
 613         return exitval;
 614 }
 615
 616 int fio_server_text_output(const char *buf, size_t len)
 617 {
 618         if (server_fd != -1)
 619                 return fio_net_send_cmd(server_fd, FIO_NET_CMD_TEXT, buf, len, 0);
 620
 621         return log_local_buf(buf, len);
 622 }
 623
 624 static void convert_io_stat(struct io_stat *dst, struct io_stat *src)
 625 {
 626         dst->max_val    = cpu_to_le64(src->max_val);
 627         dst->min_val    = cpu_to_le64(src->min_val);
 628         dst->samples    = cpu_to_le64(src->samples);
 629
 630         /*
 631          * Encode to IEEE 754 for network transfer
 632          */
 633         dst->mean.u.i   = __cpu_to_le64(fio_double_to_uint64(src->mean.u.f));
 634         dst->S.u.i      = __cpu_to_le64(fio_double_to_uint64(src->S.u.f));
 635 }
 636
 637 static void convert_gs(struct group_run_stats *dst, struct group_run_stats *src)
 638 {
 639         int i;
 640
 641         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 642                 dst->max_run[i]         = cpu_to_le64(src->max_run[i]);
 643                 dst->min_run[i]         = cpu_to_le64(src->min_run[i]);
 644                 dst->max_bw[i]          = cpu_to_le64(src->max_bw[i]);
 645                 dst->min_bw[i]          = cpu_to_le64(src->min_bw[i]);
 646                 dst->io_kb[i]           = cpu_to_le64(src->io_kb[i]);
 647                 dst->agg[i]             = cpu_to_le64(src->agg[i]);
 648         }
 649
 650         dst->kb_base    = cpu_to_le32(src->kb_base);
 651         dst->unit_base  = cpu_to_le32(src->unit_base);
 652         dst->groupid    = cpu_to_le32(src->groupid);
 653         dst->unified_rw_rep     = cpu_to_le32(src->unified_rw_rep);
 654 }
 655
 656 /*
 657  * Send a CMD_TS, which packs struct thread_stat and group_run_stats
 658  * into a single payload.
 659  */
 660 void fio_server_send_ts(struct thread_stat *ts, struct group_run_stats *rs)
 661 {
 662         struct cmd_ts_pdu p;
 663         int i, j;
 664
 665         dprint(FD_NET, "server sending end stats\n");
 666
 667         memset(&p, 0, sizeof(p));
 668
 669         strcpy(p.ts.name, ts->name);
 670         strcpy(p.ts.verror, ts->verror);
 671         strcpy(p.ts.description, ts->description);
 672
 673         p.ts.error      = cpu_to_le32(ts->error);
 674         p.ts.groupid    = cpu_to_le32(ts->groupid);
 675         p.ts.unified_rw_rep     = cpu_to_le32(ts->unified_rw_rep);
 676         p.ts.pid        = cpu_to_le32(ts->pid);
 677         p.ts.members    = cpu_to_le32(ts->members);
 678         p.ts.unified_rw_rep     = cpu_to_le32(ts->unified_rw_rep);
 679
 680         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 681                 convert_io_stat(&p.ts.clat_stat[i], &ts->clat_stat[i]);
 682                 convert_io_stat(&p.ts.slat_stat[i], &ts->slat_stat[i]);
 683                 convert_io_stat(&p.ts.lat_stat[i], &ts->lat_stat[i]);
 684                 convert_io_stat(&p.ts.bw_stat[i], &ts->bw_stat[i]);
 685         }
 686
 687         p.ts.usr_time           = cpu_to_le64(ts->usr_time);
 688         p.ts.sys_time           = cpu_to_le64(ts->sys_time);
 689         p.ts.ctx                = cpu_to_le64(ts->ctx);
 690         p.ts.minf               = cpu_to_le64(ts->minf);
 691         p.ts.majf               = cpu_to_le64(ts->majf);
 692         p.ts.clat_percentiles   = cpu_to_le64(ts->clat_percentiles);
 693
 694         for (i = 0; i < FIO_IO_U_LIST_MAX_LEN; i++) {
 695                 fio_fp64_t *src = &ts->percentile_list[i];
 696                 fio_fp64_t *dst = &p.ts.percentile_list[i];
 697
 698                 dst->u.i = __cpu_to_le64(fio_double_to_uint64(src->u.f));
 699         }
 700
 701         for (i = 0; i < FIO_IO_U_MAP_NR; i++) {
 702                 p.ts.io_u_map[i]        = cpu_to_le32(ts->io_u_map[i]);
 703                 p.ts.io_u_submit[i]     = cpu_to_le32(ts->io_u_submit[i]);
 704                 p.ts.io_u_complete[i]   = cpu_to_le32(ts->io_u_complete[i]);
 705         }
 706
 707         for (i = 0; i < FIO_IO_U_LAT_U_NR; i++) {
 708                 p.ts.io_u_lat_u[i]      = cpu_to_le32(ts->io_u_lat_u[i]);
 709                 p.ts.io_u_lat_m[i]      = cpu_to_le32(ts->io_u_lat_m[i]);
 710         }
 711
 712         for (i = 0; i < DDIR_RWDIR_CNT; i++)
 713                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++)
 714                         p.ts.io_u_plat[i][j] = cpu_to_le32(ts->io_u_plat[i][j]);
 715
 716         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 717                 p.ts.total_io_u[i]      = cpu_to_le64(ts->total_io_u[i]);
 718                 p.ts.short_io_u[i]      = cpu_to_le64(ts->short_io_u[i]);
 719         }
 720
 721         p.ts.total_submit       = cpu_to_le64(ts->total_submit);
 722         p.ts.total_complete     = cpu_to_le64(ts->total_complete);
 723
 724         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 725                 p.ts.io_bytes[i]        = cpu_to_le64(ts->io_bytes[i]);
 726                 p.ts.runtime[i]         = cpu_to_le64(ts->runtime[i]);
 727         }
 728
 729         p.ts.total_run_time     = cpu_to_le64(ts->total_run_time);
 730         p.ts.continue_on_error  = cpu_to_le16(ts->continue_on_error);
 731         p.ts.total_err_count    = cpu_to_le64(ts->total_err_count);
 732         p.ts.first_error        = cpu_to_le32(ts->first_error);
 733         p.ts.kb_base            = cpu_to_le32(ts->kb_base);
 734         p.ts.unit_base          = cpu_to_le32(ts->unit_base);
 735
 736         convert_gs(&p.rs, rs);
 737
 738         fio_net_send_cmd(server_fd, FIO_NET_CMD_TS, &p, sizeof(p), 0);
 739 }
 740
 741 void fio_server_send_gs(struct group_run_stats *rs)
 742 {
 743         struct group_run_stats gs;
 744
 745         dprint(FD_NET, "server sending group run stats\n");
 746
 747         convert_gs(&gs, rs);
 748         fio_net_send_cmd(server_fd, FIO_NET_CMD_GS, &gs, sizeof(gs), 0);
 749 }
 750
 751 static void convert_agg(struct disk_util_agg *dst, struct disk_util_agg *src)
 752 {
 753         int i;
 754
 755         for (i = 0; i < 2; i++) {
 756                 dst->ios[i]     = cpu_to_le32(src->ios[i]);
 757                 dst->merges[i]  = cpu_to_le32(src->merges[i]);
 758                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
 759                 dst->ticks[i]   = cpu_to_le32(src->ticks[i]);
 760         }
 761
 762         dst->io_ticks           = cpu_to_le32(src->io_ticks);
 763         dst->time_in_queue      = cpu_to_le32(src->time_in_queue);
 764         dst->slavecount         = cpu_to_le32(src->slavecount);
 765         dst->max_util.u.i       = __cpu_to_le64(fio_double_to_uint64(src->max_util.u.f));
 766 }
 767
 768 static void convert_dus(struct disk_util_stat *dst, struct disk_util_stat *src)
 769 {
 770         int i;
 771
 772         strcpy((char *) dst->name, (char *) src->name);
 773
 774         for (i = 0; i < 2; i++) {
 775                 dst->ios[i]     = cpu_to_le32(src->ios[i]);
 776                 dst->merges[i]  = cpu_to_le32(src->merges[i]);
 777                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
 778                 dst->ticks[i]   = cpu_to_le32(src->ticks[i]);
 779         }
 780
 781         dst->io_ticks           = cpu_to_le32(src->io_ticks);
 782         dst->time_in_queue      = cpu_to_le32(src->time_in_queue);
 783         dst->msec               = cpu_to_le64(src->msec);
 784 }
 785
 786 void fio_server_send_du(void)
 787 {
 788         struct disk_util *du;
 789         struct flist_head *entry;
 790         struct cmd_du_pdu pdu;
 791
 792         dprint(FD_NET, "server: sending disk_util %d\n", !flist_empty(&disk_list));
 793
 794         memset(&pdu, 0, sizeof(pdu));
 795
 796         flist_for_each(entry, &disk_list) {
 797                 du = flist_entry(entry, struct disk_util, list);
 798
 799                 convert_dus(&pdu.dus, &du->dus);
 800                 convert_agg(&pdu.agg, &du->agg);
 801
 802                 fio_net_send_cmd(server_fd, FIO_NET_CMD_DU, &pdu, sizeof(pdu), 0);
 803         }
 804 }
 805
 806 int fio_server_log(const char *format, ...)
 807 {
 808         char buffer[1024];
 809         va_list args;
 810         size_t len;
 811
 812         dprint(FD_NET, "server log\n");
 813
 814         va_start(args, format);
 815         len = vsnprintf(buffer, sizeof(buffer), format, args);
 816         va_end(args);
 817         len = min(len, sizeof(buffer) - 1);
 818
 819         return fio_server_text_output(buffer, len);
 820 }
 821
 822 static int fio_init_server_ip(void)
 823 {
 824         struct sockaddr *addr;
 825         socklen_t socklen;
 826         int sk, opt;
 827
 828         if (use_ipv6)
 829                 sk = socket(AF_INET6, SOCK_STREAM, 0);
 830         else
 831                 sk = socket(AF_INET, SOCK_STREAM, 0);
 832
 833         if (sk < 0) {
 834                 log_err("fio: socket: %s\n", strerror(errno));
 835                 return -1;
 836         }
 837
 838         opt = 1;
 839         if (setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, (void *)&opt, sizeof(opt)) < 0) {
 840                 log_err("fio: setsockopt: %s\n", strerror(errno));
 841                 close(sk);
 842                 return -1;
 843         }
 844 #ifdef SO_REUSEPORT
 845         if (setsockopt(sk, SOL_SOCKET, SO_REUSEPORT, &opt, sizeof(opt)) < 0) {
 846                 log_err("fio: setsockopt: %s\n", strerror(errno));
 847                 close(sk);
 848                 return -1;
 849         }
 850 #endif
 851
 852         if (use_ipv6) {
 853                 addr = (struct sockaddr *) &saddr_in6;
 854                 socklen = sizeof(saddr_in6);
 855                 saddr_in6.sin6_family = AF_INET6;
 856         } else {
 857                 addr = (struct sockaddr *) &saddr_in;
 858                 socklen = sizeof(saddr_in);
 859                 saddr_in.sin_family = AF_INET;
 860         }
 861
 862         if (bind(sk, addr, socklen) < 0) {
 863                 log_err("fio: bind: %s\n", strerror(errno));
 864                 close(sk);
 865                 return -1;
 866         }
 867
 868         return sk;
 869 }
 870
 871 static int fio_init_server_sock(void)
 872 {
 873         struct sockaddr_un addr;
 874         socklen_t len;
 875         mode_t mode;
 876         int sk;
 877
 878         sk = socket(AF_UNIX, SOCK_STREAM, 0);
 879         if (sk < 0) {
 880                 log_err("fio: socket: %s\n", strerror(errno));
 881                 return -1;
 882         }
 883
 884         mode = umask(000);
 885
 886         memset(&addr, 0, sizeof(addr));
 887         addr.sun_family = AF_UNIX;
 888         strcpy(addr.sun_path, bind_sock);
 889         unlink(bind_sock);
 890
 891         len = sizeof(addr.sun_family) + strlen(bind_sock) + 1;
 892
 893         if (bind(sk, (struct sockaddr *) &addr, len) < 0) {
 894                 log_err("fio: bind: %s\n", strerror(errno));
 895                 close(sk);
 896                 return -1;
 897         }
 898
 899         umask(mode);
 900         return sk;
 901 }
 902
 903 static int fio_init_server_connection(void)
 904 {
 905         char bind_str[128];
 906         int sk;
 907
 908         dprint(FD_NET, "starting server\n");
 909
 910         if (!bind_sock)
 911                 sk = fio_init_server_ip();
 912         else
 913                 sk = fio_init_server_sock();
 914
 915         if (sk < 0)
 916                 return sk;
 917
 918         if (!bind_sock) {
 919                 char *p, port[16];
 920                 const void *src;
 921                 int af;
 922
 923                 if (use_ipv6) {
 924                         af = AF_INET6;
 925                         src = &saddr_in6.sin6_addr;
 926                 } else {
 927                         af = AF_INET;
 928                         src = &saddr_in.sin_addr;
 929                 }
 930
 931                 p = (char *) inet_ntop(af, src, bind_str, sizeof(bind_str));
 932
 933                 sprintf(port, ",%u", fio_net_port);
 934                 if (p)
 935                         strcat(p, port);
 936                 else
 937                         strcpy(bind_str, port);
 938         } else
 939                 strcpy(bind_str, bind_sock);
 940
 941         log_info("fio: server listening on %s\n", bind_str);
 942
 943         if (listen(sk, 0) < 0) {
 944                 log_err("fio: listen: %s\n", strerror(errno));
 945                 return -1;
 946         }
 947
 948         return sk;
 949 }
 950
 951 /*
 952  * Parse a host/ip/port string. Reads from 'str'.
 953  *
 954  * Outputs:
 955  *
 956  * For IPv4:
 957  *      *ptr is the host, *port is the port, inp is the destination.
 958  * For IPv6:
 959  *      *ptr is the host, *port is the port, inp6 is the dest, and *ipv6 is 1.
 960  * For local domain sockets:
 961  *      *ptr is the filename, *is_sock is 1.
 962  */
 963 int fio_server_parse_string(const char *str, char **ptr, int *is_sock,
 964                             int *port, struct in_addr *inp,
 965                             struct in6_addr *inp6, int *ipv6)
 966 {
 967         const char *host = str;
 968         char *portp;
 969         int ret, lport = 0;
 970
 971         *ptr = NULL;
 972         *is_sock = 0;
 973         *port = fio_net_port;
 974         *ipv6 = 0;
 975
 976         if (!strncmp(str, "sock:", 5)) {
 977                 *ptr = strdup(str + 5);
 978                 *is_sock = 1;
 979
 980                 return 0;
 981         }
 982
 983         /*
 984          * Is it ip:<ip or host>:port
 985          */
 986         if (!strncmp(host, "ip:", 3))
 987                 host += 3;
 988         else if (!strncmp(host, "ip4:", 4))
 989                 host += 4;
 990         else if (!strncmp(host, "ip6:", 4)) {
 991                 host += 4;
 992                 *ipv6 = 1;
 993         } else if (host[0] == ':') {
 994                 /* String is :port */
 995                 host++;
 996                 lport = atoi(host);
 997                 if (!lport || lport > 65535) {
 998                         log_err("fio: bad server port %u\n", port);
 999                         return 1;
1000                 }
1001                 /* no hostname given, we are done */
1002                 *port = lport;
1003                 return 0;
1004         }
1005
1006         /*
1007          * If no port seen yet, check if there's a last ':' at the end
1008          */
1009         if (!lport) {
1010                 portp = strchr(host, ',');
1011                 if (portp) {
1012                         *portp = '\0';
1013                         portp++;
1014                         lport = atoi(portp);
1015                         if (!lport || lport > 65535) {
1016                                 log_err("fio: bad server port %u\n", port);
1017                                 return 1;
1018                         }
1019                 }
1020         }
1021
1022         if (lport)
1023                 *port = lport;
1024
1025         if (!strlen(host))
1026                 return 0;
1027
1028         *ptr = strdup(host);
1029
1030         if (*ipv6)
1031                 ret = inet_pton(AF_INET6, host, inp6);
1032         else
1033                 ret = inet_pton(AF_INET, host, inp);
1034
1035         if (ret != 1) {
1036                 struct hostent *hent;
1037
1038                 hent = gethostbyname(host);
1039                 if (!hent) {
1040                         log_err("fio: failed to resolve <%s>\n", host);
1041                         free(*ptr);
1042                         *ptr = NULL;
1043                         return 1;
1044                 }
1045
1046                 if (*ipv6) {
1047                         if (hent->h_addrtype != AF_INET6) {
1048                                 log_info("fio: falling back to IPv4\n");
1049                                 *ipv6 = 0;
1050                         } else
1051                                 memcpy(inp6, hent->h_addr_list[0], 16);
1052                 }
1053                 if (!*ipv6) {
1054                         if (hent->h_addrtype != AF_INET) {
1055                                 log_err("fio: lookup type mismatch\n");
1056                                 free(*ptr);
1057                                 *ptr = NULL;
1058                                 return 1;
1059                         }
1060                         memcpy(inp, hent->h_addr_list[0], 4);
1061                 }
1062         }
1063
1064         if (*port == 0)
1065                 *port = fio_net_port;
1066
1067         return 0;
1068 }
1069
1070 /*
1071  * Server arg should be one of:
1072  *
1073  * sock:/path/to/socket
1074  *   ip:1.2.3.4
1075  *      1.2.3.4
1076  *
1077  * Where sock uses unix domain sockets, and ip binds the server to
1078  * a specific interface. If no arguments are given to the server, it
1079  * uses IP and binds to 0.0.0.0.
1080  *
1081  */
1082 static int fio_handle_server_arg(void)
1083 {
1084         int port = fio_net_port;
1085         int is_sock, ret = 0;
1086
1087         saddr_in.sin_addr.s_addr = htonl(INADDR_ANY);
1088
1089         if (!fio_server_arg)
1090                 goto out;
1091
1092         ret = fio_server_parse_string(fio_server_arg, &bind_sock, &is_sock,
1093                                         &port, &saddr_in.sin_addr,
1094                                         &saddr_in6.sin6_addr, &use_ipv6);
1095
1096         if (!is_sock && bind_sock) {
1097                 free(bind_sock);
1098                 bind_sock = NULL;
1099         }
1100
1101 out:
1102         fio_net_port = port;
1103         saddr_in.sin_port = htons(port);
1104         saddr_in6.sin6_port = htons(port);
1105         return ret;
1106 }
1107
1108 static int fio_server(void)
1109 {
1110         int sk, ret;
1111
1112         dprint(FD_NET, "starting server\n");
1113
1114         if (fio_handle_server_arg())
1115                 return -1;
1116
1117         sk = fio_init_server_connection();
1118         if (sk < 0)
1119                 return -1;
1120
1121         ret = accept_loop(sk);
1122
1123         close(sk);
1124
1125         if (fio_server_arg) {
1126                 free(fio_server_arg);
1127                 fio_server_arg = NULL;
1128         }
1129         if (bind_sock)
1130                 free(bind_sock);
1131
1132         return ret;
1133 }
1134
1135 void fio_server_got_signal(int signal)
1136 {
1137         if (signal == SIGPIPE)
1138                 server_fd = -1;
1139         else {
1140                 log_info("\nfio: terminating on signal %d\n", signal);
1141                 exit_backend = 1;
1142         }
1143 }
1144
1145 static int check_existing_pidfile(const char *pidfile)
1146 {
1147         struct stat sb;
1148         char buf[16];
1149         pid_t pid;
1150         FILE *f;
1151
1152         if (stat(pidfile, &sb))
1153                 return 0;
1154
1155         f = fopen(pidfile, "r");
1156         if (!f)
1157                 return 0;
1158
1159         if (fread(buf, sb.st_size, 1, f) <= 0) {
1160                 fclose(f);
1161                 return 1;
1162         }
1163         fclose(f);
1164
1165         pid = atoi(buf);
1166         if (kill(pid, SIGCONT) < 0)
1167                 return errno != ESRCH;
1168
1169         return 1;
1170 }
1171
1172 static int write_pid(pid_t pid, const char *pidfile)
1173 {
1174         FILE *fpid;
1175
1176         fpid = fopen(pidfile, "w");
1177         if (!fpid) {
1178                 log_err("fio: failed opening pid file %s\n", pidfile);
1179                 return 1;
1180         }
1181
1182         fprintf(fpid, "%u\n", (unsigned int) pid);
1183         fclose(fpid);
1184         return 0;
1185 }
1186
1187 /*
1188  * If pidfile is specified, background us.
1189  */
1190 int fio_start_server(char *pidfile)
1191 {
1192         pid_t pid;
1193         int ret;
1194
1195 #if defined(WIN32)
1196         WSADATA wsd;
1197         WSAStartup(MAKEWORD(2,2), &wsd);
1198 #endif
1199
1200         if (!pidfile)
1201                 return fio_server();
1202
1203         if (check_existing_pidfile(pidfile)) {
1204                 log_err("fio: pidfile %s exists and server appears alive\n",
1205                                                                 pidfile);
1206                 return -1;
1207         }
1208
1209         pid = fork();
1210         if (pid < 0) {
1211                 log_err("fio: failed server fork: %s", strerror(errno));
1212                 free(pidfile);
1213                 return -1;
1214         } else if (pid) {
1215                 int ret = write_pid(pid, pidfile);
1216
1217                 exit(ret);
1218         }
1219
1220         setsid();
1221         openlog("fio", LOG_NDELAY|LOG_NOWAIT|LOG_PID, LOG_USER);
1222         log_syslog = 1;
1223         close(STDIN_FILENO);
1224         close(STDOUT_FILENO);
1225         close(STDERR_FILENO);
1226         f_out = NULL;
1227         f_err = NULL;
1228
1229         ret = fio_server();
1230
1231         closelog();
1232         unlink(pidfile);
1233         free(pidfile);
1234         return ret;
1235 }
1236
1237 void fio_server_set_arg(const char *arg)
1238 {
1239         fio_server_arg = strdup(arg);
1240 }