src/plugins/hs_apps/vcl/vcl_test_server.c

   1 /*
   2  * Copyright (c) 2017-2021 Cisco and/or its affiliates.
   3  * Licensed under the Apache License, Version 2.0 (the "License");
   4  * you may not use this file except in compliance with the License.
   5  * You may obtain a copy of the License at:
   6  *
   7  *     http://www.apache.org/licenses/LICENSE-2.0
   8  *
   9  * Unless required by applicable law or agreed to in writing, software
  10  * distributed under the License is distributed on an "AS IS" BASIS,
  11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  12  * See the License for the specific language governing permissions and
  13  * limitations under the License.
  14  */
  15
  16 #include <unistd.h>
  17 #include <errno.h>
  18 #include <sys/types.h>
  19 #include <sys/socket.h>
  20 #include <stdio.h>
  21 #include <string.h>
  22 #include <time.h>
  23 #include <ctype.h>
  24 #include <sys/stat.h>
  25 #include <fcntl.h>
  26 #include <hs_apps/vcl/vcl_test.h>
  27 #include <sys/epoll.h>
  28 #include <vppinfra/mem.h>
  29 #include <pthread.h>
  30
  31 /*
  32  * XXX: Unfortunately libepoll-shim requires some hacks to work, one of these
  33  * defines 'close' as a macro. This collides with vcl test callback 'close'.
  34  * Undef the 'close' macro on FreeBSD if it exists.
  35  */
  36 #ifdef __FreeBSD__
  37 #ifdef close
  38 #undef close
  39 #endif
  40 #endif /* __FreeBSD__ */
  41
  42 typedef struct
  43 {
  44   uint16_t port;
  45   uint32_t address_ip6;
  46   u8 proto;
  47   u8 workers;
  48   vppcom_endpt_t endpt;
  49 } vcl_test_server_cfg_t;
  50
  51 typedef struct
  52 {
  53   vcl_test_session_t *conn_pool;
  54   uint32_t wrk_index;
  55   int epfd;
  56   int conn_pool_size;
  57   int nfds;
  58   vcl_test_session_t listener;
  59   pthread_t thread_handle;
  60 } vcl_test_server_worker_t;
  61
  62 typedef struct
  63 {
  64   vcl_test_server_worker_t *workers;
  65   vcl_test_session_t *ctrl;
  66   vcl_test_server_cfg_t server_cfg;
  67   int ctrl_listen_fd;
  68   struct sockaddr_storage servaddr;
  69   volatile int worker_fails;
  70   volatile int active_workers;
  71   u8 use_ds;
  72   u8 incremental_stats;
  73 } vcl_test_server_main_t;
  74
  75 vcl_test_main_t vcl_test_main;
  76
  77 static vcl_test_server_main_t vcl_server_main;
  78
  79 static inline void
  80 conn_pool_expand (vcl_test_server_worker_t * wrk, size_t expand_size)
  81 {
  82   vcl_test_session_t *conn_pool;
  83   size_t new_size = wrk->conn_pool_size + expand_size;
  84   int i;
  85
  86   conn_pool = realloc (wrk->conn_pool, new_size * sizeof (*wrk->conn_pool));
  87   if (conn_pool)
  88     {
  89       for (i = wrk->conn_pool_size; i < new_size; i++)
  90         {
  91           vcl_test_session_t *conn = &conn_pool[i];
  92           memset (conn, 0, sizeof (*conn));
  93         }
  94
  95       wrk->conn_pool = conn_pool;
  96       wrk->conn_pool_size = new_size;
  97     }
  98   else
  99     {
 100       vterr ("conn_pool_expand()", -errno);
 101     }
 102 }
 103
 104 static inline vcl_test_session_t *
 105 conn_pool_alloc (vcl_test_server_worker_t *wrk)
 106 {
 107   vcl_test_session_t *conn;
 108   int i, expand = 0;
 109
 110 again:
 111   for (i = 0; i < wrk->conn_pool_size; i++)
 112     {
 113       if (!wrk->conn_pool[i].is_alloc)
 114         {
 115           conn = &wrk->conn_pool[i];
 116           memset (conn, 0, sizeof (*conn));
 117           conn->endpt.ip = wrk->conn_pool[i].ip;
 118           conn->is_alloc = 1;
 119           conn->session_index = i;
 120           hs_test_cfg_init (&conn->cfg);
 121           return (&wrk->conn_pool[i]);
 122         }
 123     }
 124
 125   if (expand == 0)
 126     {
 127       conn_pool_expand (wrk, 2 * wrk->conn_pool_size);
 128       expand = 1;
 129       goto again;
 130     }
 131   vtwrn ("Failed to allocate connection even after expand");
 132   return 0;
 133 }
 134
 135 static inline void
 136 conn_pool_free (vcl_test_session_t *ts)
 137 {
 138   ts->fd = 0;
 139   ts->is_alloc = 0;
 140   vcl_test_session_buf_free (ts);
 141 }
 142
 143 static inline void
 144 sync_config_and_reply (vcl_test_session_t *conn, hs_test_cfg_t *rx_cfg)
 145 {
 146   conn->cfg = *rx_cfg;
 147   vcl_test_buf_alloc (&conn->cfg, 1 /* is_rxbuf */, (uint8_t **) &conn->rxbuf,
 148                       &conn->rxbuf_size);
 149   conn->cfg.txbuf_size = conn->cfg.rxbuf_size;
 150
 151   if (conn->cfg.verbose)
 152     {
 153       vtinf ("(fd %d): Replying to cfg message!\n", conn->fd);
 154       hs_test_cfg_dump (&conn->cfg, 0 /* is_client */);
 155     }
 156   (void) vcl_test_write (conn, &conn->cfg, sizeof (conn->cfg));
 157 }
 158
 159 static void
 160 vts_session_close (vcl_test_session_t *conn)
 161 {
 162   vcl_test_server_main_t *vsm = &vcl_server_main;
 163   vcl_test_main_t *vt = &vcl_test_main;
 164
 165   if (!conn->is_open)
 166     return;
 167
 168   if (vt->protos[vsm->server_cfg.proto]->close)
 169     vt->protos[vsm->server_cfg.proto]->close (conn);
 170
 171   vppcom_session_close (conn->fd);
 172   conn->is_open = 0;
 173 }
 174
 175 static void
 176 vts_session_cleanup (vcl_test_session_t *ts)
 177 {
 178   vts_session_close (ts);
 179   conn_pool_free (ts);
 180 }
 181
 182 static void
 183 vts_wrk_cleanup_all (vcl_test_server_worker_t *wrk)
 184 {
 185   vcl_test_session_t *conn;
 186   int i;
 187
 188   for (i = 0; i < wrk->conn_pool_size; i++)
 189     {
 190       conn = &wrk->conn_pool[i];
 191       vts_session_cleanup (conn);
 192     }
 193
 194   wrk->nfds = 0;
 195 }
 196
 197 static void
 198 vts_test_cmd (vcl_test_server_worker_t *wrk, vcl_test_session_t *conn,
 199               hs_test_cfg_t *rx_cfg)
 200 {
 201   u8 is_bi = rx_cfg->test == HS_TEST_TYPE_BI;
 202   vcl_test_session_t *tc;
 203   char buf[64];
 204   int i;
 205
 206   if (rx_cfg->cmd == HS_TEST_CMD_STOP)
 207     {
 208       struct timespec stop;
 209       clock_gettime (CLOCK_REALTIME, &stop);
 210
 211       /* Test session are not closed, e.g., connection-less or errors */
 212       if (wrk->nfds > 1)
 213         {
 214           vtinf ("%u sessions are still open", wrk->nfds - 1);
 215           stop.tv_sec -= VCL_TEST_DELAY_DISCONNECT;
 216           conn->stats.stop = stop;
 217         }
 218
 219       /* Accumulate stats over all of the worker's sessions */
 220       for (i = 0; i < wrk->conn_pool_size; i++)
 221         {
 222           tc = &wrk->conn_pool[i];
 223           if (tc == conn)
 224             continue;
 225
 226           vcl_test_stats_accumulate (&conn->stats, &tc->stats);
 227           if (tc->is_open)
 228             {
 229               vts_session_cleanup (tc);
 230               continue;
 231             }
 232           /* Only relevant if all connections previously closed */
 233           if (vcl_comp_tspec (&conn->stats.stop, &tc->stats.stop) < 0)
 234             conn->stats.stop = tc->stats.stop;
 235         }
 236
 237       if (conn->cfg.verbose)
 238         {
 239           snprintf (buf, sizeof (buf), "SERVER (fd %d) RESULTS", conn->fd);
 240           vcl_test_stats_dump (buf, &conn->stats, 1 /* show_rx */,
 241                                is_bi /* show tx */, conn->cfg.verbose);
 242         }
 243
 244       vcl_test_stats_dump ("SERVER RESULTS", &conn->stats, 1 /* show_rx */ ,
 245                            is_bi /* show_tx */ , conn->cfg.verbose);
 246       hs_test_cfg_dump (&conn->cfg, 0 /* is_client */);
 247       if (conn->cfg.verbose)
 248         {
 249           vtinf ("  vcl server main\n" HS_TEST_SEPARATOR_STRING
 250                  "       buf:  %p\n"
 251                  "  buf size:  %u (0x%08x)\n" HS_TEST_SEPARATOR_STRING,
 252                  conn->rxbuf, conn->rxbuf_size, conn->rxbuf_size);
 253         }
 254
 255       sync_config_and_reply (conn, rx_cfg);
 256       memset (&conn->stats, 0, sizeof (conn->stats));
 257     }
 258   else if (rx_cfg->cmd == HS_TEST_CMD_SYNC)
 259     {
 260       rx_cfg->ctrl_handle = conn->fd;
 261       vtinf ("Set control fd %d for test!", conn->fd);
 262       sync_config_and_reply (conn, rx_cfg);
 263     }
 264   else if (rx_cfg->cmd == HS_TEST_CMD_START)
 265     {
 266       vtinf ("Starting %s-directional Stream Test (fd %d)!",
 267              is_bi ? "Bi" : "Uni", conn->fd);
 268       rx_cfg->ctrl_handle = conn->fd;
 269       sync_config_and_reply (conn, rx_cfg);
 270
 271       /* read the 1st chunk, record start time */
 272       memset (&conn->stats, 0, sizeof (conn->stats));
 273       clock_gettime (CLOCK_REALTIME, &conn->stats.start);
 274     }
 275 }
 276
 277 static inline void
 278 vts_server_process_rx (vcl_test_session_t *conn, int rx_bytes)
 279 {
 280   vcl_test_server_main_t *vsm = &vcl_server_main;
 281
 282   if (conn->cfg.test == HS_TEST_TYPE_BI)
 283     {
 284       if (vsm->use_ds)
 285         {
 286           (void) vcl_test_write (conn, conn->ds[0].data, conn->ds[0].len);
 287           if (conn->ds[1].len)
 288             (void) vcl_test_write (conn, conn->ds[1].data, conn->ds[1].len);
 289         }
 290       else
 291         (void) vcl_test_write (conn, conn->rxbuf, rx_bytes);
 292     }
 293
 294   if (vsm->use_ds)
 295     vppcom_session_free_segments (conn->fd, rx_bytes);
 296
 297   if (conn->stats.rx_bytes >= conn->cfg.total_bytes)
 298     clock_gettime (CLOCK_REALTIME, &conn->stats.stop);
 299 }
 300
 301 static void
 302 vts_server_echo (vcl_test_session_t *conn, int rx_bytes)
 303 {
 304   int tx_bytes, nbytes, pos;
 305
 306   /* If it looks vaguely like a string, make sure it's terminated */
 307   pos = rx_bytes < conn->rxbuf_size ? rx_bytes : conn->rxbuf_size - 1;
 308   ((char *) conn->rxbuf)[pos] = 0;
 309   vtinf ("(fd %d): RX (%d bytes) - '%s'", conn->fd, rx_bytes, conn->rxbuf);
 310
 311   if (conn->cfg.verbose)
 312     vtinf ("(fd %d): Echoing back", conn->fd);
 313
 314   nbytes = strlen ((const char *) conn->rxbuf) + 1;
 315   tx_bytes = conn->write (conn, conn->rxbuf, nbytes);
 316   if (tx_bytes >= 0)
 317     vtinf ("(fd %d): TX (%d bytes) - '%s'", conn->fd, tx_bytes, conn->rxbuf);
 318 }
 319
 320 static vcl_test_session_t *
 321 vts_accept_ctrl (vcl_test_server_worker_t *wrk, int listen_fd)
 322 {
 323   vcl_test_server_main_t *vsm = &vcl_server_main;
 324   const vcl_test_proto_vft_t *tp;
 325   vcl_test_session_t *conn;
 326   struct epoll_event ev;
 327   int rv;
 328
 329   conn = conn_pool_alloc (wrk);
 330   if (!conn)
 331     {
 332       vtwrn ("No free connections!");
 333       return 0;
 334     }
 335
 336   if (vsm->ctrl)
 337     conn->cfg = vsm->ctrl->cfg;
 338   vcl_test_session_buf_alloc (conn);
 339   clock_gettime (CLOCK_REALTIME, &conn->old_stats.stop);
 340
 341   tp = vcl_test_main.protos[VPPCOM_PROTO_TCP];
 342   if (tp->accept (listen_fd, conn))
 343     return 0;
 344
 345   vtinf ("CTRL accepted fd = %d (0x%08x) on listener fd = %d (0x%08x)",
 346          conn->fd, conn->fd, listen_fd, listen_fd);
 347
 348   ev.events = EPOLLET | EPOLLIN;
 349   ev.data.u64 = conn - wrk->conn_pool;
 350   rv = vppcom_epoll_ctl (wrk->epfd, EPOLL_CTL_ADD, conn->fd, &ev);
 351   if (rv < 0)
 352     {
 353       vterr ("vppcom_epoll_ctl()", rv);
 354       return 0;
 355     }
 356
 357   wrk->nfds++;
 358
 359   return conn;
 360 }
 361
 362 static vcl_test_session_t *
 363 vts_accept_client (vcl_test_server_worker_t *wrk, int listen_fd)
 364 {
 365   vcl_test_server_main_t *vsm = &vcl_server_main;
 366   const vcl_test_proto_vft_t *tp;
 367   vcl_test_session_t *conn;
 368   struct epoll_event ev;
 369   int rv;
 370
 371   conn = conn_pool_alloc (wrk);
 372   if (!conn)
 373     {
 374       vtwrn ("No free connections!");
 375       return 0;
 376     }
 377
 378   if (vsm->ctrl)
 379     conn->cfg = vsm->ctrl->cfg;
 380   vcl_test_session_buf_alloc (conn);
 381   clock_gettime (CLOCK_REALTIME, &conn->old_stats.stop);
 382
 383   tp = vcl_test_main.protos[vsm->server_cfg.proto];
 384   if (tp->accept (listen_fd, conn))
 385     return 0;
 386
 387   if (conn->cfg.num_test_sessions < VCL_TEST_CFG_MAX_SELECT_SESS)
 388     vtinf ("Got a connection -- fd = %d (0x%08x) on listener fd = %d (0x%08x)",
 389            conn->fd, conn->fd, listen_fd, listen_fd);
 390
 391   ev.events = EPOLLET | EPOLLIN;
 392   ev.data.u64 = conn - wrk->conn_pool;
 393   rv = vppcom_epoll_ctl (wrk->epfd, EPOLL_CTL_ADD, conn->fd, &ev);
 394   if (rv < 0)
 395     {
 396       vterr ("vppcom_epoll_ctl()", rv);
 397       return 0;
 398     }
 399   wrk->nfds++;
 400
 401   return conn;
 402 }
 403
 404 static void
 405 print_usage_and_exit (void)
 406 {
 407   fprintf (stderr, "vcl_test_server [OPTIONS] <port>\n"
 408                    "  OPTIONS\n"
 409                    "  -h               Print this message and exit.\n"
 410                    "  -6               Use IPv6\n"
 411                    "  -w <num>         Number of workers\n"
 412                    "  -p <PROTO>       Use <PROTO> transport layer\n"
 413                    "  -D               Use UDP transport layer\n"
 414                    "  -L               Use TLS transport layer\n"
 415                    "  -S               Incremental stats\n");
 416   exit (1);
 417 }
 418
 419 static void
 420 vcl_test_init_endpoint_addr (vcl_test_server_main_t * vsm)
 421 {
 422   struct sockaddr_storage *servaddr = &vsm->servaddr;
 423   memset (servaddr, 0, sizeof (*servaddr));
 424
 425   if (vsm->server_cfg.address_ip6)
 426     {
 427       struct sockaddr_in6 *server_addr = (struct sockaddr_in6 *) servaddr;
 428       server_addr->sin6_family = AF_INET6;
 429       server_addr->sin6_addr = in6addr_any;
 430       server_addr->sin6_port = htons (vsm->server_cfg.port);
 431     }
 432   else
 433     {
 434       struct sockaddr_in *server_addr = (struct sockaddr_in *) servaddr;
 435       server_addr->sin_family = AF_INET;
 436       server_addr->sin_addr.s_addr = htonl (INADDR_ANY);
 437       server_addr->sin_port = htons (vsm->server_cfg.port);
 438     }
 439
 440   if (vsm->server_cfg.address_ip6)
 441     {
 442       struct sockaddr_in6 *server_addr = (struct sockaddr_in6 *) servaddr;
 443       vsm->server_cfg.endpt.is_ip4 = 0;
 444       vsm->server_cfg.endpt.ip = (uint8_t *) &server_addr->sin6_addr;
 445       vsm->server_cfg.endpt.port = (uint16_t) server_addr->sin6_port;
 446     }
 447   else
 448     {
 449       struct sockaddr_in *server_addr = (struct sockaddr_in *) servaddr;
 450       vsm->server_cfg.endpt.is_ip4 = 1;
 451       vsm->server_cfg.endpt.ip = (uint8_t *) &server_addr->sin_addr;
 452       vsm->server_cfg.endpt.port = (uint16_t) server_addr->sin_port;
 453     }
 454 }
 455
 456 static void
 457 vcl_test_server_process_opts (vcl_test_server_main_t * vsm, int argc,
 458                               char **argv)
 459 {
 460   int v, c;
 461
 462   vsm->server_cfg.proto = VPPCOM_PROTO_TCP;
 463
 464   opterr = 0;
 465   while ((c = getopt (argc, argv, "6DLsw:hp:S")) != -1)
 466     switch (c)
 467       {
 468       case '6':
 469         vsm->server_cfg.address_ip6 = 1;
 470         break;
 471
 472       case 'p':
 473         if (vppcom_unformat_proto (&vsm->server_cfg.proto, optarg))
 474           vtwrn ("Invalid vppcom protocol %s, defaulting to TCP", optarg);
 475         break;
 476
 477       case 'D':
 478         vsm->server_cfg.proto = VPPCOM_PROTO_UDP;
 479         break;
 480
 481       case 'L':
 482         vsm->server_cfg.proto = VPPCOM_PROTO_TLS;
 483         break;
 484
 485       case 'w':
 486         v = atoi (optarg);
 487         if (v > 1)
 488           vsm->server_cfg.workers = v;
 489         else
 490           vtwrn ("Invalid number of workers %d", v);
 491         break;
 492       case 's':
 493         vsm->use_ds = 1;
 494         break;
 495       case 'S':
 496         vsm->incremental_stats = 1;
 497         break;
 498       case '?':
 499         switch (optopt)
 500           {
 501           case 'w':
 502           case 'p':
 503             vtwrn ("Option `-%c' requires an argument.", optopt);
 504             break;
 505           default:
 506             if (isprint (optopt))
 507               vtwrn ("Unknown option `-%c'.", optopt);
 508             else
 509               vtwrn ("Unknown option character `\\x%x'.", optopt);
 510           }
 511         /* fall thru */
 512       case 'h':
 513       default:
 514         print_usage_and_exit ();
 515       }
 516
 517   if (argc > (optind + 1))
 518     {
 519       fprintf (stderr, "Incorrect number of arguments!\n");
 520       print_usage_and_exit ();
 521     }
 522   else if (argc > 1 && argc == (optind + 1))
 523     {
 524       if (sscanf (argv[optind], "%d", &v) == 1)
 525         vsm->server_cfg.port = (uint16_t) v;
 526       else
 527         {
 528           fprintf (stderr, "Invalid port (%s)!\n", argv[optind]);
 529           print_usage_and_exit ();
 530         }
 531     }
 532
 533   vcl_test_init_endpoint_addr (vsm);
 534 }
 535
 536 int
 537 vts_handle_ctrl_cfg (vcl_test_server_worker_t *wrk, hs_test_cfg_t *rx_cfg,
 538                      vcl_test_session_t *conn, int rx_bytes)
 539 {
 540   if (rx_cfg->verbose)
 541     {
 542       vtinf ("(fd %d): Received a cfg msg!", conn->fd);
 543       hs_test_cfg_dump (rx_cfg, 0 /* is_client */);
 544     }
 545
 546   if (rx_bytes != sizeof (*rx_cfg))
 547     {
 548       vtinf ("(fd %d): Invalid cfg msg size %d expected %lu!", conn->fd,
 549              rx_bytes, sizeof (*rx_cfg));
 550       conn->cfg.rxbuf_size = 0;
 551       conn->cfg.num_writes = 0;
 552       if (conn->cfg.verbose)
 553         {
 554           vtinf ("(fd %d): Replying to cfg msg", conn->fd);
 555           hs_test_cfg_dump (rx_cfg, 0 /* is_client */);
 556         }
 557       conn->write (conn, &conn->cfg, sizeof (conn->cfg));
 558       return -1;
 559     }
 560
 561   switch (rx_cfg->test)
 562     {
 563     case HS_TEST_TYPE_NONE:
 564     case HS_TEST_TYPE_ECHO:
 565       sync_config_and_reply (conn, rx_cfg);
 566       break;
 567
 568     case HS_TEST_TYPE_BI:
 569     case HS_TEST_TYPE_UNI:
 570       vts_test_cmd (wrk, conn, rx_cfg);
 571       break;
 572
 573     case HS_TEST_TYPE_EXIT:
 574       vtinf ("Ctrl session fd %d closing!", conn->fd);
 575       vts_session_cleanup (conn);
 576       wrk->nfds--;
 577       if (wrk->nfds)
 578         vts_wrk_cleanup_all (wrk);
 579       vcl_server_main.ctrl = 0;
 580       break;
 581
 582     default:
 583       vtwrn ("Unknown test type %d", rx_cfg->test);
 584       hs_test_cfg_dump (rx_cfg, 0 /* is_client */);
 585       break;
 586     }
 587
 588   return 0;
 589 }
 590
 591 static void
 592 vts_worker_init (vcl_test_server_worker_t * wrk)
 593 {
 594   vcl_test_server_main_t *vsm = &vcl_server_main;
 595   vcl_test_main_t *vt = &vcl_test_main;
 596   const vcl_test_proto_vft_t *tp;
 597   struct epoll_event listen_ev;
 598   int rv;
 599
 600   __wrk_index = wrk->wrk_index;
 601
 602   vtinf ("Initializing worker ...");
 603
 604   conn_pool_expand (wrk, VCL_TEST_CFG_INIT_TEST_SESS + 1);
 605   if (wrk->wrk_index)
 606     if (vppcom_worker_register ())
 607       vtfail ("vppcom_worker_register()", 1);
 608
 609   tp = vt->protos[vsm->server_cfg.proto];
 610   if ((rv = tp->listen (&wrk->listener, &vsm->server_cfg.endpt)))
 611     vtfail ("proto listen", rv);
 612
 613   /* First worker already has epoll fd */
 614   if (wrk->wrk_index)
 615     {
 616       wrk->epfd = vppcom_epoll_create ();
 617       if (wrk->epfd < 0)
 618         vtfail ("vppcom_epoll_create()", wrk->epfd);
 619     }
 620
 621   listen_ev.events = EPOLLET | EPOLLIN;
 622   listen_ev.data.u32 = VCL_TEST_DATA_LISTENER;
 623   rv =
 624     vppcom_epoll_ctl (wrk->epfd, EPOLL_CTL_ADD, wrk->listener.fd, &listen_ev);
 625   if (rv < 0)
 626     vtfail ("vppcom_epoll_ctl", rv);
 627
 628   vsm->active_workers += 1;
 629   vtinf ("Waiting for client data connections on port %d ...",
 630          ntohs (vsm->server_cfg.endpt.port));
 631 }
 632
 633 static inline int
 634 vts_conn_read (vcl_test_session_t *conn)
 635 {
 636   vcl_test_server_main_t *vsm = &vcl_server_main;
 637   if (vsm->use_ds)
 638     return vcl_test_read_ds (conn);
 639   else
 640     return conn->read (conn, conn->rxbuf, conn->rxbuf_size);
 641 }
 642
 643 static void
 644 vts_inc_stats_check (vcl_test_session_t *ts)
 645 {
 646   /* Avoid checking time too often because of syscall cost */
 647   if (ts->stats.rx_bytes - ts->old_stats.rx_bytes < 1 << 20)
 648     return;
 649
 650   clock_gettime (CLOCK_REALTIME, &ts->stats.stop);
 651   if (vcl_test_time_diff (&ts->old_stats.stop, &ts->stats.stop) > 1)
 652     {
 653       vcl_test_stats_dump_inc (ts, 1 /* is_rx */);
 654       ts->old_stats = ts->stats;
 655     }
 656 }
 657
 658 static void *
 659 vts_worker_loop (void *arg)
 660 {
 661   struct epoll_event ep_evts[VCL_TEST_CFG_MAX_EPOLL_EVENTS];
 662   vcl_test_server_main_t *vsm = &vcl_server_main;
 663   vcl_test_server_worker_t *wrk = arg;
 664   vcl_test_session_t *conn;
 665   int i, rx_bytes, num_ev;
 666   hs_test_cfg_t *rx_cfg;
 667
 668   if (wrk->wrk_index)
 669     vts_worker_init (wrk);
 670
 671   while (1)
 672     {
 673       num_ev =
 674         vppcom_epoll_wait (wrk->epfd, ep_evts, VCL_TEST_CFG_MAX_EPOLL_EVENTS,
 675                            0 /* poll session events */);
 676       if (num_ev < 0)
 677         {
 678           vterr ("vppcom_epoll_wait()", num_ev);
 679           goto fail;
 680         }
 681       else if (num_ev == 0)
 682         {
 683           continue;
 684         }
 685       for (i = 0; i < num_ev; i++)
 686         {
 687           conn = &wrk->conn_pool[ep_evts[i].data.u32];
 688           /*
 689            * Check for close events
 690            */
 691           if (ep_evts[i].events & (EPOLLHUP | EPOLLRDHUP))
 692             {
 693               if (conn == vsm->ctrl)
 694                 {
 695                   vtinf ("ctrl session went away");
 696                   vsm->ctrl = 0;
 697                 }
 698               vts_session_cleanup (conn);
 699               wrk->nfds--;
 700               continue;
 701             }
 702
 703           /*
 704            * Check if new session needs to be accepted
 705            */
 706
 707           if (!wrk->wrk_index && ep_evts[i].data.u32 == VCL_TEST_CTRL_LISTENER)
 708             {
 709               if (vsm->ctrl)
 710                 {
 711                   vtwrn ("ctrl already exists");
 712                   continue;
 713                 }
 714               vsm->ctrl = vts_accept_ctrl (wrk, vsm->ctrl_listen_fd);
 715               continue;
 716             }
 717
 718           /* at this point ctrl session must be valid */
 719           ASSERT (vsm->ctrl);
 720
 721           if (ep_evts[i].data.u32 == VCL_TEST_DATA_LISTENER)
 722             {
 723               conn = vts_accept_client (wrk, wrk->listener.fd);
 724               conn->cfg = vsm->ctrl->cfg;
 725               continue;
 726             }
 727           else if (vppcom_session_is_connectable_listener (conn->fd))
 728             {
 729               vts_accept_client (wrk, conn->fd);
 730               continue;
 731             }
 732
 733           /*
 734            * Message on control session
 735            */
 736
 737           if (!wrk->wrk_index && conn->fd == vsm->ctrl->fd)
 738             {
 739               rx_bytes = conn->read (conn, conn->rxbuf, conn->rxbuf_size);
 740               rx_cfg = (hs_test_cfg_t *) conn->rxbuf;
 741               if (rx_cfg->magic == HS_TEST_CFG_CTRL_MAGIC)
 742                 {
 743                   vts_handle_ctrl_cfg (wrk, rx_cfg, conn, rx_bytes);
 744                   if (!wrk->nfds)
 745                     {
 746                       vtinf ("All client connections closed\n");
 747                       goto done;
 748                     }
 749                 }
 750               else if (isascii (conn->rxbuf[0]))
 751                 {
 752                   vts_server_echo (conn, rx_bytes);
 753                 }
 754               else
 755                 {
 756                   vtwrn ("FIFO not drained! extra bytes %d", rx_bytes);
 757                 }
 758               continue;
 759             }
 760
 761           /*
 762            * Read perf test data
 763            */
 764
 765           if (EPOLLIN & ep_evts[i].events)
 766             {
 767             read_again:
 768               rx_bytes = vts_conn_read (conn);
 769
 770               if (rx_bytes <= 0)
 771                 {
 772                   if (errno == ECONNRESET)
 773                     {
 774                       vtinf ("Connection reset by remote peer.\n");
 775                       goto fail;
 776                     }
 777                   else
 778                     continue;
 779                 }
 780               vts_server_process_rx (conn, rx_bytes);
 781               if (vppcom_session_attr (conn->fd, VPPCOM_ATTR_GET_NREAD, 0, 0) >
 782                   0)
 783                 goto read_again;
 784               if (vsm->incremental_stats)
 785                 vts_inc_stats_check (conn);
 786               continue;
 787             }
 788           else
 789             {
 790               vtwrn ("Unhandled event");
 791               goto fail;
 792             }
 793         }
 794     }
 795
 796 fail:
 797   vsm->worker_fails -= 1;
 798
 799 done:
 800   vppcom_session_close (wrk->listener.fd);
 801   if (wrk->conn_pool)
 802     free (wrk->conn_pool);
 803   vsm->active_workers -= 1;
 804   return 0;
 805 }
 806
 807 static void
 808 vts_ctrl_session_init (vcl_test_server_worker_t *wrk)
 809 {
 810   vcl_test_server_main_t *vsm = &vcl_server_main;
 811   struct epoll_event listen_ev;
 812   int rv;
 813
 814   vtinf ("Initializing main ctrl session ...");
 815
 816   vsm->ctrl_listen_fd =
 817     vppcom_session_create (VPPCOM_PROTO_TCP, 0 /* is_nonblocking */);
 818   if (vsm->ctrl_listen_fd < 0)
 819     vtfail ("vppcom_session_create()", vsm->ctrl_listen_fd);
 820
 821   rv = vppcom_session_bind (vsm->ctrl_listen_fd, &vsm->server_cfg.endpt);
 822   if (rv < 0)
 823     vtfail ("vppcom_session_bind()", rv);
 824
 825   rv = vppcom_session_listen (vsm->ctrl_listen_fd, 10);
 826   if (rv < 0)
 827     vtfail ("vppcom_session_listen()", rv);
 828
 829   wrk->epfd = vppcom_epoll_create ();
 830   if (wrk->epfd < 0)
 831     vtfail ("vppcom_epoll_create()", wrk->epfd);
 832
 833   listen_ev.events = EPOLLET | EPOLLIN;
 834   listen_ev.data.u32 = VCL_TEST_CTRL_LISTENER;
 835   rv = vppcom_epoll_ctl (wrk->epfd, EPOLL_CTL_ADD, vsm->ctrl_listen_fd,
 836                          &listen_ev);
 837   if (rv < 0)
 838     vtfail ("vppcom_epoll_ctl", rv);
 839
 840   vtinf ("Waiting for client ctrl connection on port %d ...",
 841          vsm->server_cfg.port);
 842 }
 843
 844 int
 845 main (int argc, char **argv)
 846 {
 847   vcl_test_server_main_t *vsm = &vcl_server_main;
 848   vcl_test_main_t *vt = &vcl_test_main;
 849   int rv, i;
 850
 851   clib_mem_init_thread_safe (0, 64 << 20);
 852   vsm->server_cfg.port = VCL_TEST_SERVER_PORT;
 853   vsm->server_cfg.workers = 1;
 854   vsm->active_workers = 0;
 855   vcl_test_server_process_opts (vsm, argc, argv);
 856
 857   rv = vppcom_app_create ("vcl_test_server");
 858   if (rv)
 859     vtfail ("vppcom_app_create()", rv);
 860
 861   /* Protos like tls/dtls/quic need init */
 862   if (vt->protos[vsm->server_cfg.proto]->init)
 863     vt->protos[vsm->server_cfg.proto]->init (0);
 864
 865   vsm->workers = calloc (vsm->server_cfg.workers, sizeof (*vsm->workers));
 866   vts_ctrl_session_init (&vsm->workers[0]);
 867
 868   /* Update ctrl port to data port */
 869   vsm->server_cfg.endpt.port = hs_make_data_port (vsm->server_cfg.endpt.port);
 870   vts_worker_init (&vsm->workers[0]);
 871   for (i = 1; i < vsm->server_cfg.workers; i++)
 872     {
 873       vsm->workers[i].wrk_index = i;
 874       rv = pthread_create (&vsm->workers[i].thread_handle, NULL,
 875                            vts_worker_loop, (void *) &vsm->workers[i]);
 876       if (rv)
 877         vtfail ("pthread_create()", rv);
 878     }
 879
 880   vts_worker_loop (&vsm->workers[0]);
 881
 882   while (vsm->active_workers > 0)
 883     ;
 884
 885   vppcom_app_destroy ();
 886   free (vsm->workers);
 887
 888   return vsm->worker_fails;
 889 }
 890
 891 /*
 892  * fd.io coding-style-patch-verification: ON
 893  *
 894  * Local Variables:
 895  * eval: (c-set-style "gnu")
 896  * End:
 897  */