src/tests/vnet/session/tcp_echo.c

   1 /*
   2  * Copyright (c) 2016 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 <stdio.h>
  17 #include <signal.h>
  18
  19 #include <vnet/session/application_interface.h>
  20 #include <svm/svm_fifo_segment.h>
  21 #include <vlibmemory/api.h>
  22
  23 #include <vpp/api/vpe_msg_enum.h>
  24
  25 #define vl_typedefs             /* define message structures */
  26 #include <vpp/api/vpe_all_api_h.h>
  27 #undef vl_typedefs
  28
  29 /* declare message handlers for each api */
  30
  31 #define vl_endianfun            /* define message structures */
  32 #include <vpp/api/vpe_all_api_h.h>
  33 #undef vl_endianfun
  34
  35 /* instantiate all the print functions we know about */
  36 #define vl_print(handle, ...)
  37 #define vl_printfun
  38 #include <vpp/api/vpe_all_api_h.h>
  39 #undef vl_printfun
  40
  41 #define TCP_ECHO_DBG 0
  42 #define DBG(_fmt,_args...)                      \
  43     if (TCP_ECHO_DBG)                           \
  44       clib_warning (_fmt, _args)
  45
  46 typedef struct
  47 {
  48   svm_fifo_t *server_rx_fifo;
  49   svm_fifo_t *server_tx_fifo;
  50
  51   svm_msg_q_t *vpp_evt_q;
  52
  53   u64 vpp_session_handle;
  54   u64 bytes_sent;
  55   u64 bytes_to_send;
  56   volatile u64 bytes_received;
  57   volatile u64 bytes_to_receive;
  58   f64 start;
  59 } session_t;
  60
  61 typedef enum
  62 {
  63   STATE_START,
  64   STATE_ATTACHED,
  65   STATE_READY,
  66   STATE_DISCONNECTING,
  67   STATE_FAILED,
  68   STATE_DETACHED
  69 } connection_state_t;
  70
  71 typedef struct
  72 {
  73   /* vpe input queue */
  74   svm_queue_t *vl_input_queue;
  75
  76   /* API client handle */
  77   u32 my_client_index;
  78
  79   /* The URI we're playing with */
  80   u8 *uri;
  81
  82   /* Session pool */
  83   session_t *sessions;
  84
  85   /* Hash table for disconnect processing */
  86   uword *session_index_by_vpp_handles;
  87
  88   /* intermediate rx buffer */
  89   u8 *rx_buf;
  90
  91   /* URI for slave's connect */
  92   u8 *connect_uri;
  93
  94   u32 connected_session_index;
  95
  96   int i_am_master;
  97
  98   /* drop all packets */
  99   int no_return;
 100
 101   /* Our event queue */
 102   svm_msg_q_t *our_event_queue;
 103
 104   /* $$$ single thread only for the moment */
 105   svm_queue_t *vpp_event_queue;
 106
 107   u8 *socket_name;
 108
 109   pid_t my_pid;
 110
 111   /* For deadman timers */
 112   clib_time_t clib_time;
 113
 114   /* State of the connection, shared between msg RX thread and main thread */
 115   volatile connection_state_t state;
 116
 117   /* Signal variables */
 118   volatile int time_to_stop;
 119   volatile int time_to_print_stats;
 120
 121   u32 configured_segment_size;
 122
 123   /* VNET_API_ERROR_FOO -> "Foo" hash table */
 124   uword *error_string_by_error_number;
 125
 126   u8 *connect_test_data;
 127   pthread_t *client_thread_handles;
 128   u32 *thread_args;
 129   u32 client_bytes_received;
 130   u8 test_return_packets;
 131   u64 bytes_to_send;
 132   u32 fifo_size;
 133
 134   u32 n_clients;
 135   u64 tx_total;
 136   u64 rx_total;
 137
 138   volatile u32 n_clients_connected;
 139   volatile u32 n_active_clients;
 140
 141
 142   /** Flag that decides if socket, instead of svm, api is used to connect to
 143    * vpp. If sock api is used, shm binary api is subsequently bootstrapped
 144    * and all other messages are exchanged using shm IPC. */
 145   u8 use_sock_api;
 146
 147   /* convenience */
 148   svm_fifo_segment_main_t *segment_main;
 149 } echo_main_t;
 150
 151 echo_main_t echo_main;
 152
 153 #if CLIB_DEBUG > 0
 154 #define NITER 10000
 155 #else
 156 #define NITER 4000000
 157 #endif
 158
 159 const char test_srv_crt_rsa[] =
 160   "-----BEGIN CERTIFICATE-----\r\n"
 161   "MIID5zCCAs+gAwIBAgIJALeMYCEHrTtJMA0GCSqGSIb3DQEBCwUAMIGJMQswCQYD\r\n"
 162   "VQQGEwJVUzELMAkGA1UECAwCQ0ExETAPBgNVBAcMCFNhbiBKb3NlMQ4wDAYDVQQK\r\n"
 163   "DAVDaXNjbzEOMAwGA1UECwwFZmQuaW8xFjAUBgNVBAMMDXRlc3R0bHMuZmQuaW8x\r\n"
 164   "IjAgBgkqhkiG9w0BCQEWE3ZwcC1kZXZAbGlzdHMuZmQuaW8wHhcNMTgwMzA1MjEx\r\n"
 165   "NTEyWhcNMjgwMzAyMjExNTEyWjCBiTELMAkGA1UEBhMCVVMxCzAJBgNVBAgMAkNB\r\n"
 166   "MREwDwYDVQQHDAhTYW4gSm9zZTEOMAwGA1UECgwFQ2lzY28xDjAMBgNVBAsMBWZk\r\n"
 167   "LmlvMRYwFAYDVQQDDA10ZXN0dGxzLmZkLmlvMSIwIAYJKoZIhvcNAQkBFhN2cHAt\r\n"
 168   "ZGV2QGxpc3RzLmZkLmlvMIIBIjANBgkqhkiG9w0BAQEFAAOCAQ8AMIIBCgKCAQEA\r\n"
 169   "4C1k8a1DuStgggqT4o09fP9sJ2dC54bxhS/Xk2VEfaIZ222WSo4X/syRVfVy9Yah\r\n"
 170   "cpI1zJ/RDxaZSFhgA+nPZBrFMsrULkrdAOpOVj8eDEp9JuWdO2ODSoFnCvLxcYWB\r\n"
 171   "Yc5kHryJpEaGJl1sFQSesnzMFty/59ta0stk0Fp8r5NhIjWvSovGzPo6Bhz+VS2c\r\n"
 172   "ebIZh4x1t2hHaFcgm0qJoJ6DceReWCW8w+yOVovTolGGq+bpb2Hn7MnRSZ2K2NdL\r\n"
 173   "+aLXpkZbS/AODP1FF2vTO1mYL290LO7/51vJmPXNKSDYMy5EvILr5/VqtjsFCwRL\r\n"
 174   "Q4jcM/+GeHSAFWx4qIv0BwIDAQABo1AwTjAdBgNVHQ4EFgQUWa1SOB37xmT53tZQ\r\n"
 175   "aXuLLhRI7U8wHwYDVR0jBBgwFoAUWa1SOB37xmT53tZQaXuLLhRI7U8wDAYDVR0T\r\n"
 176   "BAUwAwEB/zANBgkqhkiG9w0BAQsFAAOCAQEAoUht13W4ya27NVzQuCMvqPWL3VM4\r\n"
 177   "3xbPFk02FaGz/WupPu276zGlzJAZrbuDcQowwwU1Ni1Yygxl96s1c2M5rHDTrOKG\r\n"
 178   "rK0hbkSFBo+i6I8u4HiiQ4rYmG0Hv6+sXn3of0HsbtDPGgWZoipPWDljPYEURu3e\r\n"
 179   "3HRe/Dtsj9CakBoSDzs8ndWaBR+f4sM9Tk1cjD46Gq2T/qpSPXqKxEUXlzhdCAn4\r\n"
 180   "twub17Bq2kykHpppCwPg5M+v30tHG/R2Go15MeFWbEJthFk3TZMjKL7UFs7fH+x2\r\n"
 181   "wSonXb++jY+KmCb93C+soABBizE57g/KmiR2IxQ/LMjDik01RSUIaM0lLA==\r\n"
 182   "-----END CERTIFICATE-----\r\n";
 183 const u32 test_srv_crt_rsa_len = sizeof (test_srv_crt_rsa);
 184
 185 const char test_srv_key_rsa[] =
 186   "-----BEGIN PRIVATE KEY-----\r\n"
 187   "MIIEvQIBADANBgkqhkiG9w0BAQEFAASCBKcwggSjAgEAAoIBAQDgLWTxrUO5K2CC\r\n"
 188   "CpPijT18/2wnZ0LnhvGFL9eTZUR9ohnbbZZKjhf+zJFV9XL1hqFykjXMn9EPFplI\r\n"
 189   "WGAD6c9kGsUyytQuSt0A6k5WPx4MSn0m5Z07Y4NKgWcK8vFxhYFhzmQevImkRoYm\r\n"
 190   "XWwVBJ6yfMwW3L/n21rSy2TQWnyvk2EiNa9Ki8bM+joGHP5VLZx5shmHjHW3aEdo\r\n"
 191   "VyCbSomgnoNx5F5YJbzD7I5Wi9OiUYar5ulvYefsydFJnYrY10v5otemRltL8A4M\r\n"
 192   "/UUXa9M7WZgvb3Qs7v/nW8mY9c0pINgzLkS8guvn9Wq2OwULBEtDiNwz/4Z4dIAV\r\n"
 193   "bHioi/QHAgMBAAECggEBAMzGipP8+oT166U+NlJXRFifFVN1DvdhG9PWnOxGL+c3\r\n"
 194   "ILmBBC08WQzmHshPemBvR6DZkA1H23cV5JTiLWrFtC00CvhXsLRMrE5+uWotI6yE\r\n"
 195   "iofybMroHvD6/X5R510UX9hQ6MHu5ShLR5VZ9zXHz5MpTmB/60jG5dLx+jgcwBK8\r\n"
 196   "LuGv2YB/WCUwT9QJ3YU2eaingnXtz/MrFbkbltrqlnBdlD+kTtw6Yac9y1XuuQXc\r\n"
 197   "BPeulLNDuPolJVWbUvDBZrpt2dXTgz8ws1sv+wCNE0xwQJsqW4Nx3QkpibUL9RUr\r\n"
 198   "CVbKlNfa9lopT6nGKlgX69R/uH35yh9AOsfasro6w0ECgYEA82UJ8u/+ORah+0sF\r\n"
 199   "Q0FfW5MTdi7OAUHOz16pUsGlaEv0ERrjZxmAkHA/VRwpvDBpx4alCv0Hc39PFLIk\r\n"
 200   "nhSsM2BEuBkTAs6/GaoNAiBtQVE/hN7awNRWVmlieS0go3Y3dzaE9IUMyj8sPOFT\r\n"
 201   "5JdJ6BM69PHKCkY3dKdnnfpFEuECgYEA68mRpteunF1mdZgXs+WrN+uLlRrQR20F\r\n"
 202   "ZyMYiUCH2Dtn26EzA2moy7FipIIrQcX/j+KhYNGM3e7MU4LymIO29E18mn8JODnH\r\n"
 203   "sQOXzBTsf8A4yIVMkcuQD3bfb0JiUGYUPOidTp2N7IJA7+6Yc3vQOyb74lnKnJoO\r\n"
 204   "gougPT2wS+cCgYAn7muzb6xFsXDhyW0Tm6YJYBfRS9yAWEuVufINobeBZPSl2cN1\r\n"
 205   "Jrnw+HlrfTNbrJWuJmjtZJXUXQ6cVp2rUbjutNyRV4vG6iRwEXYQ40EJdkr1gZpi\r\n"
 206   "CHQhuShuuPih2MNAy7EEbM+sXrDjTBR3bFqzuHPzu7dp+BshCFX3lRfAAQKBgGQt\r\n"
 207   "K5i7IhCFDjb/+3IPLgOAK7mZvsvZ4eXD33TQ2eZgtut1PXtBtNl17/b85uv293Fm\r\n"
 208   "VDISVcsk3eLNS8zIiT6afUoWlxAwXEs0v5WRfjl4radkGvgGiJpJYvyeM67877RB\r\n"
 209   "EDSKc/X8ESLfOB44iGvZUEMG6zJFscx9DgN25iQZAoGAbyd+JEWwdVH9/K3IH1t2\r\n"
 210   "PBkZX17kNWv+iVM1WyFjbe++vfKZCrOJiyiqhDeEqgrP3AuNMlaaduC3VRC3G5oV\r\n"
 211   "Mj1tlhDWQ/qhvKdCKNdIVQYDE75nw+FRWV8yYkHAnXYW3tNoweDIwixE0hkPR1bc\r\n"
 212   "oEjPLVNtx8SOj/M4rhaPT3I=\r\n" "-----END PRIVATE KEY-----\r\n";
 213 const u32 test_srv_key_rsa_len = sizeof (test_srv_key_rsa);
 214
 215 static u8 *
 216 format_api_error (u8 * s, va_list * args)
 217 {
 218   echo_main_t *em = &echo_main;
 219   i32 error = va_arg (*args, u32);
 220   uword *p;
 221
 222   p = hash_get (em->error_string_by_error_number, -error);
 223
 224   if (p)
 225     s = format (s, "%s", p[0]);
 226   else
 227     s = format (s, "%d", error);
 228   return s;
 229 }
 230
 231 static void
 232 init_error_string_table (echo_main_t * em)
 233 {
 234   em->error_string_by_error_number = hash_create (0, sizeof (uword));
 235
 236 #define _(n,v,s) hash_set (em->error_string_by_error_number, -v, s);
 237   foreach_vnet_api_error;
 238 #undef _
 239
 240   hash_set (em->error_string_by_error_number, 99, "Misc");
 241 }
 242
 243 int
 244 wait_for_state_change (echo_main_t * em, connection_state_t state)
 245 {
 246 #if CLIB_DEBUG > 0
 247 #define TIMEOUT 600.0
 248 #else
 249 #define TIMEOUT 600.0
 250 #endif
 251
 252   f64 timeout = clib_time_now (&em->clib_time) + TIMEOUT;
 253
 254   while (clib_time_now (&em->clib_time) < timeout)
 255     {
 256       if (em->state == state)
 257         return 0;
 258       if (em->state == STATE_FAILED)
 259         return -1;
 260       if (em->time_to_stop == 1)
 261         return 0;
 262     }
 263   clib_warning ("timeout waiting for state %d", state);
 264   return -1;
 265 }
 266
 267 void
 268 application_send_attach (echo_main_t * em)
 269 {
 270   vl_api_application_attach_t *bmp;
 271   vl_api_application_tls_cert_add_t *cert_mp;
 272   vl_api_application_tls_key_add_t *key_mp;
 273
 274   bmp = vl_msg_api_alloc (sizeof (*bmp));
 275   memset (bmp, 0, sizeof (*bmp));
 276
 277   bmp->_vl_msg_id = ntohs (VL_API_APPLICATION_ATTACH);
 278   bmp->client_index = em->my_client_index;
 279   bmp->context = ntohl (0xfeedface);
 280   bmp->options[APP_OPTIONS_FLAGS] =
 281     APP_OPTIONS_FLAGS_ACCEPT_REDIRECT | APP_OPTIONS_FLAGS_ADD_SEGMENT;
 282   bmp->options[APP_OPTIONS_PREALLOC_FIFO_PAIRS] = 16;
 283   bmp->options[APP_OPTIONS_RX_FIFO_SIZE] = em->fifo_size;
 284   bmp->options[APP_OPTIONS_TX_FIFO_SIZE] = em->fifo_size;
 285   bmp->options[APP_OPTIONS_ADD_SEGMENT_SIZE] = 128 << 20;
 286   bmp->options[APP_OPTIONS_SEGMENT_SIZE] = 256 << 20;
 287   bmp->options[APP_OPTIONS_EVT_QUEUE_SIZE] = 256;
 288   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & bmp);
 289
 290   cert_mp = vl_msg_api_alloc (sizeof (*cert_mp) + test_srv_crt_rsa_len);
 291   memset (cert_mp, 0, sizeof (*cert_mp));
 292   cert_mp->_vl_msg_id = ntohs (VL_API_APPLICATION_TLS_CERT_ADD);
 293   cert_mp->client_index = em->my_client_index;
 294   cert_mp->context = ntohl (0xfeedface);
 295   cert_mp->cert_len = clib_host_to_net_u16 (test_srv_crt_rsa_len);
 296   clib_memcpy (cert_mp->cert, test_srv_crt_rsa, test_srv_crt_rsa_len);
 297   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & cert_mp);
 298
 299   key_mp = vl_msg_api_alloc (sizeof (*key_mp) + test_srv_key_rsa_len);
 300   memset (key_mp, 0, sizeof (*key_mp) + test_srv_key_rsa_len);
 301   key_mp->_vl_msg_id = ntohs (VL_API_APPLICATION_TLS_KEY_ADD);
 302   key_mp->client_index = em->my_client_index;
 303   key_mp->context = ntohl (0xfeedface);
 304   key_mp->key_len = clib_host_to_net_u16 (test_srv_key_rsa_len);
 305   clib_memcpy (key_mp->key, test_srv_key_rsa, test_srv_key_rsa_len);
 306   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & key_mp);
 307 }
 308
 309 int
 310 application_attach (echo_main_t * em)
 311 {
 312   application_send_attach (em);
 313   if (wait_for_state_change (em, STATE_ATTACHED))
 314     {
 315       clib_warning ("timeout waiting for STATE_ATTACHED");
 316       return -1;
 317     }
 318   return 0;
 319 }
 320
 321 void
 322 application_detach (echo_main_t * em)
 323 {
 324   vl_api_application_detach_t *bmp;
 325   bmp = vl_msg_api_alloc (sizeof (*bmp));
 326   memset (bmp, 0, sizeof (*bmp));
 327
 328   bmp->_vl_msg_id = ntohs (VL_API_APPLICATION_DETACH);
 329   bmp->client_index = em->my_client_index;
 330   bmp->context = ntohl (0xfeedface);
 331   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & bmp);
 332
 333   DBG ("%s", "Sent detach");
 334 }
 335
 336 static int
 337 memfd_segment_attach (void)
 338 {
 339   ssvm_private_t _ssvm = { 0 }, *ssvm = &_ssvm;
 340   clib_error_t *error;
 341   int rv;
 342
 343   if ((error = vl_socket_client_recv_fd_msg (&ssvm->fd, 5)))
 344     {
 345       clib_error_report (error);
 346       return -1;
 347     }
 348
 349   if ((rv = ssvm_slave_init_memfd (ssvm)))
 350     return rv;
 351
 352   return 0;
 353 }
 354
 355 static int
 356 fifo_segment_attach (char *name, u32 size, ssvm_segment_type_t type)
 357 {
 358   svm_fifo_segment_create_args_t _a, *a = &_a;
 359   clib_error_t *error;
 360   int rv;
 361
 362   memset (a, 0, sizeof (*a));
 363   a->segment_name = (char *) name;
 364   a->segment_size = size;
 365   a->segment_type = type;
 366
 367   if (type == SSVM_SEGMENT_MEMFD)
 368     {
 369       if ((error = vl_socket_client_recv_fd_msg (&a->memfd_fd, 5)))
 370         {
 371           clib_error_report (error);
 372           return -1;
 373         }
 374     }
 375
 376   if ((rv = svm_fifo_segment_attach (a)))
 377     {
 378       clib_warning ("svm_fifo_segment_attach ('%s') failed", name);
 379       return rv;
 380     }
 381
 382   return 0;
 383 }
 384
 385 static void
 386 vl_api_application_attach_reply_t_handler (vl_api_application_attach_reply_t *
 387                                            mp)
 388 {
 389   echo_main_t *em = &echo_main;
 390   ssvm_segment_type_t seg_type;
 391
 392   if (mp->retval)
 393     {
 394       clib_warning ("attach failed: %U", format_api_error,
 395                     clib_net_to_host_u32 (mp->retval));
 396       em->state = STATE_FAILED;
 397       return;
 398     }
 399
 400   if (mp->segment_name_length == 0)
 401     {
 402       clib_warning ("segment_name_length zero");
 403       return;
 404     }
 405
 406   seg_type = em->use_sock_api ? SSVM_SEGMENT_MEMFD : SSVM_SEGMENT_SHM;
 407
 408   /* Attach to fifo segment */
 409   if (fifo_segment_attach ((char *) mp->segment_name, mp->segment_size,
 410                            seg_type))
 411     {
 412       em->state = STATE_FAILED;
 413       return;
 414     }
 415
 416   /* If we're using memfd segments, read and attach to event qs segment */
 417   if (seg_type == SSVM_SEGMENT_MEMFD)
 418     {
 419       if (memfd_segment_attach ())
 420         {
 421           clib_warning ("failed to attach to evt q segment");
 422           em->state = STATE_FAILED;
 423           return;
 424         }
 425     }
 426
 427   ASSERT (mp->app_event_queue_address);
 428   em->our_event_queue = uword_to_pointer (mp->app_event_queue_address,
 429                                           svm_msg_q_t *);
 430   em->state = STATE_ATTACHED;
 431 }
 432
 433 static void
 434 vl_api_application_detach_reply_t_handler (vl_api_application_detach_reply_t *
 435                                            mp)
 436 {
 437   if (mp->retval)
 438     clib_warning ("detach returned with err: %d", mp->retval);
 439   echo_main.state = STATE_DETACHED;
 440 }
 441
 442 static void
 443 stop_signal (int signum)
 444 {
 445   echo_main_t *um = &echo_main;
 446
 447   um->time_to_stop = 1;
 448 }
 449
 450 static void
 451 stats_signal (int signum)
 452 {
 453   echo_main_t *um = &echo_main;
 454
 455   um->time_to_print_stats = 1;
 456 }
 457
 458 static clib_error_t *
 459 setup_signal_handlers (void)
 460 {
 461   signal (SIGINT, stats_signal);
 462   signal (SIGQUIT, stop_signal);
 463   signal (SIGTERM, stop_signal);
 464
 465   return 0;
 466 }
 467
 468 void
 469 vlib_cli_output (struct vlib_main_t *vm, char *fmt, ...)
 470 {
 471   clib_warning ("BUG");
 472 }
 473
 474 int
 475 connect_to_vpp (char *name)
 476 {
 477   echo_main_t *em = &echo_main;
 478   api_main_t *am = &api_main;
 479
 480   if (em->use_sock_api)
 481     {
 482       if (vl_socket_client_connect ((char *) em->socket_name, name,
 483                                     0 /* default rx, tx buffer */ ))
 484         {
 485           clib_warning ("socket connect failed");
 486           return -1;
 487         }
 488
 489       if (vl_socket_client_init_shm (0))
 490         {
 491           clib_warning ("init shm api failed");
 492           return -1;
 493         }
 494     }
 495   else
 496     {
 497       if (vl_client_connect_to_vlib ("/vpe-api", name, 32) < 0)
 498         {
 499           clib_warning ("shmem connect failed");
 500           return -1;
 501         }
 502     }
 503   em->vl_input_queue = am->shmem_hdr->vl_input_queue;
 504   em->my_client_index = am->my_client_index;
 505   return 0;
 506 }
 507
 508 void
 509 disconnect_from_vpp (echo_main_t * em)
 510 {
 511   if (em->use_sock_api)
 512     vl_socket_client_disconnect ();
 513   else
 514     vl_client_disconnect_from_vlib ();
 515 }
 516
 517 static void
 518 vl_api_map_another_segment_t_handler (vl_api_map_another_segment_t * mp)
 519 {
 520   svm_fifo_segment_create_args_t _a, *a = &_a;
 521   int rv;
 522
 523   memset (a, 0, sizeof (*a));
 524   a->segment_name = (char *) mp->segment_name;
 525   a->segment_size = mp->segment_size;
 526   /* Attach to the segment vpp created */
 527   rv = svm_fifo_segment_attach (a);
 528   if (rv)
 529     {
 530       clib_warning ("svm_fifo_segment_attach ('%s') failed",
 531                     mp->segment_name);
 532       return;
 533     }
 534   clib_warning ("Mapped new segment '%s' size %d", mp->segment_name,
 535                 mp->segment_size);
 536 }
 537
 538 static void
 539 session_print_stats (echo_main_t * em, session_t * session)
 540 {
 541   f64 deltat;
 542   u64 bytes;
 543
 544   deltat = clib_time_now (&em->clib_time) - session->start;
 545   bytes = em->i_am_master ? session->bytes_received : em->bytes_to_send;
 546   fformat (stdout, "Finished in %.6f\n", deltat);
 547   fformat (stdout, "%.4f Gbit/second\n", (bytes * 8.0) / deltat / 1e9);
 548 }
 549
 550 static void
 551 vl_api_disconnect_session_t_handler (vl_api_disconnect_session_t * mp)
 552 {
 553   echo_main_t *em = &echo_main;
 554   session_t *session = 0;
 555   vl_api_disconnect_session_reply_t *rmp;
 556   uword *p;
 557   int rv = 0;
 558
 559   p = hash_get (em->session_index_by_vpp_handles, mp->handle);
 560
 561   if (p)
 562     {
 563       session = pool_elt_at_index (em->sessions, p[0]);
 564       hash_unset (em->session_index_by_vpp_handles, mp->handle);
 565       pool_put (em->sessions, session);
 566     }
 567   else
 568     {
 569       clib_warning ("couldn't find session key %llx", mp->handle);
 570       rv = -11;
 571     }
 572
 573 //  em->time_to_stop = 1;
 574
 575   rmp = vl_msg_api_alloc (sizeof (*rmp));
 576   memset (rmp, 0, sizeof (*rmp));
 577
 578   rmp->_vl_msg_id = ntohs (VL_API_DISCONNECT_SESSION_REPLY);
 579   rmp->retval = rv;
 580   rmp->handle = mp->handle;
 581   rmp->context = mp->context;
 582   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & rmp);
 583
 584   if (session)
 585     session_print_stats (em, session);
 586 }
 587
 588 static void
 589 vl_api_reset_session_t_handler (vl_api_reset_session_t * mp)
 590 {
 591   echo_main_t *em = &echo_main;
 592   vl_api_reset_session_reply_t *rmp;
 593   uword *p;
 594   int rv = 0;
 595
 596   p = hash_get (em->session_index_by_vpp_handles, mp->handle);
 597
 598   if (p)
 599     {
 600       clib_warning ("got reset");
 601       /* Cleanup later */
 602       em->time_to_stop = 1;
 603     }
 604   else
 605     {
 606       clib_warning ("couldn't find session key %llx", mp->handle);
 607       rv = -11;
 608     }
 609
 610   rmp = vl_msg_api_alloc (sizeof (*rmp));
 611   memset (rmp, 0, sizeof (*rmp));
 612   rmp->_vl_msg_id = ntohs (VL_API_RESET_SESSION_REPLY);
 613   rmp->retval = rv;
 614   rmp->handle = mp->handle;
 615   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & rmp);
 616 }
 617
 618 static void
 619 test_recv_bytes (session_t * s, u8 * rx_buf, u32 n_read)
 620 {
 621   int i;
 622   for (i = 0; i < n_read; i++)
 623     {
 624       if (rx_buf[i] != ((s->bytes_received + i) & 0xff))
 625         {
 626           clib_warning ("error at byte %lld, 0x%x not 0x%x",
 627                         s->bytes_received + i, rx_buf[i],
 628                         ((s->bytes_received + i) & 0xff));
 629         }
 630     }
 631 }
 632
 633 static void
 634 recv_test_chunk (echo_main_t * em, session_t * s, u8 * rx_buf)
 635 {
 636   svm_fifo_t *rx_fifo = s->server_rx_fifo;
 637   u32 n_read_now, n_to_read;
 638   int n_read;
 639
 640   n_to_read = svm_fifo_max_dequeue (rx_fifo);
 641   svm_fifo_unset_event (rx_fifo);
 642
 643   do
 644     {
 645       n_read_now = clib_min (vec_len (rx_buf), n_to_read);
 646       n_read = svm_fifo_dequeue_nowait (rx_fifo, n_read_now, rx_buf);
 647       if (n_read <= 0)
 648         break;
 649
 650       if (n_read_now != n_read)
 651         clib_warning ("huh?");
 652
 653       if (em->test_return_packets)
 654         test_recv_bytes (s, rx_buf, n_read);
 655
 656       n_to_read -= n_read;
 657       s->bytes_received += n_read;
 658       s->bytes_to_receive -= n_read;
 659     }
 660   while (n_to_read > 0);
 661 }
 662
 663 void
 664 client_handle_fifo_event_rx (echo_main_t * em, session_fifo_event_t * e,
 665                              u8 * rx_buf)
 666 {
 667   session_t *s;
 668
 669   s = pool_elt_at_index (em->sessions, e->fifo->client_session_index);
 670   recv_test_chunk (em, s, rx_buf);
 671 }
 672
 673 static void
 674 send_test_chunk (echo_main_t * em, session_t * s)
 675 {
 676   u64 test_buf_len, bytes_this_chunk, test_buf_offset;
 677   svm_fifo_t *tx_fifo = s->server_tx_fifo;
 678   u8 *test_data = em->connect_test_data;
 679   u32 enq_space, min_chunk = 16 << 10;
 680   int written;
 681
 682   test_buf_len = vec_len (test_data);
 683   test_buf_offset = s->bytes_sent % test_buf_len;
 684   bytes_this_chunk = clib_min (test_buf_len - test_buf_offset,
 685                                s->bytes_to_send);
 686   enq_space = svm_fifo_max_enqueue (tx_fifo);
 687   if (enq_space < clib_min (bytes_this_chunk, min_chunk))
 688     return;
 689
 690   bytes_this_chunk = clib_min (bytes_this_chunk, enq_space);
 691   written = svm_fifo_enqueue_nowait (tx_fifo, bytes_this_chunk,
 692                                      test_data + test_buf_offset);
 693
 694   if (written > 0)
 695     {
 696       s->bytes_to_send -= written;
 697       s->bytes_sent += written;
 698
 699       if (svm_fifo_set_event (tx_fifo))
 700         app_send_io_evt_to_vpp (s->vpp_evt_q, tx_fifo, FIFO_EVENT_APP_TX,
 701                                 0 /* do wait for mutex */ );
 702     }
 703 }
 704
 705 /*
 706  * Rx/Tx polling thread per connection
 707  */
 708 static void *
 709 client_thread_fn (void *arg)
 710 {
 711   echo_main_t *em = &echo_main;
 712   static u8 *rx_buf = 0;
 713   u32 session_index = *(u32 *) arg;
 714   session_t *s;
 715
 716   vec_validate (rx_buf, 1 << 20);
 717
 718   while (!em->time_to_stop && em->state != STATE_READY)
 719     ;
 720
 721   s = pool_elt_at_index (em->sessions, session_index);
 722   while (!em->time_to_stop)
 723     {
 724       send_test_chunk (em, s);
 725       recv_test_chunk (em, s, rx_buf);
 726       if (!s->bytes_to_send && !s->bytes_to_receive)
 727         break;
 728     }
 729
 730   DBG ("session %d done", session_index);
 731   em->tx_total += s->bytes_sent;
 732   em->rx_total += s->bytes_received;
 733   em->n_active_clients--;
 734
 735   pthread_exit (0);
 736 }
 737
 738 /*
 739  * Rx thread that handles all connections.
 740  *
 741  * Not used.
 742  */
 743 void *
 744 client_rx_thread_fn (void *arg)
 745 {
 746   session_fifo_event_t _e, *e = &_e;
 747   echo_main_t *em = &echo_main;
 748   static u8 *rx_buf = 0;
 749   svm_msg_q_msg_t msg;
 750
 751   vec_validate (rx_buf, 1 << 20);
 752
 753   while (!em->time_to_stop && em->state != STATE_READY)
 754     ;
 755
 756   while (!em->time_to_stop)
 757     {
 758       svm_msg_q_sub (em->our_event_queue, &msg, SVM_Q_WAIT, 0);
 759       e = svm_msg_q_msg_data (em->our_event_queue, &msg);
 760       switch (e->event_type)
 761         {
 762         case FIFO_EVENT_APP_RX:
 763           client_handle_fifo_event_rx (em, e, rx_buf);
 764           break;
 765         default:
 766           clib_warning ("unknown event type %d", e->event_type);
 767           break;
 768         }
 769       svm_msg_q_free_msg (em->our_event_queue, &msg);
 770     }
 771   pthread_exit (0);
 772 }
 773
 774 static void
 775 vl_api_connect_session_reply_t_handler (vl_api_connect_session_reply_t * mp)
 776 {
 777   echo_main_t *em = &echo_main;
 778   session_t *session;
 779   u32 session_index;
 780   svm_fifo_t *rx_fifo, *tx_fifo;
 781   int rv;
 782
 783   if (mp->retval)
 784     {
 785       clib_warning ("connection failed with code: %U", format_api_error,
 786                     clib_net_to_host_u32 (mp->retval));
 787       em->state = STATE_FAILED;
 788       return;
 789     }
 790
 791   /*
 792    * Setup session
 793    */
 794
 795   pool_get (em->sessions, session);
 796   memset (session, 0, sizeof (*session));
 797   session_index = session - em->sessions;
 798
 799   rx_fifo = uword_to_pointer (mp->server_rx_fifo, svm_fifo_t *);
 800   rx_fifo->client_session_index = session_index;
 801   tx_fifo = uword_to_pointer (mp->server_tx_fifo, svm_fifo_t *);
 802   tx_fifo->client_session_index = session_index;
 803
 804   session->server_rx_fifo = rx_fifo;
 805   session->server_tx_fifo = tx_fifo;
 806   session->vpp_session_handle = mp->handle;
 807   session->start = clib_time_now (&em->clib_time);
 808   session->vpp_evt_q = uword_to_pointer (mp->vpp_event_queue_address,
 809                                          svm_msg_q_t *);
 810
 811   hash_set (em->session_index_by_vpp_handles, mp->handle, session_index);
 812
 813   /*
 814    * Start RX thread
 815    */
 816   em->thread_args[em->n_clients_connected] = session_index;
 817   rv = pthread_create (&em->client_thread_handles[em->n_clients_connected],
 818                        NULL /*attr */ , client_thread_fn,
 819                        (void *) &em->thread_args[em->n_clients_connected]);
 820   if (rv)
 821     {
 822       clib_warning ("pthread_create returned %d", rv);
 823       return;
 824     }
 825
 826   em->n_clients_connected += 1;
 827   clib_warning ("session %u (0x%llx) connected with local ip %U port %d",
 828                 session_index, mp->handle, format_ip46_address, mp->lcl_ip,
 829                 mp->is_ip4, clib_net_to_host_u16 (mp->lcl_port));
 830 }
 831
 832 void
 833 client_send_connect (echo_main_t * em)
 834 {
 835   vl_api_connect_uri_t *cmp;
 836   cmp = vl_msg_api_alloc (sizeof (*cmp));
 837   memset (cmp, 0, sizeof (*cmp));
 838
 839   cmp->_vl_msg_id = ntohs (VL_API_CONNECT_URI);
 840   cmp->client_index = em->my_client_index;
 841   cmp->context = ntohl (0xfeedface);
 842   memcpy (cmp->uri, em->connect_uri, vec_len (em->connect_uri));
 843   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & cmp);
 844 }
 845
 846 void
 847 client_send_disconnect (echo_main_t * em, session_t * s)
 848 {
 849   vl_api_disconnect_session_t *dmp;
 850   dmp = vl_msg_api_alloc (sizeof (*dmp));
 851   memset (dmp, 0, sizeof (*dmp));
 852   dmp->_vl_msg_id = ntohs (VL_API_DISCONNECT_SESSION);
 853   dmp->client_index = em->my_client_index;
 854   dmp->handle = s->vpp_session_handle;
 855   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & dmp);
 856 }
 857
 858 int
 859 client_disconnect (echo_main_t * em, session_t * s)
 860 {
 861   client_send_disconnect (em, s);
 862   pool_put (em->sessions, s);
 863   memset (s, 0xfe, sizeof (*s));
 864   return 0;
 865 }
 866
 867 static void
 868 clients_run (echo_main_t * em)
 869 {
 870   f64 start_time, deltat, timeout = 100.0;
 871   svm_msg_q_msg_t msg;
 872   session_t *s;
 873   int i;
 874
 875   /* Init test data */
 876   vec_validate (em->connect_test_data, 1024 * 1024 - 1);
 877   for (i = 0; i < vec_len (em->connect_test_data); i++)
 878     em->connect_test_data[i] = i & 0xff;
 879
 880   /*
 881    * Attach and connect the clients
 882    */
 883   if (application_attach (em))
 884     return;
 885
 886   for (i = 0; i < em->n_clients; i++)
 887     client_send_connect (em);
 888
 889   start_time = clib_time_now (&em->clib_time);
 890   while (em->n_clients_connected < em->n_clients
 891          && (clib_time_now (&em->clib_time) - start_time < timeout)
 892          && em->state != STATE_FAILED)
 893     ;
 894
 895   if (em->n_clients_connected != em->n_clients)
 896     {
 897       clib_warning ("failed to initialize all connections");
 898       return;
 899     }
 900
 901   /*
 902    * Initialize connections
 903    */
 904   for (i = 0; i < em->n_clients; i++)
 905     {
 906       s = pool_elt_at_index (em->sessions, i);
 907       s->bytes_to_send = em->bytes_to_send;
 908       if (!em->no_return)
 909         s->bytes_to_receive = em->bytes_to_send;
 910     }
 911   em->n_active_clients = em->n_clients_connected;
 912
 913   /*
 914    * Wait for client threads to send the data
 915    */
 916   start_time = clib_time_now (&em->clib_time);
 917   em->state = STATE_READY;
 918   while (em->n_active_clients)
 919     if (!svm_msg_q_is_empty (em->our_event_queue))
 920       {
 921         if (svm_msg_q_sub (em->our_event_queue, &msg, SVM_Q_WAIT, 0))
 922           {
 923             clib_warning ("svm msg q returned");
 924           }
 925         else
 926           svm_msg_q_free_msg (em->our_event_queue, &msg);
 927       }
 928
 929   for (i = 0; i < em->n_clients; i++)
 930     {
 931       s = pool_elt_at_index (em->sessions, i);
 932       client_disconnect (em, s);
 933     }
 934
 935   /*
 936    * Stats and detach
 937    */
 938   deltat = clib_time_now (&em->clib_time) - start_time;
 939   fformat (stdout, "%lld bytes (%lld mbytes, %lld gbytes) in %.2f seconds\n",
 940            em->tx_total, em->tx_total / (1ULL << 20),
 941            em->tx_total / (1ULL << 30), deltat);
 942   fformat (stdout, "%.4f Gbit/second\n", (em->tx_total * 8.0) / deltat / 1e9);
 943
 944   application_detach (em);
 945 }
 946
 947 static void
 948 vl_api_bind_uri_reply_t_handler (vl_api_bind_uri_reply_t * mp)
 949 {
 950   echo_main_t *em = &echo_main;
 951
 952   if (mp->retval)
 953     {
 954       clib_warning ("bind failed: %U", format_api_error,
 955                     clib_net_to_host_u32 (mp->retval));
 956       em->state = STATE_FAILED;
 957       return;
 958     }
 959
 960   em->state = STATE_READY;
 961 }
 962
 963 static void
 964 vl_api_unbind_uri_reply_t_handler (vl_api_unbind_uri_reply_t * mp)
 965 {
 966   echo_main_t *em = &echo_main;
 967
 968   if (mp->retval != 0)
 969     clib_warning ("returned %d", ntohl (mp->retval));
 970
 971   em->state = STATE_START;
 972 }
 973
 974 u8 *
 975 format_ip4_address (u8 * s, va_list * args)
 976 {
 977   u8 *a = va_arg (*args, u8 *);
 978   return format (s, "%d.%d.%d.%d", a[0], a[1], a[2], a[3]);
 979 }
 980
 981 u8 *
 982 format_ip6_address (u8 * s, va_list * args)
 983 {
 984   ip6_address_t *a = va_arg (*args, ip6_address_t *);
 985   u32 i, i_max_n_zero, max_n_zeros, i_first_zero, n_zeros, last_double_colon;
 986
 987   i_max_n_zero = ARRAY_LEN (a->as_u16);
 988   max_n_zeros = 0;
 989   i_first_zero = i_max_n_zero;
 990   n_zeros = 0;
 991   for (i = 0; i < ARRAY_LEN (a->as_u16); i++)
 992     {
 993       u32 is_zero = a->as_u16[i] == 0;
 994       if (is_zero && i_first_zero >= ARRAY_LEN (a->as_u16))
 995         {
 996           i_first_zero = i;
 997           n_zeros = 0;
 998         }
 999       n_zeros += is_zero;
1000       if ((!is_zero && n_zeros > max_n_zeros)
1001           || (i + 1 >= ARRAY_LEN (a->as_u16) && n_zeros > max_n_zeros))
1002         {
1003           i_max_n_zero = i_first_zero;
1004           max_n_zeros = n_zeros;
1005           i_first_zero = ARRAY_LEN (a->as_u16);
1006           n_zeros = 0;
1007         }
1008     }
1009
1010   last_double_colon = 0;
1011   for (i = 0; i < ARRAY_LEN (a->as_u16); i++)
1012     {
1013       if (i == i_max_n_zero && max_n_zeros > 1)
1014         {
1015           s = format (s, "::");
1016           i += max_n_zeros - 1;
1017           last_double_colon = 1;
1018         }
1019       else
1020         {
1021           s = format (s, "%s%x",
1022                       (last_double_colon || i == 0) ? "" : ":",
1023                       clib_net_to_host_u16 (a->as_u16[i]));
1024           last_double_colon = 0;
1025         }
1026     }
1027
1028   return s;
1029 }
1030
1031 /* Format an IP46 address. */
1032 u8 *
1033 format_ip46_address (u8 * s, va_list * args)
1034 {
1035   ip46_address_t *ip46 = va_arg (*args, ip46_address_t *);
1036   ip46_type_t type = va_arg (*args, ip46_type_t);
1037   int is_ip4 = 1;
1038
1039   switch (type)
1040     {
1041     case IP46_TYPE_ANY:
1042       is_ip4 = ip46_address_is_ip4 (ip46);
1043       break;
1044     case IP46_TYPE_IP4:
1045       is_ip4 = 1;
1046       break;
1047     case IP46_TYPE_IP6:
1048       is_ip4 = 0;
1049       break;
1050     }
1051
1052   return is_ip4 ?
1053     format (s, "%U", format_ip4_address, &ip46->ip4) :
1054     format (s, "%U", format_ip6_address, &ip46->ip6);
1055 }
1056
1057 static void
1058 vl_api_accept_session_t_handler (vl_api_accept_session_t * mp)
1059 {
1060   echo_main_t *em = &echo_main;
1061   vl_api_accept_session_reply_t *rmp;
1062   svm_fifo_t *rx_fifo, *tx_fifo;
1063   session_t *session;
1064   static f64 start_time;
1065   u32 session_index;
1066   u8 *ip_str;
1067
1068   if (start_time == 0.0)
1069     start_time = clib_time_now (&em->clib_time);
1070
1071   ip_str = format (0, "%U", format_ip46_address, &mp->ip, mp->is_ip4);
1072   clib_warning ("Accepted session from: %s:%d", ip_str,
1073                 clib_net_to_host_u16 (mp->port));
1074   em->vpp_event_queue =
1075     uword_to_pointer (mp->vpp_event_queue_address, svm_queue_t *);
1076
1077   /* Allocate local session and set it up */
1078   pool_get (em->sessions, session);
1079   session_index = session - em->sessions;
1080
1081   rx_fifo = uword_to_pointer (mp->server_rx_fifo, svm_fifo_t *);
1082   rx_fifo->client_session_index = session_index;
1083   tx_fifo = uword_to_pointer (mp->server_tx_fifo, svm_fifo_t *);
1084   tx_fifo->client_session_index = session_index;
1085
1086   session->server_rx_fifo = rx_fifo;
1087   session->server_tx_fifo = tx_fifo;
1088
1089   /* Add it to lookup table */
1090   hash_set (em->session_index_by_vpp_handles, mp->handle, session_index);
1091
1092   em->state = STATE_READY;
1093
1094   /* Stats printing */
1095   if (pool_elts (em->sessions) && (pool_elts (em->sessions) % 20000) == 0)
1096     {
1097       f64 now = clib_time_now (&em->clib_time);
1098       fformat (stdout, "%d active sessions in %.2f seconds, %.2f/sec...\n",
1099                pool_elts (em->sessions), now - start_time,
1100                (f64) pool_elts (em->sessions) / (now - start_time));
1101     }
1102
1103   /*
1104    * Send accept reply to vpp
1105    */
1106   rmp = vl_msg_api_alloc (sizeof (*rmp));
1107   memset (rmp, 0, sizeof (*rmp));
1108   rmp->_vl_msg_id = ntohs (VL_API_ACCEPT_SESSION_REPLY);
1109   rmp->handle = mp->handle;
1110   rmp->context = mp->context;
1111   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & rmp);
1112
1113   session->bytes_received = 0;
1114   session->start = clib_time_now (&em->clib_time);
1115 }
1116
1117 void
1118 server_handle_fifo_event_rx (echo_main_t * em, session_fifo_event_t * e)
1119 {
1120   svm_fifo_t *rx_fifo, *tx_fifo;
1121   int n_read;
1122   session_fifo_event_t evt;
1123   svm_queue_t *q;
1124   session_t *session;
1125   int rv;
1126   u32 max_dequeue, offset, max_transfer, rx_buf_len;
1127
1128   rx_buf_len = vec_len (em->rx_buf);
1129   rx_fifo = e->fifo;
1130   session = pool_elt_at_index (em->sessions, rx_fifo->client_session_index);
1131   tx_fifo = session->server_tx_fifo;
1132
1133   max_dequeue = svm_fifo_max_dequeue (rx_fifo);
1134   /* Allow enqueuing of a new event */
1135   svm_fifo_unset_event (rx_fifo);
1136
1137   if (PREDICT_FALSE (!max_dequeue))
1138     return;
1139
1140   /* Read the max_dequeue */
1141   do
1142     {
1143       max_transfer = clib_min (rx_buf_len, max_dequeue);
1144       n_read = svm_fifo_dequeue_nowait (rx_fifo, max_transfer, em->rx_buf);
1145       if (n_read > 0)
1146         {
1147           max_dequeue -= n_read;
1148           session->bytes_received += n_read;
1149           session->bytes_to_receive -= n_read;
1150         }
1151
1152       /* Reflect if a non-drop session */
1153       if (!em->no_return && n_read > 0)
1154         {
1155           offset = 0;
1156           do
1157             {
1158               rv = svm_fifo_enqueue_nowait (tx_fifo, n_read,
1159                                             &em->rx_buf[offset]);
1160               if (rv > 0)
1161                 {
1162                   n_read -= rv;
1163                   offset += rv;
1164                 }
1165             }
1166           while ((rv <= 0 || n_read > 0) && !em->time_to_stop);
1167
1168           /* If event wasn't set, add one */
1169           if (svm_fifo_set_event (tx_fifo))
1170             {
1171               /* Fabricate TX event, send to vpp */
1172               evt.fifo = tx_fifo;
1173               evt.event_type = FIFO_EVENT_APP_TX;
1174
1175               q = em->vpp_event_queue;
1176               svm_queue_add (q, (u8 *) & evt, 1 /* do wait for mutex */ );
1177             }
1178         }
1179     }
1180   while ((n_read < 0 || max_dequeue > 0) && !em->time_to_stop);
1181 }
1182
1183 void
1184 server_handle_event_queue (echo_main_t * em)
1185 {
1186   session_fifo_event_t _e, *e = &_e;
1187   svm_msg_q_msg_t msg;
1188
1189   while (1)
1190     {
1191       svm_msg_q_sub (em->our_event_queue, &msg, SVM_Q_WAIT, 0);
1192       e = svm_msg_q_msg_data (em->our_event_queue, &msg);
1193       switch (e->event_type)
1194         {
1195         case FIFO_EVENT_APP_RX:
1196           server_handle_fifo_event_rx (em, e);
1197           break;
1198
1199         case FIFO_EVENT_DISCONNECT:
1200           svm_msg_q_free_msg (em->our_event_queue, &msg);
1201           return;
1202
1203         default:
1204           clib_warning ("unknown event type %d", e->event_type);
1205           break;
1206         }
1207       if (PREDICT_FALSE (em->time_to_stop == 1))
1208         break;
1209       if (PREDICT_FALSE (em->time_to_print_stats == 1))
1210         {
1211           em->time_to_print_stats = 0;
1212           fformat (stdout, "%d connections\n", pool_elts (em->sessions));
1213         }
1214       svm_msg_q_free_msg (em->our_event_queue, &msg);
1215     }
1216 }
1217
1218 void
1219 server_send_listen (echo_main_t * em)
1220 {
1221   vl_api_bind_uri_t *bmp;
1222   bmp = vl_msg_api_alloc (sizeof (*bmp));
1223   memset (bmp, 0, sizeof (*bmp));
1224
1225   bmp->_vl_msg_id = ntohs (VL_API_BIND_URI);
1226   bmp->client_index = em->my_client_index;
1227   bmp->context = ntohl (0xfeedface);
1228   memcpy (bmp->uri, em->uri, vec_len (em->uri));
1229   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & bmp);
1230 }
1231
1232 int
1233 server_listen (echo_main_t * em)
1234 {
1235   server_send_listen (em);
1236   if (wait_for_state_change (em, STATE_READY))
1237     {
1238       clib_warning ("timeout waiting for STATE_READY");
1239       return -1;
1240     }
1241   return 0;
1242 }
1243
1244 void
1245 server_send_unbind (echo_main_t * em)
1246 {
1247   vl_api_unbind_uri_t *ump;
1248
1249   ump = vl_msg_api_alloc (sizeof (*ump));
1250   memset (ump, 0, sizeof (*ump));
1251
1252   ump->_vl_msg_id = ntohs (VL_API_UNBIND_URI);
1253   ump->client_index = em->my_client_index;
1254   memcpy (ump->uri, em->uri, vec_len (em->uri));
1255   vl_msg_api_send_shmem (em->vl_input_queue, (u8 *) & ump);
1256 }
1257
1258 int
1259 server_unbind (echo_main_t * em)
1260 {
1261   server_send_unbind (em);
1262   if (wait_for_state_change (em, STATE_START))
1263     {
1264       clib_warning ("timeout waiting for STATE_START");
1265       return -1;
1266     }
1267   return 0;
1268 }
1269
1270 void
1271 server_run (echo_main_t * em)
1272 {
1273   session_t *session;
1274   int i;
1275
1276   /* $$$$ hack preallocation */
1277   for (i = 0; i < 200000; i++)
1278     {
1279       pool_get (em->sessions, session);
1280       memset (session, 0, sizeof (*session));
1281     }
1282   for (i = 0; i < 200000; i++)
1283     pool_put_index (em->sessions, i);
1284
1285   if (application_attach (em))
1286     return;
1287
1288   /* Bind to uri */
1289   if (server_listen (em))
1290     return;
1291
1292   /* Enter handle event loop */
1293   server_handle_event_queue (em);
1294
1295   /* Cleanup */
1296   server_send_unbind (em);
1297
1298   application_detach (em);
1299
1300   fformat (stdout, "Test complete...\n");
1301 }
1302
1303 static void
1304 vl_api_disconnect_session_reply_t_handler (vl_api_disconnect_session_reply_t *
1305                                            mp)
1306 {
1307   echo_main_t *em = &echo_main;
1308   uword *p;
1309
1310   if (mp->retval)
1311     {
1312       clib_warning ("vpp complained about disconnect: %d",
1313                     ntohl (mp->retval));
1314       return;
1315     }
1316
1317   em->state = STATE_START;
1318
1319   p = hash_get (em->session_index_by_vpp_handles, mp->handle);
1320   if (p)
1321     {
1322       hash_unset (em->session_index_by_vpp_handles, mp->handle);
1323     }
1324   else
1325     {
1326       clib_warning ("couldn't find session key %llx", mp->handle);
1327     }
1328 }
1329
1330 static void
1331   vl_api_application_tls_cert_add_reply_t_handler
1332   (vl_api_application_tls_cert_add_reply_t * mp)
1333 {
1334   if (mp->retval)
1335     clib_warning ("failed to add tls cert");
1336 }
1337
1338 static void
1339   vl_api_application_tls_key_add_reply_t_handler
1340   (vl_api_application_tls_key_add_reply_t * mp)
1341 {
1342   if (mp->retval)
1343     clib_warning ("failed to add tls key");
1344 }
1345
1346 #define foreach_tcp_echo_msg                                            \
1347 _(BIND_URI_REPLY, bind_uri_reply)                                       \
1348 _(UNBIND_URI_REPLY, unbind_uri_reply)                                   \
1349 _(ACCEPT_SESSION, accept_session)                                       \
1350 _(CONNECT_SESSION_REPLY, connect_session_reply)                         \
1351 _(DISCONNECT_SESSION, disconnect_session)                               \
1352 _(DISCONNECT_SESSION_REPLY, disconnect_session_reply)                   \
1353 _(RESET_SESSION, reset_session)                                         \
1354 _(APPLICATION_ATTACH_REPLY, application_attach_reply)                   \
1355 _(APPLICATION_DETACH_REPLY, application_detach_reply)                   \
1356 _(MAP_ANOTHER_SEGMENT, map_another_segment)                             \
1357 _(APPLICATION_TLS_CERT_ADD_REPLY, application_tls_cert_add_reply)       \
1358 _(APPLICATION_TLS_KEY_ADD_REPLY, application_tls_key_add_reply)         \
1359
1360 void
1361 tcp_echo_api_hookup (echo_main_t * em)
1362 {
1363 #define _(N,n)                                                  \
1364     vl_msg_api_set_handlers(VL_API_##N, #n,                     \
1365                            vl_api_##n##_t_handler,              \
1366                            vl_noop_handler,                     \
1367                            vl_api_##n##_t_endian,               \
1368                            vl_api_##n##_t_print,                \
1369                            sizeof(vl_api_##n##_t), 1);
1370   foreach_tcp_echo_msg;
1371 #undef _
1372 }
1373
1374 int
1375 main (int argc, char **argv)
1376 {
1377   int i_am_server = 1, test_return_packets = 0;
1378   echo_main_t *em = &echo_main;
1379   unformat_input_t _argv, *a = &_argv;
1380   u8 *chroot_prefix;
1381   u8 *heap, *uri = 0;
1382   u8 *bind_uri = (u8 *) "tcp://0.0.0.0/1234";
1383   u8 *connect_uri = (u8 *) "tcp://6.0.1.1/1234";
1384   u64 bytes_to_send = 64 << 10, mbytes;
1385   char *app_name;
1386   u32 tmp;
1387   mheap_t *h;
1388
1389   clib_mem_init (0, 256 << 20);
1390
1391   heap = clib_mem_get_per_cpu_heap ();
1392   h = mheap_header (heap);
1393
1394   /* make the main heap thread-safe */
1395   h->flags |= MHEAP_FLAG_THREAD_SAFE;
1396
1397   vec_validate (em->rx_buf, 128 << 10);
1398
1399   memset (em, 0, sizeof (*em));
1400   em->session_index_by_vpp_handles = hash_create (0, sizeof (uword));
1401   em->my_pid = getpid ();
1402   em->configured_segment_size = 1 << 20;
1403   em->socket_name = 0;
1404   em->use_sock_api = 1;
1405   em->fifo_size = 64 << 10;
1406   em->n_clients = 1;
1407
1408   clib_time_init (&em->clib_time);
1409   init_error_string_table (em);
1410   svm_fifo_segment_main_init (0x200000000ULL, 20);
1411   unformat_init_command_line (a, argv);
1412
1413   while (unformat_check_input (a) != UNFORMAT_END_OF_INPUT)
1414     {
1415       if (unformat (a, "chroot prefix %s", &chroot_prefix))
1416         {
1417           vl_set_memory_root_path ((char *) chroot_prefix);
1418         }
1419       else if (unformat (a, "uri %s", &uri))
1420         ;
1421       else if (unformat (a, "segment-size %dM", &tmp))
1422         em->configured_segment_size = tmp << 20;
1423       else if (unformat (a, "segment-size %dG", &tmp))
1424         em->configured_segment_size = tmp << 30;
1425       else if (unformat (a, "server"))
1426         i_am_server = 1;
1427       else if (unformat (a, "client"))
1428         i_am_server = 0;
1429       else if (unformat (a, "no-return"))
1430         em->no_return = 1;
1431       else if (unformat (a, "test"))
1432         test_return_packets = 1;
1433       else if (unformat (a, "mbytes %lld", &mbytes))
1434         {
1435           bytes_to_send = mbytes << 20;
1436         }
1437       else if (unformat (a, "gbytes %lld", &mbytes))
1438         {
1439           bytes_to_send = mbytes << 30;
1440         }
1441       else if (unformat (a, "socket-name %s", &em->socket_name))
1442         ;
1443       else if (unformat (a, "use-svm-api"))
1444         em->use_sock_api = 0;
1445       else if (unformat (a, "fifo-size %d", &tmp))
1446         em->fifo_size = tmp << 10;
1447       else if (unformat (a, "nclients %d", &em->n_clients))
1448         ;
1449       else
1450         {
1451           fformat (stderr, "%s: usage [master|slave]\n", argv[0]);
1452           exit (1);
1453         }
1454     }
1455
1456   if (!em->socket_name)
1457     em->socket_name = format (0, "%s%c", API_SOCKET_FILE, 0);
1458
1459   if (uri)
1460     {
1461       em->uri = format (0, "%s%c", uri, 0);
1462       em->connect_uri = format (0, "%s%c", uri, 0);
1463     }
1464   else
1465     {
1466       em->uri = format (0, "%s%c", bind_uri, 0);
1467       em->connect_uri = format (0, "%s%c", connect_uri, 0);
1468     }
1469
1470   em->i_am_master = i_am_server;
1471   em->segment_main = &svm_fifo_segment_main;
1472   em->test_return_packets = test_return_packets;
1473   em->bytes_to_send = bytes_to_send;
1474   em->time_to_stop = 0;
1475   vec_validate (em->client_thread_handles, em->n_clients - 1);
1476   vec_validate (em->thread_args, em->n_clients - 1);
1477
1478   setup_signal_handlers ();
1479   tcp_echo_api_hookup (em);
1480
1481   app_name = i_am_server ? "tcp_echo_server" : "tcp_echo_client";
1482   if (connect_to_vpp (app_name) < 0)
1483     {
1484       svm_region_exit ();
1485       fformat (stderr, "Couldn't connect to vpe, exiting...\n");
1486       exit (1);
1487     }
1488
1489   if (i_am_server == 0)
1490     clients_run (em);
1491   else
1492     server_run (em);
1493
1494   /* Make sure detach finishes */
1495   wait_for_state_change (em, STATE_DETACHED);
1496
1497   disconnect_from_vpp (em);
1498   exit (0);
1499 }
1500
1501 /*
1502  * fd.io coding-style-patch-verification: ON
1503  *
1504  * Local Variables:
1505  * eval: (c-set-style "gnu")
1506  * End:
1507  */