server.c

   1 #include <stdio.h>
   2 #include <stdlib.h>
   3 #include <unistd.h>
   4 #include <errno.h>
   5 #include <poll.h>
   6 #include <sys/types.h>
   7 #include <sys/wait.h>
   8 #include <sys/socket.h>
   9 #include <sys/stat.h>
  10 #include <sys/un.h>
  11 #include <sys/uio.h>
  12 #include <netinet/in.h>
  13 #include <arpa/inet.h>
  14 #include <netdb.h>
  15 #include <syslog.h>
  16 #include <signal.h>
  17 #ifdef CONFIG_ZLIB
  18 #include <zlib.h>
  19 #endif
  20
  21 #include "fio.h"
  22 #include "options.h"
  23 #include "server.h"
  24 #include "crc/crc16.h"
  25 #include "lib/ieee754.h"
  26 #include "verify-state.h"
  27 #include "smalloc.h"
  28
  29 int fio_net_port = FIO_NET_PORT;
  30
  31 bool exit_backend = false;
  32
  33 enum {
  34         SK_F_FREE       = 1,
  35         SK_F_COPY       = 2,
  36         SK_F_SIMPLE     = 4,
  37         SK_F_VEC        = 8,
  38         SK_F_INLINE     = 16,
  39 };
  40
  41 struct sk_entry {
  42         struct flist_head list; /* link on sk_out->list */
  43         int flags;              /* SK_F_* */
  44         int opcode;             /* Actual command fields */
  45         void *buf;
  46         off_t size;
  47         uint64_t tag;
  48         struct flist_head next; /* Other sk_entry's, if linked command */
  49 };
  50
  51 static char *fio_server_arg;
  52 static char *bind_sock;
  53 static struct sockaddr_in saddr_in;
  54 static struct sockaddr_in6 saddr_in6;
  55 static int use_ipv6;
  56 #ifdef CONFIG_ZLIB
  57 static unsigned int has_zlib = 1;
  58 #else
  59 static unsigned int has_zlib = 0;
  60 #endif
  61 static unsigned int use_zlib;
  62 static char me[128];
  63
  64 static pthread_key_t sk_out_key;
  65
  66 struct fio_fork_item {
  67         struct flist_head list;
  68         int exitval;
  69         int signal;
  70         int exited;
  71         pid_t pid;
  72 };
  73
  74 struct cmd_reply {
  75         struct fio_sem lock;
  76         void *data;
  77         size_t size;
  78         int error;
  79 };
  80
  81 static const char *fio_server_ops[FIO_NET_CMD_NR] = {
  82         "",
  83         "QUIT",
  84         "EXIT",
  85         "JOB",
  86         "JOBLINE",
  87         "TEXT",
  88         "TS",
  89         "GS",
  90         "SEND_ETA",
  91         "ETA",
  92         "PROBE",
  93         "START",
  94         "STOP",
  95         "DISK_UTIL",
  96         "SERVER_START",
  97         "ADD_JOB",
  98         "RUN",
  99         "IOLOG",
 100         "UPDATE_JOB",
 101         "LOAD_FILE",
 102         "VTRIGGER",
 103         "SENDFILE",
 104         "JOB_OPT",
 105 };
 106
 107 static void sk_lock(struct sk_out *sk_out)
 108 {
 109         fio_sem_down(&sk_out->lock);
 110 }
 111
 112 static void sk_unlock(struct sk_out *sk_out)
 113 {
 114         fio_sem_up(&sk_out->lock);
 115 }
 116
 117 void sk_out_assign(struct sk_out *sk_out)
 118 {
 119         if (!sk_out)
 120                 return;
 121
 122         sk_lock(sk_out);
 123         sk_out->refs++;
 124         sk_unlock(sk_out);
 125         pthread_setspecific(sk_out_key, sk_out);
 126 }
 127
 128 static void sk_out_free(struct sk_out *sk_out)
 129 {
 130         __fio_sem_remove(&sk_out->lock);
 131         __fio_sem_remove(&sk_out->wait);
 132         __fio_sem_remove(&sk_out->xmit);
 133         sfree(sk_out);
 134 }
 135
 136 static int __sk_out_drop(struct sk_out *sk_out)
 137 {
 138         if (sk_out) {
 139                 int refs;
 140
 141                 sk_lock(sk_out);
 142                 assert(sk_out->refs != 0);
 143                 refs = --sk_out->refs;
 144                 sk_unlock(sk_out);
 145
 146                 if (!refs) {
 147                         sk_out_free(sk_out);
 148                         pthread_setspecific(sk_out_key, NULL);
 149                         return 0;
 150                 }
 151         }
 152
 153         return 1;
 154 }
 155
 156 void sk_out_drop(void)
 157 {
 158         struct sk_out *sk_out;
 159
 160         sk_out = pthread_getspecific(sk_out_key);
 161         __sk_out_drop(sk_out);
 162 }
 163
 164 static void __fio_init_net_cmd(struct fio_net_cmd *cmd, uint16_t opcode,
 165                                uint32_t pdu_len, uint64_t tag)
 166 {
 167         memset(cmd, 0, sizeof(*cmd));
 168
 169         cmd->version    = __cpu_to_le16(FIO_SERVER_VER);
 170         cmd->opcode     = cpu_to_le16(opcode);
 171         cmd->tag        = cpu_to_le64(tag);
 172         cmd->pdu_len    = cpu_to_le32(pdu_len);
 173 }
 174
 175
 176 static void fio_init_net_cmd(struct fio_net_cmd *cmd, uint16_t opcode,
 177                              const void *pdu, uint32_t pdu_len, uint64_t tag)
 178 {
 179         __fio_init_net_cmd(cmd, opcode, pdu_len, tag);
 180
 181         if (pdu)
 182                 memcpy(&cmd->payload, pdu, pdu_len);
 183 }
 184
 185 const char *fio_server_op(unsigned int op)
 186 {
 187         static char buf[32];
 188
 189         if (op < FIO_NET_CMD_NR)
 190                 return fio_server_ops[op];
 191
 192         sprintf(buf, "UNKNOWN/%d", op);
 193         return buf;
 194 }
 195
 196 static ssize_t iov_total_len(const struct iovec *iov, int count)
 197 {
 198         ssize_t ret = 0;
 199
 200         while (count--) {
 201                 ret += iov->iov_len;
 202                 iov++;
 203         }
 204
 205         return ret;
 206 }
 207
 208 static int fio_sendv_data(int sk, struct iovec *iov, int count)
 209 {
 210         ssize_t total_len = iov_total_len(iov, count);
 211         ssize_t ret;
 212
 213         do {
 214                 ret = writev(sk, iov, count);
 215                 if (ret > 0) {
 216                         total_len -= ret;
 217                         if (!total_len)
 218                                 break;
 219
 220                         while (ret) {
 221                                 if (ret >= iov->iov_len) {
 222                                         ret -= iov->iov_len;
 223                                         iov++;
 224                                         continue;
 225                                 }
 226                                 iov->iov_base += ret;
 227                                 iov->iov_len -= ret;
 228                                 ret = 0;
 229                         }
 230                 } else if (!ret)
 231                         break;
 232                 else if (errno == EAGAIN || errno == EINTR)
 233                         continue;
 234                 else
 235                         break;
 236         } while (!exit_backend);
 237
 238         if (!total_len)
 239                 return 0;
 240
 241         return 1;
 242 }
 243
 244 static int fio_send_data(int sk, const void *p, unsigned int len)
 245 {
 246         struct iovec iov = { .iov_base = (void *) p, .iov_len = len };
 247
 248         assert(len <= sizeof(struct fio_net_cmd) + FIO_SERVER_MAX_FRAGMENT_PDU);
 249
 250         return fio_sendv_data(sk, &iov, 1);
 251 }
 252
 253 static int fio_recv_data(int sk, void *buf, unsigned int len, bool wait)
 254 {
 255         int flags;
 256         char *p = buf;
 257
 258         if (wait)
 259                 flags = MSG_WAITALL;
 260         else
 261                 flags = OS_MSG_DONTWAIT;
 262
 263         do {
 264                 int ret = recv(sk, p, len, flags);
 265
 266                 if (ret > 0) {
 267                         len -= ret;
 268                         if (!len)
 269                                 break;
 270                         p += ret;
 271                         continue;
 272                 } else if (!ret)
 273                         break;
 274                 else if (errno == EAGAIN || errno == EINTR) {
 275                         if (wait)
 276                                 continue;
 277                         break;
 278                 } else
 279                         break;
 280         } while (!exit_backend);
 281
 282         if (!len)
 283                 return 0;
 284
 285         return -1;
 286 }
 287
 288 static int verify_convert_cmd(struct fio_net_cmd *cmd)
 289 {
 290         uint16_t crc;
 291
 292         cmd->cmd_crc16 = le16_to_cpu(cmd->cmd_crc16);
 293         cmd->pdu_crc16 = le16_to_cpu(cmd->pdu_crc16);
 294
 295         crc = fio_crc16(cmd, FIO_NET_CMD_CRC_SZ);
 296         if (crc != cmd->cmd_crc16) {
 297                 log_err("fio: server bad crc on command (got %x, wanted %x)\n",
 298                                 cmd->cmd_crc16, crc);
 299                 fprintf(f_err, "fio: server bad crc on command (got %x, wanted %x)\n",
 300                                 cmd->cmd_crc16, crc);
 301                 return 1;
 302         }
 303
 304         cmd->version    = le16_to_cpu(cmd->version);
 305         cmd->opcode     = le16_to_cpu(cmd->opcode);
 306         cmd->flags      = le32_to_cpu(cmd->flags);
 307         cmd->tag        = le64_to_cpu(cmd->tag);
 308         cmd->pdu_len    = le32_to_cpu(cmd->pdu_len);
 309
 310         switch (cmd->version) {
 311         case FIO_SERVER_VER:
 312                 break;
 313         default:
 314                 log_err("fio: bad server cmd version %d\n", cmd->version);
 315                 fprintf(f_err, "fio: client/server version mismatch (%d != %d)\n",
 316                                 cmd->version, FIO_SERVER_VER);
 317                 return 1;
 318         }
 319
 320         if (cmd->pdu_len > FIO_SERVER_MAX_FRAGMENT_PDU) {
 321                 log_err("fio: command payload too large: %u\n", cmd->pdu_len);
 322                 return 1;
 323         }
 324
 325         return 0;
 326 }
 327
 328 /*
 329  * Read (and defragment, if necessary) incoming commands
 330  */
 331 struct fio_net_cmd *fio_net_recv_cmd(int sk, bool wait)
 332 {
 333         struct fio_net_cmd cmd, *tmp, *cmdret = NULL;
 334         size_t cmd_size = 0, pdu_offset = 0;
 335         uint16_t crc;
 336         int ret, first = 1;
 337         void *pdu = NULL;
 338
 339         do {
 340                 ret = fio_recv_data(sk, &cmd, sizeof(cmd), wait);
 341                 if (ret)
 342                         break;
 343
 344                 /* We have a command, verify it and swap if need be */
 345                 ret = verify_convert_cmd(&cmd);
 346                 if (ret)
 347                         break;
 348
 349                 if (first) {
 350                         /* if this is text, add room for \0 at the end */
 351                         cmd_size = sizeof(cmd) + cmd.pdu_len + 1;
 352                         assert(!cmdret);
 353                 } else
 354                         cmd_size += cmd.pdu_len;
 355
 356                 if (cmd_size / 1024 > FIO_SERVER_MAX_CMD_MB * 1024) {
 357                         log_err("fio: cmd+pdu too large (%llu)\n", (unsigned long long) cmd_size);
 358                         ret = 1;
 359                         break;
 360                 }
 361
 362                 tmp = realloc(cmdret, cmd_size);
 363                 if (!tmp) {
 364                         log_err("fio: server failed allocating cmd\n");
 365                         ret = 1;
 366                         break;
 367                 }
 368                 cmdret = tmp;
 369
 370                 if (first)
 371                         memcpy(cmdret, &cmd, sizeof(cmd));
 372                 else if (cmdret->opcode != cmd.opcode) {
 373                         log_err("fio: fragment opcode mismatch (%d != %d)\n",
 374                                         cmdret->opcode, cmd.opcode);
 375                         ret = 1;
 376                         break;
 377                 }
 378
 379                 if (!cmd.pdu_len)
 380                         break;
 381
 382                 /* There's payload, get it */
 383                 pdu = (char *) cmdret->payload + pdu_offset;
 384                 ret = fio_recv_data(sk, pdu, cmd.pdu_len, wait);
 385                 if (ret)
 386                         break;
 387
 388                 /* Verify payload crc */
 389                 crc = fio_crc16(pdu, cmd.pdu_len);
 390                 if (crc != cmd.pdu_crc16) {
 391                         log_err("fio: server bad crc on payload ");
 392                         log_err("(got %x, wanted %x)\n", cmd.pdu_crc16, crc);
 393                         ret = 1;
 394                         break;
 395                 }
 396
 397                 pdu_offset += cmd.pdu_len;
 398                 if (!first)
 399                         cmdret->pdu_len += cmd.pdu_len;
 400                 first = 0;
 401         } while (cmd.flags & FIO_NET_CMD_F_MORE);
 402
 403         if (ret) {
 404                 free(cmdret);
 405                 cmdret = NULL;
 406         } else if (cmdret) {
 407                 /* zero-terminate text input */
 408                 if (cmdret->pdu_len) {
 409                         if (cmdret->opcode == FIO_NET_CMD_TEXT) {
 410                                 struct cmd_text_pdu *__pdu = (struct cmd_text_pdu *) cmdret->payload;
 411                                 char *buf = (char *) __pdu->buf;
 412
 413                                 buf[__pdu->buf_len] = '\0';
 414                         } else if (cmdret->opcode == FIO_NET_CMD_JOB) {
 415                                 struct cmd_job_pdu *__pdu = (struct cmd_job_pdu *) cmdret->payload;
 416                                 char *buf = (char *) __pdu->buf;
 417                                 int len = le32_to_cpu(__pdu->buf_len);
 418
 419                                 buf[len] = '\0';
 420                         }
 421                 }
 422
 423                 /* frag flag is internal */
 424                 cmdret->flags &= ~FIO_NET_CMD_F_MORE;
 425         }
 426
 427         return cmdret;
 428 }
 429
 430 static void add_reply(uint64_t tag, struct flist_head *list)
 431 {
 432         struct fio_net_cmd_reply *reply;
 433
 434         reply = (struct fio_net_cmd_reply *) (uintptr_t) tag;
 435         flist_add_tail(&reply->list, list);
 436 }
 437
 438 static uint64_t alloc_reply(uint64_t tag, uint16_t opcode)
 439 {
 440         struct fio_net_cmd_reply *reply;
 441
 442         reply = calloc(1, sizeof(*reply));
 443         INIT_FLIST_HEAD(&reply->list);
 444         fio_gettime(&reply->ts, NULL);
 445         reply->saved_tag = tag;
 446         reply->opcode = opcode;
 447
 448         return (uintptr_t) reply;
 449 }
 450
 451 static void free_reply(uint64_t tag)
 452 {
 453         struct fio_net_cmd_reply *reply;
 454
 455         reply = (struct fio_net_cmd_reply *) (uintptr_t) tag;
 456         free(reply);
 457 }
 458
 459 static void fio_net_cmd_crc_pdu(struct fio_net_cmd *cmd, const void *pdu)
 460 {
 461         uint32_t pdu_len;
 462
 463         cmd->cmd_crc16 = __cpu_to_le16(fio_crc16(cmd, FIO_NET_CMD_CRC_SZ));
 464
 465         pdu_len = le32_to_cpu(cmd->pdu_len);
 466         cmd->pdu_crc16 = __cpu_to_le16(fio_crc16(pdu, pdu_len));
 467 }
 468
 469 static void fio_net_cmd_crc(struct fio_net_cmd *cmd)
 470 {
 471         fio_net_cmd_crc_pdu(cmd, cmd->payload);
 472 }
 473
 474 int fio_net_send_cmd(int fd, uint16_t opcode, const void *buf, off_t size,
 475                      uint64_t *tagptr, struct flist_head *list)
 476 {
 477         struct fio_net_cmd *cmd = NULL;
 478         size_t this_len, cur_len = 0;
 479         uint64_t tag;
 480         int ret;
 481
 482         if (list) {
 483                 assert(tagptr);
 484                 tag = *tagptr = alloc_reply(*tagptr, opcode);
 485         } else
 486                 tag = tagptr ? *tagptr : 0;
 487
 488         do {
 489                 this_len = size;
 490                 if (this_len > FIO_SERVER_MAX_FRAGMENT_PDU)
 491                         this_len = FIO_SERVER_MAX_FRAGMENT_PDU;
 492
 493                 if (!cmd || cur_len < sizeof(*cmd) + this_len) {
 494                         if (cmd)
 495                                 free(cmd);
 496
 497                         cur_len = sizeof(*cmd) + this_len;
 498                         cmd = malloc(cur_len);
 499                 }
 500
 501                 fio_init_net_cmd(cmd, opcode, buf, this_len, tag);
 502
 503                 if (this_len < size)
 504                         cmd->flags = __cpu_to_le32(FIO_NET_CMD_F_MORE);
 505
 506                 fio_net_cmd_crc(cmd);
 507
 508                 ret = fio_send_data(fd, cmd, sizeof(*cmd) + this_len);
 509                 size -= this_len;
 510                 buf += this_len;
 511         } while (!ret && size);
 512
 513         if (list) {
 514                 if (ret)
 515                         free_reply(tag);
 516                 else
 517                         add_reply(tag, list);
 518         }
 519
 520         if (cmd)
 521                 free(cmd);
 522
 523         return ret;
 524 }
 525
 526 static struct sk_entry *fio_net_prep_cmd(uint16_t opcode, void *buf,
 527                                          size_t size, uint64_t *tagptr,
 528                                          int flags)
 529 {
 530         struct sk_entry *entry;
 531
 532         entry = smalloc(sizeof(*entry));
 533         if (!entry)
 534                 return NULL;
 535
 536         INIT_FLIST_HEAD(&entry->next);
 537         entry->opcode = opcode;
 538         if (flags & SK_F_COPY) {
 539                 entry->buf = smalloc(size);
 540                 memcpy(entry->buf, buf, size);
 541         } else
 542                 entry->buf = buf;
 543
 544         entry->size = size;
 545         if (tagptr)
 546                 entry->tag = *tagptr;
 547         else
 548                 entry->tag = 0;
 549         entry->flags = flags;
 550         return entry;
 551 }
 552
 553 static int handle_sk_entry(struct sk_out *sk_out, struct sk_entry *entry);
 554
 555 static void fio_net_queue_entry(struct sk_entry *entry)
 556 {
 557         struct sk_out *sk_out = pthread_getspecific(sk_out_key);
 558
 559         if (entry->flags & SK_F_INLINE)
 560                 handle_sk_entry(sk_out, entry);
 561         else {
 562                 sk_lock(sk_out);
 563                 flist_add_tail(&entry->list, &sk_out->list);
 564                 sk_unlock(sk_out);
 565
 566                 fio_sem_up(&sk_out->wait);
 567         }
 568 }
 569
 570 static int fio_net_queue_cmd(uint16_t opcode, void *buf, off_t size,
 571                              uint64_t *tagptr, int flags)
 572 {
 573         struct sk_entry *entry;
 574
 575         entry = fio_net_prep_cmd(opcode, buf, size, tagptr, flags);
 576         if (entry) {
 577                 fio_net_queue_entry(entry);
 578                 return 0;
 579         }
 580
 581         return 1;
 582 }
 583
 584 static int fio_net_send_simple_stack_cmd(int sk, uint16_t opcode, uint64_t tag)
 585 {
 586         struct fio_net_cmd cmd;
 587
 588         fio_init_net_cmd(&cmd, opcode, NULL, 0, tag);
 589         fio_net_cmd_crc(&cmd);
 590
 591         return fio_send_data(sk, &cmd, sizeof(cmd));
 592 }
 593
 594 /*
 595  * If 'list' is non-NULL, then allocate and store the sent command for
 596  * later verification.
 597  */
 598 int fio_net_send_simple_cmd(int sk, uint16_t opcode, uint64_t tag,
 599                             struct flist_head *list)
 600 {
 601         int ret;
 602
 603         if (list)
 604                 tag = alloc_reply(tag, opcode);
 605
 606         ret = fio_net_send_simple_stack_cmd(sk, opcode, tag);
 607         if (ret) {
 608                 if (list)
 609                         free_reply(tag);
 610
 611                 return ret;
 612         }
 613
 614         if (list)
 615                 add_reply(tag, list);
 616
 617         return 0;
 618 }
 619
 620 static int fio_net_queue_quit(void)
 621 {
 622         dprint(FD_NET, "server: sending quit\n");
 623
 624         return fio_net_queue_cmd(FIO_NET_CMD_QUIT, NULL, 0, NULL, SK_F_SIMPLE);
 625 }
 626
 627 int fio_net_send_quit(int sk)
 628 {
 629         dprint(FD_NET, "server: sending quit\n");
 630
 631         return fio_net_send_simple_cmd(sk, FIO_NET_CMD_QUIT, 0, NULL);
 632 }
 633
 634 static int fio_net_send_ack(struct fio_net_cmd *cmd, int error, int signal)
 635 {
 636         struct cmd_end_pdu epdu;
 637         uint64_t tag = 0;
 638
 639         if (cmd)
 640                 tag = cmd->tag;
 641
 642         epdu.error = __cpu_to_le32(error);
 643         epdu.signal = __cpu_to_le32(signal);
 644         return fio_net_queue_cmd(FIO_NET_CMD_STOP, &epdu, sizeof(epdu), &tag, SK_F_COPY);
 645 }
 646
 647 static int fio_net_queue_stop(int error, int signal)
 648 {
 649         dprint(FD_NET, "server: sending stop (%d, %d)\n", error, signal);
 650         return fio_net_send_ack(NULL, error, signal);
 651 }
 652
 653 static void fio_server_add_fork_item(pid_t pid, struct flist_head *list)
 654 {
 655         struct fio_fork_item *ffi;
 656
 657         ffi = malloc(sizeof(*ffi));
 658         ffi->exitval = 0;
 659         ffi->signal = 0;
 660         ffi->exited = 0;
 661         ffi->pid = pid;
 662         flist_add_tail(&ffi->list, list);
 663 }
 664
 665 static void fio_server_add_conn_pid(struct flist_head *conn_list, pid_t pid)
 666 {
 667         dprint(FD_NET, "server: forked off connection job (pid=%u)\n", (int) pid);
 668         fio_server_add_fork_item(pid, conn_list);
 669 }
 670
 671 static void fio_server_add_job_pid(struct flist_head *job_list, pid_t pid)
 672 {
 673         dprint(FD_NET, "server: forked off job job (pid=%u)\n", (int) pid);
 674         fio_server_add_fork_item(pid, job_list);
 675 }
 676
 677 static void fio_server_check_fork_item(struct fio_fork_item *ffi)
 678 {
 679         int ret, status;
 680
 681         ret = waitpid(ffi->pid, &status, WNOHANG);
 682         if (ret < 0) {
 683                 if (errno == ECHILD) {
 684                         log_err("fio: connection pid %u disappeared\n", (int) ffi->pid);
 685                         ffi->exited = 1;
 686                 } else
 687                         log_err("fio: waitpid: %s\n", strerror(errno));
 688         } else if (ret == ffi->pid) {
 689                 if (WIFSIGNALED(status)) {
 690                         ffi->signal = WTERMSIG(status);
 691                         ffi->exited = 1;
 692                 }
 693                 if (WIFEXITED(status)) {
 694                         if (WEXITSTATUS(status))
 695                                 ffi->exitval = WEXITSTATUS(status);
 696                         ffi->exited = 1;
 697                 }
 698         }
 699 }
 700
 701 static void fio_server_fork_item_done(struct fio_fork_item *ffi, bool stop)
 702 {
 703         dprint(FD_NET, "pid %u exited, sig=%u, exitval=%d\n", (int) ffi->pid, ffi->signal, ffi->exitval);
 704
 705         /*
 706          * Fold STOP and QUIT...
 707          */
 708         if (stop) {
 709                 fio_net_queue_stop(ffi->exitval, ffi->signal);
 710                 fio_net_queue_quit();
 711         }
 712
 713         flist_del(&ffi->list);
 714         free(ffi);
 715 }
 716
 717 static void fio_server_check_fork_items(struct flist_head *list, bool stop)
 718 {
 719         struct flist_head *entry, *tmp;
 720         struct fio_fork_item *ffi;
 721
 722         flist_for_each_safe(entry, tmp, list) {
 723                 ffi = flist_entry(entry, struct fio_fork_item, list);
 724
 725                 fio_server_check_fork_item(ffi);
 726
 727                 if (ffi->exited)
 728                         fio_server_fork_item_done(ffi, stop);
 729         }
 730 }
 731
 732 static void fio_server_check_jobs(struct flist_head *job_list)
 733 {
 734         fio_server_check_fork_items(job_list, true);
 735 }
 736
 737 static void fio_server_check_conns(struct flist_head *conn_list)
 738 {
 739         fio_server_check_fork_items(conn_list, false);
 740 }
 741
 742 static int handle_load_file_cmd(struct fio_net_cmd *cmd)
 743 {
 744         struct cmd_load_file_pdu *pdu = (struct cmd_load_file_pdu *) cmd->payload;
 745         void *file_name = pdu->file;
 746         struct cmd_start_pdu spdu;
 747
 748         dprint(FD_NET, "server: loading local file %s\n", (char *) file_name);
 749
 750         pdu->name_len = le16_to_cpu(pdu->name_len);
 751         pdu->client_type = le16_to_cpu(pdu->client_type);
 752
 753         if (parse_jobs_ini(file_name, 0, 0, pdu->client_type)) {
 754                 fio_net_queue_quit();
 755                 return -1;
 756         }
 757
 758         spdu.jobs = cpu_to_le32(thread_number);
 759         spdu.stat_outputs = cpu_to_le32(stat_number);
 760         fio_net_queue_cmd(FIO_NET_CMD_START, &spdu, sizeof(spdu), NULL, SK_F_COPY);
 761         return 0;
 762 }
 763
 764 static int handle_run_cmd(struct sk_out *sk_out, struct flist_head *job_list,
 765                           struct fio_net_cmd *cmd)
 766 {
 767         pid_t pid;
 768         int ret;
 769
 770         sk_out_assign(sk_out);
 771
 772         fio_time_init();
 773         set_genesis_time();
 774
 775         pid = fork();
 776         if (pid) {
 777                 fio_server_add_job_pid(job_list, pid);
 778                 return 0;
 779         }
 780
 781         ret = fio_backend(sk_out);
 782         free_threads_shm();
 783         sk_out_drop();
 784         _exit(ret);
 785 }
 786
 787 static int handle_job_cmd(struct fio_net_cmd *cmd)
 788 {
 789         struct cmd_job_pdu *pdu = (struct cmd_job_pdu *) cmd->payload;
 790         void *buf = pdu->buf;
 791         struct cmd_start_pdu spdu;
 792
 793         pdu->buf_len = le32_to_cpu(pdu->buf_len);
 794         pdu->client_type = le32_to_cpu(pdu->client_type);
 795
 796         if (parse_jobs_ini(buf, 1, 0, pdu->client_type)) {
 797                 fio_net_queue_quit();
 798                 return -1;
 799         }
 800
 801         spdu.jobs = cpu_to_le32(thread_number);
 802         spdu.stat_outputs = cpu_to_le32(stat_number);
 803
 804         fio_net_queue_cmd(FIO_NET_CMD_START, &spdu, sizeof(spdu), NULL, SK_F_COPY);
 805         return 0;
 806 }
 807
 808 static int handle_jobline_cmd(struct fio_net_cmd *cmd)
 809 {
 810         void *pdu = cmd->payload;
 811         struct cmd_single_line_pdu *cslp;
 812         struct cmd_line_pdu *clp;
 813         unsigned long offset;
 814         struct cmd_start_pdu spdu;
 815         char **argv;
 816         int i;
 817
 818         clp = pdu;
 819         clp->lines = le16_to_cpu(clp->lines);
 820         clp->client_type = le16_to_cpu(clp->client_type);
 821         argv = malloc(clp->lines * sizeof(char *));
 822         offset = sizeof(*clp);
 823
 824         dprint(FD_NET, "server: %d command line args\n", clp->lines);
 825
 826         for (i = 0; i < clp->lines; i++) {
 827                 cslp = pdu + offset;
 828                 argv[i] = (char *) cslp->text;
 829
 830                 offset += sizeof(*cslp) + le16_to_cpu(cslp->len);
 831                 dprint(FD_NET, "server: %d: %s\n", i, argv[i]);
 832         }
 833
 834         if (parse_cmd_line(clp->lines, argv, clp->client_type)) {
 835                 fio_net_queue_quit();
 836                 free(argv);
 837                 return -1;
 838         }
 839
 840         free(argv);
 841
 842         spdu.jobs = cpu_to_le32(thread_number);
 843         spdu.stat_outputs = cpu_to_le32(stat_number);
 844
 845         fio_net_queue_cmd(FIO_NET_CMD_START, &spdu, sizeof(spdu), NULL, SK_F_COPY);
 846         return 0;
 847 }
 848
 849 static int handle_probe_cmd(struct fio_net_cmd *cmd)
 850 {
 851         struct cmd_client_probe_pdu *pdu = (struct cmd_client_probe_pdu *) cmd->payload;
 852         uint64_t tag = cmd->tag;
 853         struct cmd_probe_reply_pdu probe = {
 854 #ifdef CONFIG_BIG_ENDIAN
 855                 .bigendian      = 1,
 856 #endif
 857                 .os             = FIO_OS,
 858                 .arch           = FIO_ARCH,
 859                 .bpp            = sizeof(void *),
 860                 .cpus           = __cpu_to_le32(cpus_online()),
 861         };
 862
 863         dprint(FD_NET, "server: sending probe reply\n");
 864
 865         strcpy(me, (char *) pdu->server);
 866
 867         gethostname((char *) probe.hostname, sizeof(probe.hostname));
 868         snprintf((char *) probe.fio_version, sizeof(probe.fio_version), "%s",
 869                  fio_version_string);
 870
 871         /*
 872          * If the client supports compression and we do too, then enable it
 873          */
 874         if (has_zlib && le64_to_cpu(pdu->flags) & FIO_PROBE_FLAG_ZLIB) {
 875                 probe.flags = __cpu_to_le64(FIO_PROBE_FLAG_ZLIB);
 876                 use_zlib = 1;
 877         } else {
 878                 probe.flags = 0;
 879                 use_zlib = 0;
 880         }
 881
 882         return fio_net_queue_cmd(FIO_NET_CMD_PROBE, &probe, sizeof(probe), &tag, SK_F_COPY);
 883 }
 884
 885 static int handle_send_eta_cmd(struct fio_net_cmd *cmd)
 886 {
 887         struct jobs_eta *je;
 888         uint64_t tag = cmd->tag;
 889         size_t size;
 890         int i;
 891
 892         dprint(FD_NET, "server sending status\n");
 893
 894         /*
 895          * Fake ETA return if we don't have a local one, otherwise the client
 896          * will end up timing out waiting for a response to the ETA request
 897          */
 898         je = get_jobs_eta(true, &size);
 899         if (!je) {
 900                 size = sizeof(*je);
 901                 je = calloc(1, size);
 902         } else {
 903                 je->nr_running          = cpu_to_le32(je->nr_running);
 904                 je->nr_ramp             = cpu_to_le32(je->nr_ramp);
 905                 je->nr_pending          = cpu_to_le32(je->nr_pending);
 906                 je->nr_setting_up       = cpu_to_le32(je->nr_setting_up);
 907                 je->files_open          = cpu_to_le32(je->files_open);
 908
 909                 for (i = 0; i < DDIR_RWDIR_CNT; i++) {
 910                         je->m_rate[i]   = cpu_to_le64(je->m_rate[i]);
 911                         je->t_rate[i]   = cpu_to_le64(je->t_rate[i]);
 912                         je->m_iops[i]   = cpu_to_le32(je->m_iops[i]);
 913                         je->t_iops[i]   = cpu_to_le32(je->t_iops[i]);
 914                         je->rate[i]     = cpu_to_le64(je->rate[i]);
 915                         je->iops[i]     = cpu_to_le32(je->iops[i]);
 916                 }
 917
 918                 je->elapsed_sec         = cpu_to_le64(je->elapsed_sec);
 919                 je->eta_sec             = cpu_to_le64(je->eta_sec);
 920                 je->nr_threads          = cpu_to_le32(je->nr_threads);
 921                 je->is_pow2             = cpu_to_le32(je->is_pow2);
 922                 je->unit_base           = cpu_to_le32(je->unit_base);
 923         }
 924
 925         fio_net_queue_cmd(FIO_NET_CMD_ETA, je, size, &tag, SK_F_FREE);
 926         return 0;
 927 }
 928
 929 static int send_update_job_reply(uint64_t __tag, int error)
 930 {
 931         uint64_t tag = __tag;
 932         uint32_t pdu_error;
 933
 934         pdu_error = __cpu_to_le32(error);
 935         return fio_net_queue_cmd(FIO_NET_CMD_UPDATE_JOB, &pdu_error, sizeof(pdu_error), &tag, SK_F_COPY);
 936 }
 937
 938 static int handle_update_job_cmd(struct fio_net_cmd *cmd)
 939 {
 940         struct cmd_add_job_pdu *pdu = (struct cmd_add_job_pdu *) cmd->payload;
 941         struct thread_data *td;
 942         uint32_t tnumber;
 943
 944         tnumber = le32_to_cpu(pdu->thread_number);
 945
 946         dprint(FD_NET, "server: updating options for job %u\n", tnumber);
 947
 948         if (!tnumber || tnumber > thread_number) {
 949                 send_update_job_reply(cmd->tag, ENODEV);
 950                 return 0;
 951         }
 952
 953         td = &threads[tnumber - 1];
 954         convert_thread_options_to_cpu(&td->o, &pdu->top);
 955         send_update_job_reply(cmd->tag, 0);
 956         return 0;
 957 }
 958
 959 static int handle_trigger_cmd(struct fio_net_cmd *cmd, struct flist_head *job_list)
 960 {
 961         struct cmd_vtrigger_pdu *pdu = (struct cmd_vtrigger_pdu *) cmd->payload;
 962         char *buf = (char *) pdu->cmd;
 963         struct all_io_list *rep;
 964         size_t sz;
 965
 966         pdu->len = le16_to_cpu(pdu->len);
 967         buf[pdu->len] = '\0';
 968
 969         rep = get_all_io_list(IO_LIST_ALL, &sz);
 970         if (!rep) {
 971                 struct all_io_list state;
 972
 973                 state.threads = cpu_to_le64((uint64_t) 0);
 974                 fio_net_queue_cmd(FIO_NET_CMD_VTRIGGER, &state, sizeof(state), NULL, SK_F_COPY | SK_F_INLINE);
 975         } else
 976                 fio_net_queue_cmd(FIO_NET_CMD_VTRIGGER, rep, sz, NULL, SK_F_FREE | SK_F_INLINE);
 977
 978         fio_terminate_threads(TERMINATE_ALL, TERMINATE_ALL);
 979         fio_server_check_jobs(job_list);
 980         exec_trigger(buf);
 981         return 0;
 982 }
 983
 984 static int handle_command(struct sk_out *sk_out, struct flist_head *job_list,
 985                           struct fio_net_cmd *cmd)
 986 {
 987         int ret;
 988
 989         dprint(FD_NET, "server: got op [%s], pdu=%u, tag=%llx\n",
 990                         fio_server_op(cmd->opcode), cmd->pdu_len,
 991                         (unsigned long long) cmd->tag);
 992
 993         switch (cmd->opcode) {
 994         case FIO_NET_CMD_QUIT:
 995                 fio_terminate_threads(TERMINATE_ALL, TERMINATE_ALL);
 996                 ret = 0;
 997                 break;
 998         case FIO_NET_CMD_EXIT:
 999                 exit_backend = true;
1000                 return -1;
1001         case FIO_NET_CMD_LOAD_FILE:
1002                 ret = handle_load_file_cmd(cmd);
1003                 break;
1004         case FIO_NET_CMD_JOB:
1005                 ret = handle_job_cmd(cmd);
1006                 break;
1007         case FIO_NET_CMD_JOBLINE:
1008                 ret = handle_jobline_cmd(cmd);
1009                 break;
1010         case FIO_NET_CMD_PROBE:
1011                 ret = handle_probe_cmd(cmd);
1012                 break;
1013         case FIO_NET_CMD_SEND_ETA:
1014                 ret = handle_send_eta_cmd(cmd);
1015                 break;
1016         case FIO_NET_CMD_RUN:
1017                 ret = handle_run_cmd(sk_out, job_list, cmd);
1018                 break;
1019         case FIO_NET_CMD_UPDATE_JOB:
1020                 ret = handle_update_job_cmd(cmd);
1021                 break;
1022         case FIO_NET_CMD_VTRIGGER:
1023                 ret = handle_trigger_cmd(cmd, job_list);
1024                 break;
1025         case FIO_NET_CMD_SENDFILE: {
1026                 struct cmd_sendfile_reply *in;
1027                 struct cmd_reply *rep;
1028
1029                 rep = (struct cmd_reply *) (uintptr_t) cmd->tag;
1030
1031                 in = (struct cmd_sendfile_reply *) cmd->payload;
1032                 in->size = le32_to_cpu(in->size);
1033                 in->error = le32_to_cpu(in->error);
1034                 if (in->error) {
1035                         ret = 1;
1036                         rep->error = in->error;
1037                 } else {
1038                         ret = 0;
1039                         rep->data = smalloc(in->size);
1040                         if (!rep->data) {
1041                                 ret = 1;
1042                                 rep->error = ENOMEM;
1043                         } else {
1044                                 rep->size = in->size;
1045                                 memcpy(rep->data, in->data, in->size);
1046                         }
1047                 }
1048                 fio_sem_up(&rep->lock);
1049                 break;
1050                 }
1051         default:
1052                 log_err("fio: unknown opcode: %s\n", fio_server_op(cmd->opcode));
1053                 ret = 1;
1054         }
1055
1056         return ret;
1057 }
1058
1059 /*
1060  * Send a command with a separate PDU, not inlined in the command
1061  */
1062 static int fio_send_cmd_ext_pdu(int sk, uint16_t opcode, const void *buf,
1063                                 off_t size, uint64_t tag, uint32_t flags)
1064 {
1065         struct fio_net_cmd cmd;
1066         struct iovec iov[2];
1067         size_t this_len;
1068         int ret;
1069
1070         iov[0].iov_base = (void *) &cmd;
1071         iov[0].iov_len = sizeof(cmd);
1072
1073         do {
1074                 uint32_t this_flags = flags;
1075
1076                 this_len = size;
1077                 if (this_len > FIO_SERVER_MAX_FRAGMENT_PDU)
1078                         this_len = FIO_SERVER_MAX_FRAGMENT_PDU;
1079
1080                 if (this_len < size)
1081                         this_flags |= FIO_NET_CMD_F_MORE;
1082
1083                 __fio_init_net_cmd(&cmd, opcode, this_len, tag);
1084                 cmd.flags = __cpu_to_le32(this_flags);
1085                 fio_net_cmd_crc_pdu(&cmd, buf);
1086
1087                 iov[1].iov_base = (void *) buf;
1088                 iov[1].iov_len = this_len;
1089
1090                 ret = fio_sendv_data(sk, iov, 2);
1091                 size -= this_len;
1092                 buf += this_len;
1093         } while (!ret && size);
1094
1095         return ret;
1096 }
1097
1098 static void finish_entry(struct sk_entry *entry)
1099 {
1100         if (entry->flags & SK_F_FREE)
1101                 free(entry->buf);
1102         else if (entry->flags & SK_F_COPY)
1103                 sfree(entry->buf);
1104
1105         sfree(entry);
1106 }
1107
1108 static void entry_set_flags(struct sk_entry *entry, struct flist_head *list,
1109                             unsigned int *flags)
1110 {
1111         if (!flist_empty(list))
1112                 *flags = FIO_NET_CMD_F_MORE;
1113         else
1114                 *flags = 0;
1115 }
1116
1117 static int send_vec_entry(struct sk_out *sk_out, struct sk_entry *first)
1118 {
1119         unsigned int flags;
1120         int ret;
1121
1122         entry_set_flags(first, &first->next, &flags);
1123
1124         ret = fio_send_cmd_ext_pdu(sk_out->sk, first->opcode, first->buf,
1125                                         first->size, first->tag, flags);
1126
1127         while (!flist_empty(&first->next)) {
1128                 struct sk_entry *next;
1129
1130                 next = flist_first_entry(&first->next, struct sk_entry, list);
1131                 flist_del_init(&next->list);
1132
1133                 entry_set_flags(next, &first->next, &flags);
1134
1135                 ret += fio_send_cmd_ext_pdu(sk_out->sk, next->opcode, next->buf,
1136                                                 next->size, next->tag, flags);
1137                 finish_entry(next);
1138         }
1139
1140         return ret;
1141 }
1142
1143 static int handle_sk_entry(struct sk_out *sk_out, struct sk_entry *entry)
1144 {
1145         int ret;
1146
1147         fio_sem_down(&sk_out->xmit);
1148
1149         if (entry->flags & SK_F_VEC)
1150                 ret = send_vec_entry(sk_out, entry);
1151         else if (entry->flags & SK_F_SIMPLE) {
1152                 ret = fio_net_send_simple_cmd(sk_out->sk, entry->opcode,
1153                                                 entry->tag, NULL);
1154         } else {
1155                 ret = fio_net_send_cmd(sk_out->sk, entry->opcode, entry->buf,
1156                                         entry->size, &entry->tag, NULL);
1157         }
1158
1159         fio_sem_up(&sk_out->xmit);
1160
1161         if (ret)
1162                 log_err("fio: failed handling cmd %s\n", fio_server_op(entry->opcode));
1163
1164         finish_entry(entry);
1165         return ret;
1166 }
1167
1168 static int handle_xmits(struct sk_out *sk_out)
1169 {
1170         struct sk_entry *entry;
1171         FLIST_HEAD(list);
1172         int ret = 0;
1173
1174         sk_lock(sk_out);
1175         if (flist_empty(&sk_out->list)) {
1176                 sk_unlock(sk_out);
1177                 return 0;
1178         }
1179
1180         flist_splice_init(&sk_out->list, &list);
1181         sk_unlock(sk_out);
1182
1183         while (!flist_empty(&list)) {
1184                 entry = flist_entry(list.next, struct sk_entry, list);
1185                 flist_del(&entry->list);
1186                 ret += handle_sk_entry(sk_out, entry);
1187         }
1188
1189         return ret;
1190 }
1191
1192 static int handle_connection(struct sk_out *sk_out)
1193 {
1194         struct fio_net_cmd *cmd = NULL;
1195         FLIST_HEAD(job_list);
1196         int ret = 0;
1197
1198         reset_fio_state();
1199
1200         /* read forever */
1201         while (!exit_backend) {
1202                 struct pollfd pfd = {
1203                         .fd     = sk_out->sk,
1204                         .events = POLLIN,
1205                 };
1206
1207                 do {
1208                         int timeout = 1000;
1209
1210                         if (!flist_empty(&job_list))
1211                                 timeout = 100;
1212
1213                         handle_xmits(sk_out);
1214
1215                         ret = poll(&pfd, 1, 0);
1216                         if (ret < 0) {
1217                                 if (errno == EINTR)
1218                                         break;
1219                                 log_err("fio: poll: %s\n", strerror(errno));
1220                                 break;
1221                         } else if (!ret) {
1222                                 fio_server_check_jobs(&job_list);
1223                                 fio_sem_down_timeout(&sk_out->wait, timeout);
1224                                 continue;
1225                         }
1226
1227                         if (pfd.revents & POLLIN)
1228                                 break;
1229                         if (pfd.revents & (POLLERR|POLLHUP)) {
1230                                 ret = 1;
1231                                 break;
1232                         }
1233                 } while (!exit_backend);
1234
1235                 fio_server_check_jobs(&job_list);
1236
1237                 if (ret < 0)
1238                         break;
1239
1240                 cmd = fio_net_recv_cmd(sk_out->sk, true);
1241                 if (!cmd) {
1242                         ret = -1;
1243                         break;
1244                 }
1245
1246                 ret = handle_command(sk_out, &job_list, cmd);
1247                 if (ret)
1248                         break;
1249
1250                 free(cmd);
1251                 cmd = NULL;
1252         }
1253
1254         if (cmd)
1255                 free(cmd);
1256
1257         handle_xmits(sk_out);
1258
1259         close(sk_out->sk);
1260         sk_out->sk = -1;
1261         __sk_out_drop(sk_out);
1262         _exit(ret);
1263 }
1264
1265 /* get the address on this host bound by the input socket,
1266  * whether it is ipv6 or ipv4 */
1267
1268 static int get_my_addr_str(int sk)
1269 {
1270         struct sockaddr_in6 myaddr6 = { 0, };
1271         struct sockaddr_in myaddr4 = { 0, };
1272         struct sockaddr *sockaddr_p;
1273         char *net_addr;
1274         socklen_t len;
1275         int ret;
1276
1277         if (use_ipv6) {
1278                 len = sizeof(myaddr6);
1279                 sockaddr_p = (struct sockaddr * )&myaddr6;
1280                 net_addr = (char * )&myaddr6.sin6_addr;
1281         } else {
1282                 len = sizeof(myaddr4);
1283                 sockaddr_p = (struct sockaddr * )&myaddr4;
1284                 net_addr = (char * )&myaddr4.sin_addr;
1285         }
1286
1287         ret = getsockname(sk, sockaddr_p, &len);
1288         if (ret) {
1289                 log_err("fio: getsockname: %s\n", strerror(errno));
1290                 return -1;
1291         }
1292
1293         if (!inet_ntop(use_ipv6?AF_INET6:AF_INET, net_addr, client_sockaddr_str, INET6_ADDRSTRLEN - 1)) {
1294                 log_err("inet_ntop: failed to convert addr to string\n");
1295                 return -1;
1296         }
1297
1298         dprint(FD_NET, "fio server bound to addr %s\n", client_sockaddr_str);
1299         return 0;
1300 }
1301
1302 static int accept_loop(int listen_sk)
1303 {
1304         struct sockaddr_in addr;
1305         struct sockaddr_in6 addr6;
1306         socklen_t len = use_ipv6 ? sizeof(addr6) : sizeof(addr);
1307         struct pollfd pfd;
1308         int ret = 0, sk, exitval = 0;
1309         FLIST_HEAD(conn_list);
1310
1311         dprint(FD_NET, "server enter accept loop\n");
1312
1313         fio_set_fd_nonblocking(listen_sk, "server");
1314
1315         while (!exit_backend) {
1316                 struct sk_out *sk_out;
1317                 const char *from;
1318                 char buf[64];
1319                 pid_t pid;
1320
1321                 pfd.fd = listen_sk;
1322                 pfd.events = POLLIN;
1323                 do {
1324                         int timeout = 1000;
1325
1326                         if (!flist_empty(&conn_list))
1327                                 timeout = 100;
1328
1329                         ret = poll(&pfd, 1, timeout);
1330                         if (ret < 0) {
1331                                 if (errno == EINTR)
1332                                         break;
1333                                 log_err("fio: poll: %s\n", strerror(errno));
1334                                 break;
1335                         } else if (!ret) {
1336                                 fio_server_check_conns(&conn_list);
1337                                 continue;
1338                         }
1339
1340                         if (pfd.revents & POLLIN)
1341                                 break;
1342                 } while (!exit_backend);
1343
1344                 fio_server_check_conns(&conn_list);
1345
1346                 if (exit_backend || ret < 0)
1347                         break;
1348
1349                 if (use_ipv6)
1350                         sk = accept(listen_sk, (struct sockaddr *) &addr6, &len);
1351                 else
1352                         sk = accept(listen_sk, (struct sockaddr *) &addr, &len);
1353
1354                 if (sk < 0) {
1355                         log_err("fio: accept: %s\n", strerror(errno));
1356                         return -1;
1357                 }
1358
1359                 if (use_ipv6)
1360                         from = inet_ntop(AF_INET6, (struct sockaddr *) &addr6.sin6_addr, buf, sizeof(buf));
1361                 else
1362                         from = inet_ntop(AF_INET, (struct sockaddr *) &addr.sin_addr, buf, sizeof(buf));
1363
1364                 dprint(FD_NET, "server: connect from %s\n", from);
1365
1366                 sk_out = scalloc(1, sizeof(*sk_out));
1367                 if (!sk_out) {
1368                         close(sk);
1369                         return -1;
1370                 }
1371
1372                 sk_out->sk = sk;
1373                 INIT_FLIST_HEAD(&sk_out->list);
1374                 __fio_sem_init(&sk_out->lock, FIO_SEM_UNLOCKED);
1375                 __fio_sem_init(&sk_out->wait, FIO_SEM_LOCKED);
1376                 __fio_sem_init(&sk_out->xmit, FIO_SEM_UNLOCKED);
1377
1378                 pid = fork();
1379                 if (pid) {
1380                         close(sk);
1381                         fio_server_add_conn_pid(&conn_list, pid);
1382                         continue;
1383                 }
1384
1385                 /* if error, it's already logged, non-fatal */
1386                 get_my_addr_str(sk);
1387
1388                 /*
1389                  * Assign sk_out here, it'll be dropped in handle_connection()
1390                  * since that function calls _exit() when done
1391                  */
1392                 sk_out_assign(sk_out);
1393                 handle_connection(sk_out);
1394         }
1395
1396         return exitval;
1397 }
1398
1399 int fio_server_text_output(int level, const char *buf, size_t len)
1400 {
1401         struct sk_out *sk_out = pthread_getspecific(sk_out_key);
1402         struct cmd_text_pdu *pdu;
1403         unsigned int tlen;
1404         struct timeval tv;
1405
1406         if (!sk_out || sk_out->sk == -1)
1407                 return -1;
1408
1409         tlen = sizeof(*pdu) + len;
1410         pdu = malloc(tlen);
1411
1412         pdu->level      = __cpu_to_le32(level);
1413         pdu->buf_len    = __cpu_to_le32(len);
1414
1415         gettimeofday(&tv, NULL);
1416         pdu->log_sec    = __cpu_to_le64(tv.tv_sec);
1417         pdu->log_usec   = __cpu_to_le64(tv.tv_usec);
1418
1419         memcpy(pdu->buf, buf, len);
1420
1421         fio_net_queue_cmd(FIO_NET_CMD_TEXT, pdu, tlen, NULL, SK_F_COPY);
1422         free(pdu);
1423         return len;
1424 }
1425
1426 static void convert_io_stat(struct io_stat *dst, struct io_stat *src)
1427 {
1428         dst->max_val    = cpu_to_le64(src->max_val);
1429         dst->min_val    = cpu_to_le64(src->min_val);
1430         dst->samples    = cpu_to_le64(src->samples);
1431
1432         /*
1433          * Encode to IEEE 754 for network transfer
1434          */
1435         dst->mean.u.i   = cpu_to_le64(fio_double_to_uint64(src->mean.u.f));
1436         dst->S.u.i      = cpu_to_le64(fio_double_to_uint64(src->S.u.f));
1437 }
1438
1439 static void convert_gs(struct group_run_stats *dst, struct group_run_stats *src)
1440 {
1441         int i;
1442
1443         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1444                 dst->max_run[i]         = cpu_to_le64(src->max_run[i]);
1445                 dst->min_run[i]         = cpu_to_le64(src->min_run[i]);
1446                 dst->max_bw[i]          = cpu_to_le64(src->max_bw[i]);
1447                 dst->min_bw[i]          = cpu_to_le64(src->min_bw[i]);
1448                 dst->iobytes[i]         = cpu_to_le64(src->iobytes[i]);
1449                 dst->agg[i]             = cpu_to_le64(src->agg[i]);
1450         }
1451
1452         dst->kb_base    = cpu_to_le32(src->kb_base);
1453         dst->unit_base  = cpu_to_le32(src->unit_base);
1454         dst->groupid    = cpu_to_le32(src->groupid);
1455         dst->unified_rw_rep     = cpu_to_le32(src->unified_rw_rep);
1456         dst->sig_figs   = cpu_to_le32(src->sig_figs);
1457 }
1458
1459 /*
1460  * Send a CMD_TS, which packs struct thread_stat and group_run_stats
1461  * into a single payload.
1462  */
1463 void fio_server_send_ts(struct thread_stat *ts, struct group_run_stats *rs)
1464 {
1465         struct cmd_ts_pdu p;
1466         int i, j;
1467         void *ss_buf;
1468         uint64_t *ss_iops, *ss_bw;
1469
1470         dprint(FD_NET, "server sending end stats\n");
1471
1472         memset(&p, 0, sizeof(p));
1473
1474         snprintf(p.ts.name, sizeof(p.ts.name), "%s", ts->name);
1475         snprintf(p.ts.verror, sizeof(p.ts.verror), "%s", ts->verror);
1476         snprintf(p.ts.description, sizeof(p.ts.description), "%s",
1477                  ts->description);
1478
1479         p.ts.error              = cpu_to_le32(ts->error);
1480         p.ts.thread_number      = cpu_to_le32(ts->thread_number);
1481         p.ts.groupid            = cpu_to_le32(ts->groupid);
1482         p.ts.pid                = cpu_to_le32(ts->pid);
1483         p.ts.members            = cpu_to_le32(ts->members);
1484         p.ts.unified_rw_rep     = cpu_to_le32(ts->unified_rw_rep);
1485
1486         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1487                 convert_io_stat(&p.ts.clat_stat[i], &ts->clat_stat[i]);
1488                 convert_io_stat(&p.ts.slat_stat[i], &ts->slat_stat[i]);
1489                 convert_io_stat(&p.ts.lat_stat[i], &ts->lat_stat[i]);
1490                 convert_io_stat(&p.ts.bw_stat[i], &ts->bw_stat[i]);
1491                 convert_io_stat(&p.ts.iops_stat[i], &ts->iops_stat[i]);
1492         }
1493         convert_io_stat(&p.ts.sync_stat, &ts->sync_stat);
1494
1495         p.ts.usr_time           = cpu_to_le64(ts->usr_time);
1496         p.ts.sys_time           = cpu_to_le64(ts->sys_time);
1497         p.ts.ctx                = cpu_to_le64(ts->ctx);
1498         p.ts.minf               = cpu_to_le64(ts->minf);
1499         p.ts.majf               = cpu_to_le64(ts->majf);
1500         p.ts.clat_percentiles   = cpu_to_le32(ts->clat_percentiles);
1501         p.ts.lat_percentiles    = cpu_to_le32(ts->lat_percentiles);
1502         p.ts.percentile_precision = cpu_to_le64(ts->percentile_precision);
1503
1504         for (i = 0; i < FIO_IO_U_LIST_MAX_LEN; i++) {
1505                 fio_fp64_t *src = &ts->percentile_list[i];
1506                 fio_fp64_t *dst = &p.ts.percentile_list[i];
1507
1508                 dst->u.i = cpu_to_le64(fio_double_to_uint64(src->u.f));
1509         }
1510
1511         for (i = 0; i < FIO_IO_U_MAP_NR; i++) {
1512                 p.ts.io_u_map[i]        = cpu_to_le64(ts->io_u_map[i]);
1513                 p.ts.io_u_submit[i]     = cpu_to_le64(ts->io_u_submit[i]);
1514                 p.ts.io_u_complete[i]   = cpu_to_le64(ts->io_u_complete[i]);
1515         }
1516
1517         for (i = 0; i < FIO_IO_U_LAT_N_NR; i++)
1518                 p.ts.io_u_lat_n[i]      = cpu_to_le64(ts->io_u_lat_n[i]);
1519         for (i = 0; i < FIO_IO_U_LAT_U_NR; i++)
1520                 p.ts.io_u_lat_u[i]      = cpu_to_le64(ts->io_u_lat_u[i]);
1521         for (i = 0; i < FIO_IO_U_LAT_M_NR; i++)
1522                 p.ts.io_u_lat_m[i]      = cpu_to_le64(ts->io_u_lat_m[i]);
1523
1524         for (i = 0; i < DDIR_RWDIR_CNT; i++)
1525                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++)
1526                         p.ts.io_u_plat[i][j] = cpu_to_le64(ts->io_u_plat[i][j]);
1527
1528         for (j = 0; j < FIO_IO_U_PLAT_NR; j++)
1529                 p.ts.io_u_sync_plat[j] = cpu_to_le64(ts->io_u_sync_plat[j]);
1530
1531         for (i = 0; i < DDIR_RWDIR_SYNC_CNT; i++)
1532                 p.ts.total_io_u[i]      = cpu_to_le64(ts->total_io_u[i]);
1533
1534         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1535                 p.ts.short_io_u[i]      = cpu_to_le64(ts->short_io_u[i]);
1536                 p.ts.drop_io_u[i]       = cpu_to_le64(ts->drop_io_u[i]);
1537         }
1538
1539         p.ts.total_submit       = cpu_to_le64(ts->total_submit);
1540         p.ts.total_complete     = cpu_to_le64(ts->total_complete);
1541         p.ts.nr_zone_resets     = cpu_to_le64(ts->nr_zone_resets);
1542
1543         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1544                 p.ts.io_bytes[i]        = cpu_to_le64(ts->io_bytes[i]);
1545                 p.ts.runtime[i]         = cpu_to_le64(ts->runtime[i]);
1546         }
1547
1548         p.ts.total_run_time     = cpu_to_le64(ts->total_run_time);
1549         p.ts.continue_on_error  = cpu_to_le16(ts->continue_on_error);
1550         p.ts.total_err_count    = cpu_to_le64(ts->total_err_count);
1551         p.ts.first_error        = cpu_to_le32(ts->first_error);
1552         p.ts.kb_base            = cpu_to_le32(ts->kb_base);
1553         p.ts.unit_base          = cpu_to_le32(ts->unit_base);
1554
1555         p.ts.latency_depth      = cpu_to_le32(ts->latency_depth);
1556         p.ts.latency_target     = cpu_to_le64(ts->latency_target);
1557         p.ts.latency_window     = cpu_to_le64(ts->latency_window);
1558         p.ts.latency_percentile.u.i = cpu_to_le64(fio_double_to_uint64(ts->latency_percentile.u.f));
1559
1560         p.ts.sig_figs           = cpu_to_le32(ts->sig_figs);
1561
1562         p.ts.nr_block_infos     = cpu_to_le64(ts->nr_block_infos);
1563         for (i = 0; i < p.ts.nr_block_infos; i++)
1564                 p.ts.block_infos[i] = cpu_to_le32(ts->block_infos[i]);
1565
1566         p.ts.ss_dur             = cpu_to_le64(ts->ss_dur);
1567         p.ts.ss_state           = cpu_to_le32(ts->ss_state);
1568         p.ts.ss_head            = cpu_to_le32(ts->ss_head);
1569         p.ts.ss_limit.u.i       = cpu_to_le64(fio_double_to_uint64(ts->ss_limit.u.f));
1570         p.ts.ss_slope.u.i       = cpu_to_le64(fio_double_to_uint64(ts->ss_slope.u.f));
1571         p.ts.ss_deviation.u.i   = cpu_to_le64(fio_double_to_uint64(ts->ss_deviation.u.f));
1572         p.ts.ss_criterion.u.i   = cpu_to_le64(fio_double_to_uint64(ts->ss_criterion.u.f));
1573
1574         p.ts.cachehit           = cpu_to_le64(ts->cachehit);
1575         p.ts.cachemiss          = cpu_to_le64(ts->cachemiss);
1576
1577         for (i = 0; i < DDIR_RWDIR_CNT; i++) {
1578                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++) {
1579                         p.ts.io_u_plat_high_prio[i][j] = cpu_to_le64(ts->io_u_plat_high_prio[i][j]);
1580                         p.ts.io_u_plat_prio[i][j] = cpu_to_le64(ts->io_u_plat_prio[i][j]);
1581                 }
1582                 convert_io_stat(&p.ts.clat_high_prio_stat[i], &ts->clat_high_prio_stat[i]);
1583                 convert_io_stat(&p.ts.clat_prio_stat[i], &ts->clat_prio_stat[i]);
1584         }
1585
1586         convert_gs(&p.rs, rs);
1587
1588         dprint(FD_NET, "ts->ss_state = %d\n", ts->ss_state);
1589         if (ts->ss_state & FIO_SS_DATA) {
1590                 dprint(FD_NET, "server sending steadystate ring buffers\n");
1591
1592                 ss_buf = malloc(sizeof(p) + 2*ts->ss_dur*sizeof(uint64_t));
1593
1594                 memcpy(ss_buf, &p, sizeof(p));
1595
1596                 ss_iops = (uint64_t *) ((struct cmd_ts_pdu *)ss_buf + 1);
1597                 ss_bw = ss_iops + (int) ts->ss_dur;
1598                 for (i = 0; i < ts->ss_dur; i++) {
1599                         ss_iops[i] = cpu_to_le64(ts->ss_iops_data[i]);
1600                         ss_bw[i] = cpu_to_le64(ts->ss_bw_data[i]);
1601                 }
1602
1603                 fio_net_queue_cmd(FIO_NET_CMD_TS, ss_buf, sizeof(p) + 2*ts->ss_dur*sizeof(uint64_t), NULL, SK_F_COPY);
1604
1605                 free(ss_buf);
1606         }
1607         else
1608                 fio_net_queue_cmd(FIO_NET_CMD_TS, &p, sizeof(p), NULL, SK_F_COPY);
1609 }
1610
1611 void fio_server_send_gs(struct group_run_stats *rs)
1612 {
1613         struct group_run_stats gs;
1614
1615         dprint(FD_NET, "server sending group run stats\n");
1616
1617         convert_gs(&gs, rs);
1618         fio_net_queue_cmd(FIO_NET_CMD_GS, &gs, sizeof(gs), NULL, SK_F_COPY);
1619 }
1620
1621 void fio_server_send_job_options(struct flist_head *opt_list,
1622                                  unsigned int gid)
1623 {
1624         struct cmd_job_option pdu;
1625         struct flist_head *entry;
1626
1627         if (flist_empty(opt_list))
1628                 return;
1629
1630         flist_for_each(entry, opt_list) {
1631                 struct print_option *p;
1632                 size_t len;
1633
1634                 p = flist_entry(entry, struct print_option, list);
1635                 memset(&pdu, 0, sizeof(pdu));
1636
1637                 if (gid == -1U) {
1638                         pdu.global = __cpu_to_le16(1);
1639                         pdu.groupid = 0;
1640                 } else {
1641                         pdu.global = 0;
1642                         pdu.groupid = cpu_to_le32(gid);
1643                 }
1644                 len = strlen(p->name);
1645                 if (len >= sizeof(pdu.name)) {
1646                         len = sizeof(pdu.name) - 1;
1647                         pdu.truncated = __cpu_to_le16(1);
1648                 }
1649                 memcpy(pdu.name, p->name, len);
1650                 if (p->value) {
1651                         len = strlen(p->value);
1652                         if (len >= sizeof(pdu.value)) {
1653                                 len = sizeof(pdu.value) - 1;
1654                                 pdu.truncated = __cpu_to_le16(1);
1655                         }
1656                         memcpy(pdu.value, p->value, len);
1657                 }
1658                 fio_net_queue_cmd(FIO_NET_CMD_JOB_OPT, &pdu, sizeof(pdu), NULL, SK_F_COPY);
1659         }
1660 }
1661
1662 static void convert_agg(struct disk_util_agg *dst, struct disk_util_agg *src)
1663 {
1664         int i;
1665
1666         for (i = 0; i < 2; i++) {
1667                 dst->ios[i]     = cpu_to_le64(src->ios[i]);
1668                 dst->merges[i]  = cpu_to_le64(src->merges[i]);
1669                 dst->sectors[i] = cpu_to_le64(src->sectors[i]);
1670                 dst->ticks[i]   = cpu_to_le64(src->ticks[i]);
1671         }
1672
1673         dst->io_ticks           = cpu_to_le64(src->io_ticks);
1674         dst->time_in_queue      = cpu_to_le64(src->time_in_queue);
1675         dst->slavecount         = cpu_to_le32(src->slavecount);
1676         dst->max_util.u.i       = cpu_to_le64(fio_double_to_uint64(src->max_util.u.f));
1677 }
1678
1679 static void convert_dus(struct disk_util_stat *dst, struct disk_util_stat *src)
1680 {
1681         int i;
1682
1683         snprintf((char *) dst->name, sizeof(dst->name), "%s", src->name);
1684
1685         for (i = 0; i < 2; i++) {
1686                 dst->s.ios[i]           = cpu_to_le64(src->s.ios[i]);
1687                 dst->s.merges[i]        = cpu_to_le64(src->s.merges[i]);
1688                 dst->s.sectors[i]       = cpu_to_le64(src->s.sectors[i]);
1689                 dst->s.ticks[i]         = cpu_to_le64(src->s.ticks[i]);
1690         }
1691
1692         dst->s.io_ticks         = cpu_to_le64(src->s.io_ticks);
1693         dst->s.time_in_queue    = cpu_to_le64(src->s.time_in_queue);
1694         dst->s.msec             = cpu_to_le64(src->s.msec);
1695 }
1696
1697 void fio_server_send_du(void)
1698 {
1699         struct disk_util *du;
1700         struct flist_head *entry;
1701         struct cmd_du_pdu pdu;
1702
1703         dprint(FD_NET, "server: sending disk_util %d\n", !flist_empty(&disk_list));
1704
1705         memset(&pdu, 0, sizeof(pdu));
1706
1707         flist_for_each(entry, &disk_list) {
1708                 du = flist_entry(entry, struct disk_util, list);
1709
1710                 convert_dus(&pdu.dus, &du->dus);
1711                 convert_agg(&pdu.agg, &du->agg);
1712
1713                 fio_net_queue_cmd(FIO_NET_CMD_DU, &pdu, sizeof(pdu), NULL, SK_F_COPY);
1714         }
1715 }
1716
1717 #ifdef CONFIG_ZLIB
1718
1719 static inline void __fio_net_prep_tail(z_stream *stream, void *out_pdu,
1720                                         struct sk_entry **last_entry,
1721                                         struct sk_entry *first)
1722 {
1723         unsigned int this_len = FIO_SERVER_MAX_FRAGMENT_PDU - stream->avail_out;
1724
1725         *last_entry = fio_net_prep_cmd(FIO_NET_CMD_IOLOG, out_pdu, this_len,
1726                                  NULL, SK_F_VEC | SK_F_INLINE | SK_F_FREE);
1727         if (*last_entry)
1728                 flist_add_tail(&(*last_entry)->list, &first->next);
1729 }
1730
1731 /*
1732  * Deflates the next input given, creating as many new packets in the
1733  * linked list as necessary.
1734  */
1735 static int __deflate_pdu_buffer(void *next_in, unsigned int next_sz, void **out_pdu,
1736                                 struct sk_entry **last_entry, z_stream *stream,
1737                                 struct sk_entry *first)
1738 {
1739         int ret;
1740
1741         stream->next_in = next_in;
1742         stream->avail_in = next_sz;
1743         do {
1744                 if (!stream->avail_out) {
1745                         __fio_net_prep_tail(stream, *out_pdu, last_entry, first);
1746                         if (*last_entry == NULL)
1747                                 return 1;
1748
1749                         *out_pdu = malloc(FIO_SERVER_MAX_FRAGMENT_PDU);
1750
1751                         stream->avail_out = FIO_SERVER_MAX_FRAGMENT_PDU;
1752                         stream->next_out = *out_pdu;
1753                 }
1754
1755                 ret = deflate(stream, Z_BLOCK);
1756
1757                 if (ret < 0) {
1758                         free(*out_pdu);
1759                         return 1;
1760                 }
1761         } while (stream->avail_in);
1762
1763         return 0;
1764 }
1765
1766 static int __fio_append_iolog_gz_hist(struct sk_entry *first, struct io_log *log,
1767                                       struct io_logs *cur_log, z_stream *stream)
1768 {
1769         struct sk_entry *entry;
1770         void *out_pdu;
1771         int ret, i, j;
1772         int sample_sz = log_entry_sz(log);
1773
1774         out_pdu = malloc(FIO_SERVER_MAX_FRAGMENT_PDU);
1775         stream->avail_out = FIO_SERVER_MAX_FRAGMENT_PDU;
1776         stream->next_out = out_pdu;
1777
1778         for (i = 0; i < cur_log->nr_samples; i++) {
1779                 struct io_sample *s;
1780                 struct io_u_plat_entry *cur_plat_entry, *prev_plat_entry;
1781                 uint64_t *cur_plat, *prev_plat;
1782
1783                 s = get_sample(log, cur_log, i);
1784                 ret = __deflate_pdu_buffer(s, sample_sz, &out_pdu, &entry, stream, first);
1785                 if (ret)
1786                         return ret;
1787
1788                 /* Do the subtraction on server side so that client doesn't have to
1789                  * reconstruct our linked list from packets.
1790                  */
1791                 cur_plat_entry  = s->data.plat_entry;
1792                 prev_plat_entry = flist_first_entry(&cur_plat_entry->list, struct io_u_plat_entry, list);
1793                 cur_plat  = cur_plat_entry->io_u_plat;
1794                 prev_plat = prev_plat_entry->io_u_plat;
1795
1796                 for (j = 0; j < FIO_IO_U_PLAT_NR; j++) {
1797                         cur_plat[j] -= prev_plat[j];
1798                 }
1799
1800                 flist_del(&prev_plat_entry->list);
1801                 free(prev_plat_entry);
1802
1803                 ret = __deflate_pdu_buffer(cur_plat_entry, sizeof(*cur_plat_entry),
1804                                            &out_pdu, &entry, stream, first);
1805
1806                 if (ret)
1807                         return ret;
1808         }
1809
1810         __fio_net_prep_tail(stream, out_pdu, &entry, first);
1811         return entry == NULL;
1812 }
1813
1814 static int __fio_append_iolog_gz(struct sk_entry *first, struct io_log *log,
1815                                  struct io_logs *cur_log, z_stream *stream)
1816 {
1817         unsigned int this_len;
1818         void *out_pdu;
1819         int ret;
1820
1821         if (log->log_type == IO_LOG_TYPE_HIST)
1822                 return __fio_append_iolog_gz_hist(first, log, cur_log, stream);
1823
1824         stream->next_in = (void *) cur_log->log;
1825         stream->avail_in = cur_log->nr_samples * log_entry_sz(log);
1826
1827         do {
1828                 struct sk_entry *entry;
1829
1830                 /*
1831                  * Dirty - since the log is potentially huge, compress it into
1832                  * FIO_SERVER_MAX_FRAGMENT_PDU chunks and let the receiving
1833                  * side defragment it.
1834                  */
1835                 out_pdu = malloc(FIO_SERVER_MAX_FRAGMENT_PDU);
1836
1837                 stream->avail_out = FIO_SERVER_MAX_FRAGMENT_PDU;
1838                 stream->next_out = out_pdu;
1839                 ret = deflate(stream, Z_BLOCK);
1840                 /* may be Z_OK, or Z_STREAM_END */
1841                 if (ret < 0) {
1842                         free(out_pdu);
1843                         return 1;
1844                 }
1845
1846                 this_len = FIO_SERVER_MAX_FRAGMENT_PDU - stream->avail_out;
1847
1848                 entry = fio_net_prep_cmd(FIO_NET_CMD_IOLOG, out_pdu, this_len,
1849                                          NULL, SK_F_VEC | SK_F_INLINE | SK_F_FREE);
1850                 if (!entry) {
1851                         free(out_pdu);
1852                         return 1;
1853                 }
1854                 flist_add_tail(&entry->list, &first->next);
1855         } while (stream->avail_in);
1856
1857         return 0;
1858 }
1859
1860 static int fio_append_iolog_gz(struct sk_entry *first, struct io_log *log)
1861 {
1862         z_stream stream = {
1863                 .zalloc = Z_NULL,
1864                 .zfree  = Z_NULL,
1865                 .opaque = Z_NULL,
1866         };
1867         int ret = 0;
1868
1869         if (deflateInit(&stream, Z_DEFAULT_COMPRESSION) != Z_OK)
1870                 return 1;
1871
1872         while (!flist_empty(&log->io_logs)) {
1873                 struct io_logs *cur_log;
1874
1875                 cur_log = flist_first_entry(&log->io_logs, struct io_logs, list);
1876                 flist_del_init(&cur_log->list);
1877
1878                 ret = __fio_append_iolog_gz(first, log, cur_log, &stream);
1879                 if (ret)
1880                         break;
1881         }
1882
1883         ret = deflate(&stream, Z_FINISH);
1884
1885         while (ret != Z_STREAM_END) {
1886                 struct sk_entry *entry;
1887                 unsigned int this_len;
1888                 void *out_pdu;
1889
1890                 out_pdu = malloc(FIO_SERVER_MAX_FRAGMENT_PDU);
1891                 stream.avail_out = FIO_SERVER_MAX_FRAGMENT_PDU;
1892                 stream.next_out = out_pdu;
1893
1894                 ret = deflate(&stream, Z_FINISH);
1895                 /* may be Z_OK, or Z_STREAM_END */
1896                 if (ret < 0) {
1897                         free(out_pdu);
1898                         break;
1899                 }
1900
1901                 this_len = FIO_SERVER_MAX_FRAGMENT_PDU - stream.avail_out;
1902
1903                 entry = fio_net_prep_cmd(FIO_NET_CMD_IOLOG, out_pdu, this_len,
1904                                          NULL, SK_F_VEC | SK_F_INLINE | SK_F_FREE);
1905                 if (!entry) {
1906                         free(out_pdu);
1907                         break;
1908                 }
1909                 flist_add_tail(&entry->list, &first->next);
1910         } while (ret != Z_STREAM_END);
1911
1912         ret = deflateEnd(&stream);
1913         if (ret == Z_OK)
1914                 return 0;
1915
1916         return 1;
1917 }
1918 #else
1919 static int fio_append_iolog_gz(struct sk_entry *first, struct io_log *log)
1920 {
1921         return 1;
1922 }
1923 #endif
1924
1925 static int fio_append_gz_chunks(struct sk_entry *first, struct io_log *log)
1926 {
1927         struct sk_entry *entry;
1928         struct flist_head *node;
1929         int ret = 0;
1930
1931         pthread_mutex_lock(&log->chunk_lock);
1932         flist_for_each(node, &log->chunk_list) {
1933                 struct iolog_compress *c;
1934
1935                 c = flist_entry(node, struct iolog_compress, list);
1936                 entry = fio_net_prep_cmd(FIO_NET_CMD_IOLOG, c->buf, c->len,
1937                                                 NULL, SK_F_VEC | SK_F_INLINE);
1938                 if (!entry) {
1939                         ret = 1;
1940                         break;
1941                 }
1942                 flist_add_tail(&entry->list, &first->next);
1943         }
1944         pthread_mutex_unlock(&log->chunk_lock);
1945         return ret;
1946 }
1947
1948 static int fio_append_text_log(struct sk_entry *first, struct io_log *log)
1949 {
1950         struct sk_entry *entry;
1951         int ret = 0;
1952
1953         while (!flist_empty(&log->io_logs)) {
1954                 struct io_logs *cur_log;
1955                 size_t size;
1956
1957                 cur_log = flist_first_entry(&log->io_logs, struct io_logs, list);
1958                 flist_del_init(&cur_log->list);
1959
1960                 size = cur_log->nr_samples * log_entry_sz(log);
1961
1962                 entry = fio_net_prep_cmd(FIO_NET_CMD_IOLOG, cur_log->log, size,
1963                                                 NULL, SK_F_VEC | SK_F_INLINE);
1964                 if (!entry) {
1965                         ret = 1;
1966                         break;
1967                 }
1968                 flist_add_tail(&entry->list, &first->next);
1969         }
1970
1971         return ret;
1972 }
1973
1974 int fio_send_iolog(struct thread_data *td, struct io_log *log, const char *name)
1975 {
1976         struct cmd_iolog_pdu pdu = {
1977                 .nr_samples             = cpu_to_le64(iolog_nr_samples(log)),
1978                 .thread_number          = cpu_to_le32(td->thread_number),
1979                 .log_type               = cpu_to_le32(log->log_type),
1980                 .log_hist_coarseness    = cpu_to_le32(log->hist_coarseness),
1981         };
1982         struct sk_entry *first;
1983         struct flist_head *entry;
1984         int ret = 0;
1985
1986         if (!flist_empty(&log->chunk_list))
1987                 pdu.compressed = __cpu_to_le32(STORE_COMPRESSED);
1988         else if (use_zlib)
1989                 pdu.compressed = __cpu_to_le32(XMIT_COMPRESSED);
1990         else
1991                 pdu.compressed = 0;
1992
1993         snprintf((char *) pdu.name, sizeof(pdu.name), "%s", name);
1994
1995         /*
1996          * We can't do this for a pre-compressed log, but for that case,
1997          * log->nr_samples is zero anyway.
1998          */
1999         flist_for_each(entry, &log->io_logs) {
2000                 struct io_logs *cur_log;
2001                 int i;
2002
2003                 cur_log = flist_entry(entry, struct io_logs, list);
2004
2005                 for (i = 0; i < cur_log->nr_samples; i++) {
2006                         struct io_sample *s = get_sample(log, cur_log, i);
2007
2008                         s->time         = cpu_to_le64(s->time);
2009                         s->data.val     = cpu_to_le64(s->data.val);
2010                         s->__ddir       = __cpu_to_le32(s->__ddir);
2011                         s->bs           = cpu_to_le64(s->bs);
2012
2013                         if (log->log_offset) {
2014                                 struct io_sample_offset *so = (void *) s;
2015
2016                                 so->offset = cpu_to_le64(so->offset);
2017                         }
2018                 }
2019         }
2020
2021         /*
2022          * Assemble header entry first
2023          */
2024         first = fio_net_prep_cmd(FIO_NET_CMD_IOLOG, &pdu, sizeof(pdu), NULL, SK_F_VEC | SK_F_INLINE | SK_F_COPY);
2025         if (!first)
2026                 return 1;
2027
2028         /*
2029          * Now append actual log entries. If log compression was enabled on
2030          * the job, just send out the compressed chunks directly. If we
2031          * have a plain log, compress if we can, then send. Otherwise, send
2032          * the plain text output.
2033          */
2034         if (!flist_empty(&log->chunk_list))
2035                 ret = fio_append_gz_chunks(first, log);
2036         else if (use_zlib)
2037                 ret = fio_append_iolog_gz(first, log);
2038         else
2039                 ret = fio_append_text_log(first, log);
2040
2041         fio_net_queue_entry(first);
2042         return ret;
2043 }
2044
2045 void fio_server_send_add_job(struct thread_data *td)
2046 {
2047         struct cmd_add_job_pdu pdu = {
2048                 .thread_number = cpu_to_le32(td->thread_number),
2049                 .groupid = cpu_to_le32(td->groupid),
2050         };
2051
2052         convert_thread_options_to_net(&pdu.top, &td->o);
2053
2054         fio_net_queue_cmd(FIO_NET_CMD_ADD_JOB, &pdu, sizeof(pdu), NULL,
2055                                 SK_F_COPY);
2056 }
2057
2058 void fio_server_send_start(struct thread_data *td)
2059 {
2060         struct sk_out *sk_out = pthread_getspecific(sk_out_key);
2061
2062         assert(sk_out->sk != -1);
2063
2064         fio_net_queue_cmd(FIO_NET_CMD_SERVER_START, NULL, 0, NULL, SK_F_SIMPLE);
2065 }
2066
2067 int fio_server_get_verify_state(const char *name, int threadnumber,
2068                                 void **datap)
2069 {
2070         struct thread_io_list *s;
2071         struct cmd_sendfile out;
2072         struct cmd_reply *rep;
2073         uint64_t tag;
2074         void *data;
2075         int ret;
2076
2077         dprint(FD_NET, "server: request verify state\n");
2078
2079         rep = smalloc(sizeof(*rep));
2080         if (!rep)
2081                 return ENOMEM;
2082
2083         __fio_sem_init(&rep->lock, FIO_SEM_LOCKED);
2084         rep->data = NULL;
2085         rep->error = 0;
2086
2087         verify_state_gen_name((char *) out.path, sizeof(out.path), name, me,
2088                                 threadnumber);
2089         tag = (uint64_t) (uintptr_t) rep;
2090         fio_net_queue_cmd(FIO_NET_CMD_SENDFILE, &out, sizeof(out), &tag,
2091                                 SK_F_COPY);
2092
2093         /*
2094          * Wait for the backend to receive the reply
2095          */
2096         if (fio_sem_down_timeout(&rep->lock, 10000)) {
2097                 log_err("fio: timed out waiting for reply\n");
2098                 ret = ETIMEDOUT;
2099                 goto fail;
2100         }
2101
2102         if (rep->error) {
2103                 log_err("fio: failure on receiving state file %s: %s\n",
2104                                 out.path, strerror(rep->error));
2105                 ret = rep->error;
2106 fail:
2107                 *datap = NULL;
2108                 sfree(rep);
2109                 fio_net_queue_quit();
2110                 return ret;
2111         }
2112
2113         /*
2114          * The format is verify_state_hdr, then thread_io_list. Verify
2115          * the header, and the thread_io_list checksum
2116          */
2117         s = rep->data + sizeof(struct verify_state_hdr);
2118         if (verify_state_hdr(rep->data, s)) {
2119                 ret = EILSEQ;
2120                 goto fail;
2121         }
2122
2123         /*
2124          * Don't need the header from now, copy just the thread_io_list
2125          */
2126         ret = 0;
2127         rep->size -= sizeof(struct verify_state_hdr);
2128         data = malloc(rep->size);
2129         memcpy(data, s, rep->size);
2130         *datap = data;
2131
2132         sfree(rep->data);
2133         __fio_sem_remove(&rep->lock);
2134         sfree(rep);
2135         return ret;
2136 }
2137
2138 static int fio_init_server_ip(void)
2139 {
2140         struct sockaddr *addr;
2141         socklen_t socklen;
2142         char buf[80];
2143         const char *str;
2144         int sk, opt;
2145
2146         if (use_ipv6)
2147                 sk = socket(AF_INET6, SOCK_STREAM, 0);
2148         else
2149                 sk = socket(AF_INET, SOCK_STREAM, 0);
2150
2151         if (sk < 0) {
2152                 log_err("fio: socket: %s\n", strerror(errno));
2153                 return -1;
2154         }
2155
2156         opt = 1;
2157         if (setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, (void *)&opt, sizeof(opt)) < 0) {
2158                 log_err("fio: setsockopt(REUSEADDR): %s\n", strerror(errno));
2159                 close(sk);
2160                 return -1;
2161         }
2162 #ifdef SO_REUSEPORT
2163         /*
2164          * Not fatal if fails, so just ignore it if that happens
2165          */
2166         if (setsockopt(sk, SOL_SOCKET, SO_REUSEPORT, &opt, sizeof(opt))) {
2167         }
2168 #endif
2169
2170         if (use_ipv6) {
2171                 void *src = &saddr_in6.sin6_addr;
2172
2173                 addr = (struct sockaddr *) &saddr_in6;
2174                 socklen = sizeof(saddr_in6);
2175                 saddr_in6.sin6_family = AF_INET6;
2176                 str = inet_ntop(AF_INET6, src, buf, sizeof(buf));
2177         } else {
2178                 void *src = &saddr_in.sin_addr;
2179
2180                 addr = (struct sockaddr *) &saddr_in;
2181                 socklen = sizeof(saddr_in);
2182                 saddr_in.sin_family = AF_INET;
2183                 str = inet_ntop(AF_INET, src, buf, sizeof(buf));
2184         }
2185
2186         if (bind(sk, addr, socklen) < 0) {
2187                 log_err("fio: bind: %s\n", strerror(errno));
2188                 log_info("fio: failed with IPv%c %s\n", use_ipv6 ? '6' : '4', str);
2189                 close(sk);
2190                 return -1;
2191         }
2192
2193         return sk;
2194 }
2195
2196 static int fio_init_server_sock(void)
2197 {
2198         struct sockaddr_un addr;
2199         socklen_t len;
2200         mode_t mode;
2201         int sk;
2202
2203         sk = socket(AF_UNIX, SOCK_STREAM, 0);
2204         if (sk < 0) {
2205                 log_err("fio: socket: %s\n", strerror(errno));
2206                 return -1;
2207         }
2208
2209         mode = umask(000);
2210
2211         addr.sun_family = AF_UNIX;
2212         snprintf(addr.sun_path, sizeof(addr.sun_path), "%s", bind_sock);
2213
2214         len = sizeof(addr.sun_family) + strlen(bind_sock) + 1;
2215
2216         if (bind(sk, (struct sockaddr *) &addr, len) < 0) {
2217                 log_err("fio: bind: %s\n", strerror(errno));
2218                 close(sk);
2219                 return -1;
2220         }
2221
2222         umask(mode);
2223         return sk;
2224 }
2225
2226 static int fio_init_server_connection(void)
2227 {
2228         char bind_str[128];
2229         int sk;
2230
2231         dprint(FD_NET, "starting server\n");
2232
2233         if (!bind_sock)
2234                 sk = fio_init_server_ip();
2235         else
2236                 sk = fio_init_server_sock();
2237
2238         if (sk < 0)
2239                 return sk;
2240
2241         memset(bind_str, 0, sizeof(bind_str));
2242
2243         if (!bind_sock) {
2244                 char *p, port[16];
2245                 void *src;
2246                 int af;
2247
2248                 if (use_ipv6) {
2249                         af = AF_INET6;
2250                         src = &saddr_in6.sin6_addr;
2251                 } else {
2252                         af = AF_INET;
2253                         src = &saddr_in.sin_addr;
2254                 }
2255
2256                 p = (char *) inet_ntop(af, src, bind_str, sizeof(bind_str));
2257
2258                 sprintf(port, ",%u", fio_net_port);
2259                 if (p)
2260                         strcat(p, port);
2261                 else
2262                         snprintf(bind_str, sizeof(bind_str), "%s", port);
2263         } else
2264                 snprintf(bind_str, sizeof(bind_str), "%s", bind_sock);
2265
2266         log_info("fio: server listening on %s\n", bind_str);
2267
2268         if (listen(sk, 4) < 0) {
2269                 log_err("fio: listen: %s\n", strerror(errno));
2270                 close(sk);
2271                 return -1;
2272         }
2273
2274         return sk;
2275 }
2276
2277 int fio_server_parse_host(const char *host, int ipv6, struct in_addr *inp,
2278                           struct in6_addr *inp6)
2279
2280 {
2281         int ret = 0;
2282
2283         if (ipv6)
2284                 ret = inet_pton(AF_INET6, host, inp6);
2285         else
2286                 ret = inet_pton(AF_INET, host, inp);
2287
2288         if (ret != 1) {
2289                 struct addrinfo *res, hints = {
2290                         .ai_family = ipv6 ? AF_INET6 : AF_INET,
2291                         .ai_socktype = SOCK_STREAM,
2292                 };
2293
2294                 ret = getaddrinfo(host, NULL, &hints, &res);
2295                 if (ret) {
2296                         log_err("fio: failed to resolve <%s> (%s)\n", host,
2297                                         gai_strerror(ret));
2298                         return 1;
2299                 }
2300
2301                 if (ipv6)
2302                         memcpy(inp6, &((struct sockaddr_in6 *) res->ai_addr)->sin6_addr, sizeof(*inp6));
2303                 else
2304                         memcpy(inp, &((struct sockaddr_in *) res->ai_addr)->sin_addr, sizeof(*inp));
2305
2306                 ret = 1;
2307                 freeaddrinfo(res);
2308         }
2309
2310         return !(ret == 1);
2311 }
2312
2313 /*
2314  * Parse a host/ip/port string. Reads from 'str'.
2315  *
2316  * Outputs:
2317  *
2318  * For IPv4:
2319  *      *ptr is the host, *port is the port, inp is the destination.
2320  * For IPv6:
2321  *      *ptr is the host, *port is the port, inp6 is the dest, and *ipv6 is 1.
2322  * For local domain sockets:
2323  *      *ptr is the filename, *is_sock is 1.
2324  */
2325 int fio_server_parse_string(const char *str, char **ptr, bool *is_sock,
2326                             int *port, struct in_addr *inp,
2327                             struct in6_addr *inp6, int *ipv6)
2328 {
2329         const char *host = str;
2330         char *portp;
2331         int lport = 0;
2332
2333         *ptr = NULL;
2334         *is_sock = false;
2335         *port = fio_net_port;
2336         *ipv6 = 0;
2337
2338         if (!strncmp(str, "sock:", 5)) {
2339                 *ptr = strdup(str + 5);
2340                 *is_sock = true;
2341
2342                 return 0;
2343         }
2344
2345         /*
2346          * Is it ip:<ip or host>:port
2347          */
2348         if (!strncmp(host, "ip:", 3))
2349                 host += 3;
2350         else if (!strncmp(host, "ip4:", 4))
2351                 host += 4;
2352         else if (!strncmp(host, "ip6:", 4)) {
2353                 host += 4;
2354                 *ipv6 = 1;
2355         } else if (host[0] == ':') {
2356                 /* String is :port */
2357                 host++;
2358                 lport = atoi(host);
2359                 if (!lport || lport > 65535) {
2360                         log_err("fio: bad server port %u\n", lport);
2361                         return 1;
2362                 }
2363                 /* no hostname given, we are done */
2364                 *port = lport;
2365                 return 0;
2366         }
2367
2368         /*
2369          * If no port seen yet, check if there's a last ',' at the end
2370          */
2371         if (!lport) {
2372                 portp = strchr(host, ',');
2373                 if (portp) {
2374                         *portp = '\0';
2375                         portp++;
2376                         lport = atoi(portp);
2377                         if (!lport || lport > 65535) {
2378                                 log_err("fio: bad server port %u\n", lport);
2379                                 return 1;
2380                         }
2381                 }
2382         }
2383
2384         if (lport)
2385                 *port = lport;
2386
2387         if (!strlen(host))
2388                 return 0;
2389
2390         *ptr = strdup(host);
2391
2392         if (fio_server_parse_host(*ptr, *ipv6, inp, inp6)) {
2393                 free(*ptr);
2394                 *ptr = NULL;
2395                 return 1;
2396         }
2397
2398         if (*port == 0)
2399                 *port = fio_net_port;
2400
2401         return 0;
2402 }
2403
2404 /*
2405  * Server arg should be one of:
2406  *
2407  * sock:/path/to/socket
2408  *   ip:1.2.3.4
2409  *      1.2.3.4
2410  *
2411  * Where sock uses unix domain sockets, and ip binds the server to
2412  * a specific interface. If no arguments are given to the server, it
2413  * uses IP and binds to 0.0.0.0.
2414  *
2415  */
2416 static int fio_handle_server_arg(void)
2417 {
2418         int port = fio_net_port;
2419         bool is_sock;
2420         int ret = 0;
2421
2422         saddr_in.sin_addr.s_addr = htonl(INADDR_ANY);
2423
2424         if (!fio_server_arg)
2425                 goto out;
2426
2427         ret = fio_server_parse_string(fio_server_arg, &bind_sock, &is_sock,
2428                                         &port, &saddr_in.sin_addr,
2429                                         &saddr_in6.sin6_addr, &use_ipv6);
2430
2431         if (!is_sock && bind_sock) {
2432                 free(bind_sock);
2433                 bind_sock = NULL;
2434         }
2435
2436 out:
2437         fio_net_port = port;
2438         saddr_in.sin_port = htons(port);
2439         saddr_in6.sin6_port = htons(port);
2440         return ret;
2441 }
2442
2443 static void sig_int(int sig)
2444 {
2445         if (bind_sock)
2446                 unlink(bind_sock);
2447 }
2448
2449 static void set_sig_handlers(void)
2450 {
2451         struct sigaction act = {
2452                 .sa_handler = sig_int,
2453                 .sa_flags = SA_RESTART,
2454         };
2455
2456         sigaction(SIGINT, &act, NULL);
2457 }
2458
2459 void fio_server_destroy_sk_key(void)
2460 {
2461         pthread_key_delete(sk_out_key);
2462 }
2463
2464 int fio_server_create_sk_key(void)
2465 {
2466         if (pthread_key_create(&sk_out_key, NULL)) {
2467                 log_err("fio: can't create sk_out backend key\n");
2468                 return 1;
2469         }
2470
2471         pthread_setspecific(sk_out_key, NULL);
2472         return 0;
2473 }
2474
2475 static int fio_server(void)
2476 {
2477         int sk, ret;
2478
2479         dprint(FD_NET, "starting server\n");
2480
2481         if (fio_handle_server_arg())
2482                 return -1;
2483
2484         sk = fio_init_server_connection();
2485         if (sk < 0)
2486                 return -1;
2487
2488         set_sig_handlers();
2489
2490         ret = accept_loop(sk);
2491
2492         close(sk);
2493
2494         if (fio_server_arg) {
2495                 free(fio_server_arg);
2496                 fio_server_arg = NULL;
2497         }
2498         if (bind_sock)
2499                 free(bind_sock);
2500
2501         return ret;
2502 }
2503
2504 void fio_server_got_signal(int signal)
2505 {
2506         struct sk_out *sk_out = pthread_getspecific(sk_out_key);
2507
2508         assert(sk_out);
2509
2510         if (signal == SIGPIPE)
2511                 sk_out->sk = -1;
2512         else {
2513                 log_info("\nfio: terminating on signal %d\n", signal);
2514                 exit_backend = true;
2515         }
2516 }
2517
2518 static int check_existing_pidfile(const char *pidfile)
2519 {
2520         struct stat sb;
2521         char buf[16];
2522         pid_t pid;
2523         FILE *f;
2524
2525         if (stat(pidfile, &sb))
2526                 return 0;
2527
2528         f = fopen(pidfile, "r");
2529         if (!f)
2530                 return 0;
2531
2532         if (fread(buf, sb.st_size, 1, f) <= 0) {
2533                 fclose(f);
2534                 return 1;
2535         }
2536         fclose(f);
2537
2538         pid = atoi(buf);
2539         if (kill(pid, SIGCONT) < 0)
2540                 return errno != ESRCH;
2541
2542         return 1;
2543 }
2544
2545 static int write_pid(pid_t pid, const char *pidfile)
2546 {
2547         FILE *fpid;
2548
2549         fpid = fopen(pidfile, "w");
2550         if (!fpid) {
2551                 log_err("fio: failed opening pid file %s\n", pidfile);
2552                 return 1;
2553         }
2554
2555         fprintf(fpid, "%u\n", (unsigned int) pid);
2556         fclose(fpid);
2557         return 0;
2558 }
2559
2560 /*
2561  * If pidfile is specified, background us.
2562  */
2563 int fio_start_server(char *pidfile)
2564 {
2565         pid_t pid;
2566         int ret;
2567
2568 #if defined(WIN32)
2569         WSADATA wsd;
2570         WSAStartup(MAKEWORD(2, 2), &wsd);
2571 #endif
2572
2573         if (!pidfile)
2574                 return fio_server();
2575
2576         if (check_existing_pidfile(pidfile)) {
2577                 log_err("fio: pidfile %s exists and server appears alive\n",
2578                                                                 pidfile);
2579                 free(pidfile);
2580                 return -1;
2581         }
2582
2583         pid = fork();
2584         if (pid < 0) {
2585                 log_err("fio: failed server fork: %s\n", strerror(errno));
2586                 free(pidfile);
2587                 return -1;
2588         } else if (pid) {
2589                 ret = write_pid(pid, pidfile);
2590                 free(pidfile);
2591                 _exit(ret);
2592         }
2593
2594         setsid();
2595         openlog("fio", LOG_NDELAY|LOG_NOWAIT|LOG_PID, LOG_USER);
2596         log_syslog = true;
2597         close(STDIN_FILENO);
2598         close(STDOUT_FILENO);
2599         close(STDERR_FILENO);
2600         f_out = NULL;
2601         f_err = NULL;
2602
2603         ret = fio_server();
2604
2605         closelog();
2606         unlink(pidfile);
2607         free(pidfile);
2608         return ret;
2609 }
2610
2611 void fio_server_set_arg(const char *arg)
2612 {
2613         fio_server_arg = strdup(arg);
2614 }