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