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