src/vnet/session/session_node.c

   1 /*
   2  * Copyright (c) 2017-2019 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 <math.h>
  17 #include <vlib/vlib.h>
  18 #include <vnet/vnet.h>
  19 #include <vppinfra/elog.h>
  20 #include <vnet/session/transport.h>
  21 #include <vnet/session/session.h>
  22 #include <vnet/session/application.h>
  23 #include <vnet/session/application_interface.h>
  24 #include <vnet/session/application_local.h>
  25 #include <vnet/session/session_debug.h>
  26 #include <svm/queue.h>
  27
  28 #define app_check_thread_and_barrier(_fn, _arg)                         \
  29   if (!vlib_thread_is_main_w_barrier ())                                \
  30     {                                                                   \
  31      vlib_rpc_call_main_thread (_fn, (u8 *) _arg, sizeof(*_arg));       \
  32       return;                                                           \
  33    }
  34
  35 static void
  36 session_mq_listen_handler (void *data)
  37 {
  38   session_listen_msg_t *mp = (session_listen_msg_t *) data;
  39   vnet_listen_args_t _a, *a = &_a;
  40   app_worker_t *app_wrk;
  41   application_t *app;
  42   int rv;
  43
  44   app_check_thread_and_barrier (session_mq_listen_handler, mp);
  45
  46   app = application_lookup (mp->client_index);
  47   if (!app)
  48     return;
  49
  50   clib_memset (a, 0, sizeof (*a));
  51   a->sep.is_ip4 = mp->is_ip4;
  52   clib_memcpy_fast (&a->sep.ip, &mp->ip, sizeof (mp->ip));
  53   a->sep.port = mp->port;
  54   a->sep.fib_index = mp->vrf;
  55   a->sep.sw_if_index = ENDPOINT_INVALID_INDEX;
  56   a->sep.transport_proto = mp->proto;
  57   a->sep_ext.ckpair_index = mp->ckpair_index;
  58   a->sep_ext.crypto_engine = mp->crypto_engine;
  59   a->app_index = app->app_index;
  60   a->wrk_map_index = mp->wrk_index;
  61
  62   if ((rv = vnet_listen (a)))
  63     clib_warning ("listen returned: %d", rv);
  64
  65   app_wrk = application_get_worker (app, mp->wrk_index);
  66   mq_send_session_bound_cb (app_wrk->wrk_index, mp->context, a->handle, rv);
  67   return;
  68 }
  69
  70 static void
  71 session_mq_listen_uri_handler (void *data)
  72 {
  73   session_listen_uri_msg_t *mp = (session_listen_uri_msg_t *) data;
  74   vnet_listen_args_t _a, *a = &_a;
  75   app_worker_t *app_wrk;
  76   application_t *app;
  77   int rv;
  78
  79   app_check_thread_and_barrier (session_mq_listen_uri_handler, mp);
  80
  81   app = application_lookup (mp->client_index);
  82   if (!app)
  83     return;
  84
  85   clib_memset (a, 0, sizeof (*a));
  86   a->uri = (char *) mp->uri;
  87   a->app_index = app->app_index;
  88   rv = vnet_bind_uri (a);
  89
  90   app_wrk = application_get_worker (app, 0);
  91   mq_send_session_bound_cb (app_wrk->wrk_index, mp->context, a->handle, rv);
  92 }
  93
  94 static void
  95 session_mq_connect_handler (void *data)
  96 {
  97   session_connect_msg_t *mp = (session_connect_msg_t *) data;
  98   vnet_connect_args_t _a, *a = &_a;
  99   app_worker_t *app_wrk;
 100   application_t *app;
 101   int rv;
 102
 103   app_check_thread_and_barrier (session_mq_connect_handler, mp);
 104
 105   app = application_lookup (mp->client_index);
 106   if (!app)
 107     return;
 108
 109   clib_memset (a, 0, sizeof (*a));
 110   a->sep.is_ip4 = mp->is_ip4;
 111   clib_memcpy_fast (&a->sep.ip, &mp->ip, sizeof (mp->ip));
 112   a->sep.port = mp->port;
 113   a->sep.transport_proto = mp->proto;
 114   a->sep.peer.fib_index = mp->vrf;
 115   clib_memcpy_fast (&a->sep.peer.ip, &mp->lcl_ip, sizeof (mp->lcl_ip));
 116   a->sep.peer.sw_if_index = ENDPOINT_INVALID_INDEX;
 117   a->sep_ext.parent_handle = mp->parent_handle;
 118   a->sep_ext.ckpair_index = mp->ckpair_index;
 119   a->sep_ext.crypto_engine = mp->crypto_engine;
 120   a->sep_ext.flags = mp->flags;
 121   if (mp->hostname_len)
 122     {
 123       vec_validate (a->sep_ext.hostname, mp->hostname_len - 1);
 124       clib_memcpy_fast (a->sep_ext.hostname, mp->hostname, mp->hostname_len);
 125     }
 126   a->api_context = mp->context;
 127   a->app_index = app->app_index;
 128   a->wrk_map_index = mp->wrk_index;
 129
 130   if ((rv = vnet_connect (a)))
 131     {
 132       clib_warning ("connect returned: %U", format_vnet_api_errno, rv);
 133       app_wrk = application_get_worker (app, mp->wrk_index);
 134       mq_send_session_connected_cb (app_wrk->wrk_index, mp->context, 0,
 135                                     /* is_fail */ 1);
 136     }
 137
 138   vec_free (a->sep_ext.hostname);
 139 }
 140
 141 static void
 142 session_mq_connect_uri_handler (void *data)
 143 {
 144   session_connect_uri_msg_t *mp = (session_connect_uri_msg_t *) data;
 145   vnet_connect_args_t _a, *a = &_a;
 146   app_worker_t *app_wrk;
 147   application_t *app;
 148   int rv;
 149
 150   app_check_thread_and_barrier (session_mq_connect_uri_handler, mp);
 151
 152   app = application_lookup (mp->client_index);
 153   if (!app)
 154     return;
 155
 156   clib_memset (a, 0, sizeof (*a));
 157   a->uri = (char *) mp->uri;
 158   a->api_context = mp->context;
 159   a->app_index = app->app_index;
 160   if ((rv = vnet_connect_uri (a)))
 161     {
 162       clib_warning ("connect_uri returned: %d", rv);
 163       app_wrk = application_get_worker (app, 0 /* default wrk only */ );
 164       mq_send_session_connected_cb (app_wrk->wrk_index, mp->context, 0,
 165                                     /* is_fail */ 1);
 166     }
 167 }
 168
 169 static void
 170 session_mq_disconnect_handler (void *data)
 171 {
 172   session_disconnect_msg_t *mp = (session_disconnect_msg_t *) data;
 173   vnet_disconnect_args_t _a, *a = &_a;
 174   application_t *app;
 175
 176   app = application_lookup (mp->client_index);
 177   if (!app)
 178     return;
 179
 180   a->app_index = app->app_index;
 181   a->handle = mp->handle;
 182   vnet_disconnect_session (a);
 183 }
 184
 185 static void
 186 app_mq_detach_handler (void *data)
 187 {
 188   session_app_detach_msg_t *mp = (session_app_detach_msg_t *) data;
 189   vnet_app_detach_args_t _a, *a = &_a;
 190   application_t *app;
 191
 192   app_check_thread_and_barrier (app_mq_detach_handler, mp);
 193
 194   app = application_lookup (mp->client_index);
 195   if (!app)
 196     return;
 197
 198   a->app_index = app->app_index;
 199   a->api_client_index = mp->client_index;
 200   vnet_application_detach (a);
 201 }
 202
 203 static void
 204 session_mq_unlisten_handler (void *data)
 205 {
 206   session_unlisten_msg_t *mp = (session_unlisten_msg_t *) data;
 207   vnet_unlisten_args_t _a, *a = &_a;
 208   app_worker_t *app_wrk;
 209   application_t *app;
 210   int rv;
 211
 212   app_check_thread_and_barrier (session_mq_unlisten_handler, mp);
 213
 214   app = application_lookup (mp->client_index);
 215   if (!app)
 216     return;
 217
 218   clib_memset (a, 0, sizeof (*a));
 219   a->app_index = app->app_index;
 220   a->handle = mp->handle;
 221   a->wrk_map_index = mp->wrk_index;
 222   if ((rv = vnet_unlisten (a)))
 223     clib_warning ("unlisten returned: %d", rv);
 224
 225   app_wrk = application_get_worker (app, a->wrk_map_index);
 226   if (!app_wrk)
 227     return;
 228
 229   mq_send_unlisten_reply (app_wrk, mp->handle, mp->context, rv);
 230 }
 231
 232 static void
 233 session_mq_accepted_reply_handler (void *data)
 234 {
 235   session_accepted_reply_msg_t *mp = (session_accepted_reply_msg_t *) data;
 236   vnet_disconnect_args_t _a = { 0 }, *a = &_a;
 237   session_state_t old_state;
 238   app_worker_t *app_wrk;
 239   session_t *s;
 240
 241   /* Server isn't interested, kill the session */
 242   if (mp->retval)
 243     {
 244       a->app_index = mp->context;
 245       a->handle = mp->handle;
 246       vnet_disconnect_session (a);
 247       return;
 248     }
 249
 250   /* Mail this back from the main thread. We're not polling in main
 251    * thread so we're using other workers for notifications. */
 252   if (vlib_num_workers () && vlib_get_thread_index () != 0
 253       && session_thread_from_handle (mp->handle) == 0)
 254     {
 255       vlib_rpc_call_main_thread (session_mq_accepted_reply_handler,
 256                                  (u8 *) mp, sizeof (*mp));
 257       return;
 258     }
 259
 260   s = session_get_from_handle_if_valid (mp->handle);
 261   if (!s)
 262     return;
 263
 264   app_wrk = app_worker_get (s->app_wrk_index);
 265   if (app_wrk->app_index != mp->context)
 266     {
 267       clib_warning ("app doesn't own session");
 268       return;
 269     }
 270
 271   if (!session_has_transport (s))
 272     {
 273       s->session_state = SESSION_STATE_READY;
 274       if (ct_session_connect_notify (s))
 275         return;
 276     }
 277   else
 278     {
 279       old_state = s->session_state;
 280       s->session_state = SESSION_STATE_READY;
 281
 282       if (!svm_fifo_is_empty_prod (s->rx_fifo))
 283         app_worker_lock_and_send_event (app_wrk, s, SESSION_IO_EVT_RX);
 284
 285       /* Closed while waiting for app to reply. Resend disconnect */
 286       if (old_state >= SESSION_STATE_TRANSPORT_CLOSING)
 287         {
 288           app_worker_close_notify (app_wrk, s);
 289           s->session_state = old_state;
 290           return;
 291         }
 292     }
 293 }
 294
 295 static void
 296 session_mq_reset_reply_handler (void *data)
 297 {
 298   vnet_disconnect_args_t _a = { 0 }, *a = &_a;
 299   session_reset_reply_msg_t *mp;
 300   app_worker_t *app_wrk;
 301   session_t *s;
 302   application_t *app;
 303   u32 index, thread_index;
 304
 305   mp = (session_reset_reply_msg_t *) data;
 306   app = application_lookup (mp->context);
 307   if (!app)
 308     return;
 309
 310   session_parse_handle (mp->handle, &index, &thread_index);
 311   s = session_get_if_valid (index, thread_index);
 312
 313   /* No session or not the right session */
 314   if (!s || s->session_state < SESSION_STATE_TRANSPORT_CLOSING)
 315     return;
 316
 317   app_wrk = app_worker_get (s->app_wrk_index);
 318   if (!app_wrk || app_wrk->app_index != app->app_index)
 319     {
 320       clib_warning ("App %u does not own handle 0x%lx!", app->app_index,
 321                     mp->handle);
 322       return;
 323     }
 324
 325   /* Client objected to resetting the session, log and continue */
 326   if (mp->retval)
 327     {
 328       clib_warning ("client retval %d", mp->retval);
 329       return;
 330     }
 331
 332   /* This comes as a response to a reset, transport only waiting for
 333    * confirmation to remove connection state, no need to disconnect */
 334   a->handle = mp->handle;
 335   a->app_index = app->app_index;
 336   vnet_disconnect_session (a);
 337 }
 338
 339 static void
 340 session_mq_disconnected_handler (void *data)
 341 {
 342   session_disconnected_reply_msg_t *rmp;
 343   vnet_disconnect_args_t _a, *a = &_a;
 344   svm_msg_q_msg_t _msg, *msg = &_msg;
 345   session_disconnected_msg_t *mp;
 346   app_worker_t *app_wrk;
 347   session_event_t *evt;
 348   session_t *s;
 349   application_t *app;
 350   int rv = 0;
 351
 352   mp = (session_disconnected_msg_t *) data;
 353   if (!(s = session_get_from_handle_if_valid (mp->handle)))
 354     {
 355       clib_warning ("could not disconnect handle %llu", mp->handle);
 356       return;
 357     }
 358   app_wrk = app_worker_get (s->app_wrk_index);
 359   app = application_lookup (mp->client_index);
 360   if (!(app_wrk && app && app->app_index == app_wrk->app_index))
 361     {
 362       clib_warning ("could not disconnect session: %llu app: %u",
 363                     mp->handle, mp->client_index);
 364       return;
 365     }
 366
 367   a->handle = mp->handle;
 368   a->app_index = app_wrk->wrk_index;
 369   rv = vnet_disconnect_session (a);
 370
 371   svm_msg_q_lock_and_alloc_msg_w_ring (app_wrk->event_queue,
 372                                        SESSION_MQ_CTRL_EVT_RING,
 373                                        SVM_Q_WAIT, msg);
 374   evt = svm_msg_q_msg_data (app_wrk->event_queue, msg);
 375   clib_memset (evt, 0, sizeof (*evt));
 376   evt->event_type = SESSION_CTRL_EVT_DISCONNECTED_REPLY;
 377   rmp = (session_disconnected_reply_msg_t *) evt->data;
 378   rmp->handle = mp->handle;
 379   rmp->context = mp->context;
 380   rmp->retval = rv;
 381   svm_msg_q_add_and_unlock (app_wrk->event_queue, msg);
 382 }
 383
 384 static void
 385 session_mq_disconnected_reply_handler (void *data)
 386 {
 387   session_disconnected_reply_msg_t *mp;
 388   vnet_disconnect_args_t _a, *a = &_a;
 389   application_t *app;
 390
 391   mp = (session_disconnected_reply_msg_t *) data;
 392
 393   /* Client objected to disconnecting the session, log and continue */
 394   if (mp->retval)
 395     {
 396       clib_warning ("client retval %d", mp->retval);
 397       return;
 398     }
 399
 400   /* Disconnect has been confirmed. Confirm close to transport */
 401   app = application_lookup (mp->context);
 402   if (app)
 403     {
 404       a->handle = mp->handle;
 405       a->app_index = app->app_index;
 406       vnet_disconnect_session (a);
 407     }
 408 }
 409
 410 static void
 411 session_mq_worker_update_handler (void *data)
 412 {
 413   session_worker_update_msg_t *mp = (session_worker_update_msg_t *) data;
 414   session_worker_update_reply_msg_t *rmp;
 415   svm_msg_q_msg_t _msg, *msg = &_msg;
 416   app_worker_t *app_wrk;
 417   u32 owner_app_wrk_map;
 418   session_event_t *evt;
 419   session_t *s;
 420   application_t *app;
 421
 422   app = application_lookup (mp->client_index);
 423   if (!app)
 424     return;
 425   if (!(s = session_get_from_handle_if_valid (mp->handle)))
 426     {
 427       clib_warning ("invalid handle %llu", mp->handle);
 428       return;
 429     }
 430   app_wrk = app_worker_get (s->app_wrk_index);
 431   if (app_wrk->app_index != app->app_index)
 432     {
 433       clib_warning ("app %u does not own session %llu", app->app_index,
 434                     mp->handle);
 435       return;
 436     }
 437   owner_app_wrk_map = app_wrk->wrk_map_index;
 438   app_wrk = application_get_worker (app, mp->wrk_index);
 439
 440   /* This needs to come from the new owner */
 441   if (mp->req_wrk_index == owner_app_wrk_map)
 442     {
 443       session_req_worker_update_msg_t *wump;
 444
 445       svm_msg_q_lock_and_alloc_msg_w_ring (app_wrk->event_queue,
 446                                            SESSION_MQ_CTRL_EVT_RING,
 447                                            SVM_Q_WAIT, msg);
 448       evt = svm_msg_q_msg_data (app_wrk->event_queue, msg);
 449       clib_memset (evt, 0, sizeof (*evt));
 450       evt->event_type = SESSION_CTRL_EVT_REQ_WORKER_UPDATE;
 451       wump = (session_req_worker_update_msg_t *) evt->data;
 452       wump->session_handle = mp->handle;
 453       svm_msg_q_add_and_unlock (app_wrk->event_queue, msg);
 454       return;
 455     }
 456
 457   app_worker_own_session (app_wrk, s);
 458
 459   /*
 460    * Send reply
 461    */
 462   svm_msg_q_lock_and_alloc_msg_w_ring (app_wrk->event_queue,
 463                                        SESSION_MQ_CTRL_EVT_RING,
 464                                        SVM_Q_WAIT, msg);
 465   evt = svm_msg_q_msg_data (app_wrk->event_queue, msg);
 466   clib_memset (evt, 0, sizeof (*evt));
 467   evt->event_type = SESSION_CTRL_EVT_WORKER_UPDATE_REPLY;
 468   rmp = (session_worker_update_reply_msg_t *) evt->data;
 469   rmp->handle = mp->handle;
 470   rmp->rx_fifo = pointer_to_uword (s->rx_fifo);
 471   rmp->tx_fifo = pointer_to_uword (s->tx_fifo);
 472   rmp->segment_handle = session_segment_handle (s);
 473   svm_msg_q_add_and_unlock (app_wrk->event_queue, msg);
 474
 475   /*
 476    * Retransmit messages that may have been lost
 477    */
 478   if (s->tx_fifo && !svm_fifo_is_empty (s->tx_fifo))
 479     session_send_io_evt_to_thread (s->tx_fifo, SESSION_IO_EVT_TX);
 480
 481   if (s->rx_fifo && !svm_fifo_is_empty (s->rx_fifo))
 482     app_worker_lock_and_send_event (app_wrk, s, SESSION_IO_EVT_RX);
 483
 484   if (s->session_state >= SESSION_STATE_TRANSPORT_CLOSING)
 485     app_worker_close_notify (app_wrk, s);
 486 }
 487
 488 vlib_node_registration_t session_queue_node;
 489
 490 typedef struct
 491 {
 492   u32 session_index;
 493   u32 server_thread_index;
 494 } session_queue_trace_t;
 495
 496 /* packet trace format function */
 497 static u8 *
 498 format_session_queue_trace (u8 * s, va_list * args)
 499 {
 500   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
 501   CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
 502   session_queue_trace_t *t = va_arg (*args, session_queue_trace_t *);
 503
 504   s = format (s, "session index %d thread index %d",
 505               t->session_index, t->server_thread_index);
 506   return s;
 507 }
 508
 509 #define foreach_session_queue_error             \
 510 _(TX, "Packets transmitted")                    \
 511 _(TIMER, "Timer events")                        \
 512 _(NO_BUFFER, "Out of buffers")
 513
 514 typedef enum
 515 {
 516 #define _(sym,str) SESSION_QUEUE_ERROR_##sym,
 517   foreach_session_queue_error
 518 #undef _
 519     SESSION_QUEUE_N_ERROR,
 520 } session_queue_error_t;
 521
 522 static char *session_queue_error_strings[] = {
 523 #define _(sym,string) string,
 524   foreach_session_queue_error
 525 #undef _
 526 };
 527
 528 enum
 529 {
 530   SESSION_TX_NO_BUFFERS = -2,
 531   SESSION_TX_NO_DATA,
 532   SESSION_TX_OK
 533 };
 534
 535 static void
 536 session_tx_trace_frame (vlib_main_t * vm, vlib_node_runtime_t * node,
 537                         u32 next_index, u32 * to_next, u16 n_segs,
 538                         session_t * s, u32 n_trace)
 539 {
 540   session_queue_trace_t *t;
 541   vlib_buffer_t *b;
 542   int i;
 543
 544   for (i = 0; i < clib_min (n_trace, n_segs); i++)
 545     {
 546       b = vlib_get_buffer (vm, to_next[i]);
 547       vlib_trace_buffer (vm, node, next_index, b, 1 /* follow_chain */ );
 548       t = vlib_add_trace (vm, node, b, sizeof (*t));
 549       t->session_index = s->session_index;
 550       t->server_thread_index = s->thread_index;
 551     }
 552   vlib_set_trace_count (vm, node, n_trace - i);
 553 }
 554
 555 always_inline void
 556 session_tx_fifo_chain_tail (vlib_main_t * vm, session_tx_context_t * ctx,
 557                             vlib_buffer_t * b, u16 * n_bufs, u8 peek_data)
 558 {
 559   vlib_buffer_t *chain_b, *prev_b;
 560   u32 chain_bi0, to_deq, left_from_seg;
 561   session_worker_t *wrk;
 562   u16 len_to_deq, n_bytes_read;
 563   u8 *data, j;
 564
 565   wrk = session_main_get_worker (ctx->s->thread_index);
 566   b->flags |= VLIB_BUFFER_TOTAL_LENGTH_VALID;
 567   b->total_length_not_including_first_buffer = 0;
 568
 569   chain_b = b;
 570   left_from_seg = clib_min (ctx->sp.snd_mss - b->current_length,
 571                             ctx->left_to_snd);
 572   to_deq = left_from_seg;
 573   for (j = 1; j < ctx->n_bufs_per_seg; j++)
 574     {
 575       prev_b = chain_b;
 576       len_to_deq = clib_min (to_deq, ctx->deq_per_buf);
 577
 578       *n_bufs -= 1;
 579       chain_bi0 = wrk->tx_buffers[*n_bufs];
 580       chain_b = vlib_get_buffer (vm, chain_bi0);
 581       chain_b->current_data = 0;
 582       data = vlib_buffer_get_current (chain_b);
 583       if (peek_data)
 584         {
 585           n_bytes_read = svm_fifo_peek (ctx->s->tx_fifo,
 586                                         ctx->sp.tx_offset, len_to_deq, data);
 587           ctx->sp.tx_offset += n_bytes_read;
 588         }
 589       else
 590         {
 591           if (ctx->transport_vft->transport_options.tx_type ==
 592               TRANSPORT_TX_DGRAM)
 593             {
 594               svm_fifo_t *f = ctx->s->tx_fifo;
 595               session_dgram_hdr_t *hdr = &ctx->hdr;
 596               u16 deq_now;
 597               deq_now = clib_min (hdr->data_length - hdr->data_offset,
 598                                   len_to_deq);
 599               n_bytes_read = svm_fifo_peek (f, hdr->data_offset, deq_now,
 600                                             data);
 601               ASSERT (n_bytes_read > 0);
 602
 603               hdr->data_offset += n_bytes_read;
 604               if (hdr->data_offset == hdr->data_length)
 605                 {
 606                   u32 offset = hdr->data_length + SESSION_CONN_HDR_LEN;
 607                   svm_fifo_dequeue_drop (f, offset);
 608                 }
 609             }
 610           else
 611             n_bytes_read = svm_fifo_dequeue (ctx->s->tx_fifo,
 612                                              len_to_deq, data);
 613         }
 614       ASSERT (n_bytes_read == len_to_deq);
 615       chain_b->current_length = n_bytes_read;
 616       b->total_length_not_including_first_buffer += chain_b->current_length;
 617
 618       /* update previous buffer */
 619       prev_b->next_buffer = chain_bi0;
 620       prev_b->flags |= VLIB_BUFFER_NEXT_PRESENT;
 621
 622       /* update current buffer */
 623       chain_b->next_buffer = 0;
 624
 625       to_deq -= n_bytes_read;
 626       if (to_deq == 0)
 627         break;
 628     }
 629   ASSERT (to_deq == 0
 630           && b->total_length_not_including_first_buffer == left_from_seg);
 631   ctx->left_to_snd -= left_from_seg;
 632 }
 633
 634 always_inline void
 635 session_tx_fill_buffer (vlib_main_t * vm, session_tx_context_t * ctx,
 636                         vlib_buffer_t * b, u16 * n_bufs, u8 peek_data)
 637 {
 638   u32 len_to_deq;
 639   u8 *data0;
 640   int n_bytes_read;
 641
 642   /*
 643    * Start with the first buffer in chain
 644    */
 645   b->error = 0;
 646   b->flags = VNET_BUFFER_F_LOCALLY_ORIGINATED;
 647   b->current_data = 0;
 648
 649   data0 = vlib_buffer_make_headroom (b, TRANSPORT_MAX_HDRS_LEN);
 650   len_to_deq = clib_min (ctx->left_to_snd, ctx->deq_per_first_buf);
 651
 652   if (peek_data)
 653     {
 654       n_bytes_read = svm_fifo_peek (ctx->s->tx_fifo, ctx->sp.tx_offset,
 655                                     len_to_deq, data0);
 656       ASSERT (n_bytes_read > 0);
 657       /* Keep track of progress locally, transport is also supposed to
 658        * increment it independently when pushing the header */
 659       ctx->sp.tx_offset += n_bytes_read;
 660     }
 661   else
 662     {
 663       if (ctx->transport_vft->transport_options.tx_type == TRANSPORT_TX_DGRAM)
 664         {
 665           session_dgram_hdr_t *hdr = &ctx->hdr;
 666           svm_fifo_t *f = ctx->s->tx_fifo;
 667           u16 deq_now;
 668           u32 offset;
 669
 670           ASSERT (hdr->data_length > hdr->data_offset);
 671           deq_now = clib_min (hdr->data_length - hdr->data_offset,
 672                               len_to_deq);
 673           offset = hdr->data_offset + SESSION_CONN_HDR_LEN;
 674           n_bytes_read = svm_fifo_peek (f, offset, deq_now, data0);
 675           ASSERT (n_bytes_read > 0);
 676
 677           if (ctx->s->session_state == SESSION_STATE_LISTENING)
 678             {
 679               ip_copy (&ctx->tc->rmt_ip, &hdr->rmt_ip, ctx->tc->is_ip4);
 680               ctx->tc->rmt_port = hdr->rmt_port;
 681             }
 682           hdr->data_offset += n_bytes_read;
 683           if (hdr->data_offset == hdr->data_length)
 684             {
 685               offset = hdr->data_length + SESSION_CONN_HDR_LEN;
 686               svm_fifo_dequeue_drop (f, offset);
 687             }
 688         }
 689       else
 690         {
 691           n_bytes_read = svm_fifo_dequeue (ctx->s->tx_fifo,
 692                                            len_to_deq, data0);
 693           ASSERT (n_bytes_read > 0);
 694         }
 695     }
 696   b->current_length = n_bytes_read;
 697   ctx->left_to_snd -= n_bytes_read;
 698
 699   /*
 700    * Fill in the remaining buffers in the chain, if any
 701    */
 702   if (PREDICT_FALSE (ctx->n_bufs_per_seg > 1 && ctx->left_to_snd))
 703     session_tx_fifo_chain_tail (vm, ctx, b, n_bufs, peek_data);
 704 }
 705
 706 always_inline u8
 707 session_tx_not_ready (session_t * s, u8 peek_data)
 708 {
 709   if (peek_data)
 710     {
 711       if (PREDICT_TRUE (s->session_state == SESSION_STATE_READY))
 712         return 0;
 713       /* Can retransmit for closed sessions but can't send new data if
 714        * session is not ready or closed */
 715       else if (s->session_state < SESSION_STATE_READY)
 716         return 1;
 717       else if (s->session_state >= SESSION_STATE_TRANSPORT_CLOSED)
 718         {
 719           /* Allow closed transports to still send custom packets.
 720            * For instance, tcp may want to send acks in time-wait. */
 721           if (s->session_state != SESSION_STATE_TRANSPORT_DELETED
 722               && (s->flags & SESSION_F_CUSTOM_TX))
 723             return 0;
 724           return 2;
 725         }
 726     }
 727   return 0;
 728 }
 729
 730 always_inline transport_connection_t *
 731 session_tx_get_transport (session_tx_context_t * ctx, u8 peek_data)
 732 {
 733   if (peek_data)
 734     {
 735       return ctx->transport_vft->get_connection (ctx->s->connection_index,
 736                                                  ctx->s->thread_index);
 737     }
 738   else
 739     {
 740       if (ctx->s->session_state == SESSION_STATE_LISTENING)
 741         return ctx->transport_vft->get_listener (ctx->s->connection_index);
 742       else
 743         {
 744           return ctx->transport_vft->get_connection (ctx->s->connection_index,
 745                                                      ctx->s->thread_index);
 746         }
 747     }
 748 }
 749
 750 always_inline void
 751 session_tx_set_dequeue_params (vlib_main_t * vm, session_tx_context_t * ctx,
 752                                u32 max_segs, u8 peek_data)
 753 {
 754   u32 n_bytes_per_buf, n_bytes_per_seg;
 755   ctx->max_dequeue = svm_fifo_max_dequeue_cons (ctx->s->tx_fifo);
 756   if (peek_data)
 757     {
 758       /* Offset in rx fifo from where to peek data */
 759       if (PREDICT_FALSE (ctx->sp.tx_offset >= ctx->max_dequeue))
 760         {
 761           ctx->max_len_to_snd = 0;
 762           return;
 763         }
 764       ctx->max_dequeue -= ctx->sp.tx_offset;
 765     }
 766   else
 767     {
 768       if (ctx->transport_vft->transport_options.tx_type == TRANSPORT_TX_DGRAM)
 769         {
 770           if (ctx->max_dequeue <= sizeof (ctx->hdr))
 771             {
 772               ctx->max_len_to_snd = 0;
 773               return;
 774             }
 775           svm_fifo_peek (ctx->s->tx_fifo, 0, sizeof (ctx->hdr),
 776                          (u8 *) & ctx->hdr);
 777           ASSERT (ctx->hdr.data_length > ctx->hdr.data_offset);
 778           ctx->max_dequeue = ctx->hdr.data_length - ctx->hdr.data_offset;
 779         }
 780     }
 781   ASSERT (ctx->max_dequeue > 0);
 782
 783   /* Ensure we're not writing more than transport window allows */
 784   if (ctx->max_dequeue < ctx->sp.snd_space)
 785     {
 786       /* Constrained by tx queue. Try to send only fully formed segments */
 787       ctx->max_len_to_snd = (ctx->max_dequeue > ctx->sp.snd_mss) ?
 788         (ctx->max_dequeue - (ctx->max_dequeue % ctx->sp.snd_mss)) :
 789         ctx->max_dequeue;
 790       /* TODO Nagle ? */
 791     }
 792   else
 793     {
 794       /* Expectation is that snd_space0 is already a multiple of snd_mss */
 795       ctx->max_len_to_snd = ctx->sp.snd_space;
 796     }
 797
 798   /* Check if we're tx constrained by the node */
 799   ctx->n_segs_per_evt = ceil ((f64) ctx->max_len_to_snd / ctx->sp.snd_mss);
 800   if (ctx->n_segs_per_evt > max_segs)
 801     {
 802       ctx->n_segs_per_evt = max_segs;
 803       ctx->max_len_to_snd = max_segs * ctx->sp.snd_mss;
 804     }
 805
 806   n_bytes_per_buf = vlib_buffer_get_default_data_size (vm);
 807   ASSERT (n_bytes_per_buf > TRANSPORT_MAX_HDRS_LEN);
 808   n_bytes_per_seg = TRANSPORT_MAX_HDRS_LEN + ctx->sp.snd_mss;
 809   ctx->n_bufs_per_seg = ceil ((f64) n_bytes_per_seg / n_bytes_per_buf);
 810   ctx->deq_per_buf = clib_min (ctx->sp.snd_mss, n_bytes_per_buf);
 811   ctx->deq_per_first_buf = clib_min (ctx->sp.snd_mss,
 812                                      n_bytes_per_buf -
 813                                      TRANSPORT_MAX_HDRS_LEN);
 814 }
 815
 816 always_inline void
 817 session_tx_maybe_reschedule (session_worker_t * wrk,
 818                              session_tx_context_t * ctx,
 819                              session_evt_elt_t * elt)
 820 {
 821   session_t *s = ctx->s;
 822
 823   svm_fifo_unset_event (s->tx_fifo);
 824   if (svm_fifo_max_dequeue_cons (s->tx_fifo) > ctx->sp.tx_offset)
 825     if (svm_fifo_set_event (s->tx_fifo))
 826       session_evt_add_head_old (wrk, elt);
 827 }
 828
 829 always_inline int
 830 session_tx_fifo_read_and_snd_i (session_worker_t * wrk,
 831                                 vlib_node_runtime_t * node,
 832                                 session_evt_elt_t * elt,
 833                                 int *n_tx_packets, u8 peek_data)
 834 {
 835   u32 n_trace, n_bufs_needed = 0, n_left, pbi, next_index, max_burst;
 836   session_tx_context_t *ctx = &wrk->ctx;
 837   session_main_t *smm = &session_main;
 838   session_event_t *e = &elt->evt;
 839   vlib_main_t *vm = wrk->vm;
 840   transport_proto_t tp;
 841   vlib_buffer_t *pb;
 842   u16 n_bufs, rv;
 843
 844   if (PREDICT_FALSE ((rv = session_tx_not_ready (ctx->s, peek_data))))
 845     {
 846       if (rv < 2)
 847         session_evt_add_old (wrk, elt);
 848       return SESSION_TX_NO_DATA;
 849     }
 850
 851   next_index = smm->session_type_to_next[ctx->s->session_type];
 852   max_burst = VLIB_FRAME_SIZE - *n_tx_packets;
 853
 854   tp = session_get_transport_proto (ctx->s);
 855   ctx->transport_vft = transport_protocol_get_vft (tp);
 856   ctx->tc = session_tx_get_transport (ctx, peek_data);
 857
 858   if (PREDICT_FALSE (e->event_type == SESSION_IO_EVT_TX_FLUSH))
 859     {
 860       if (ctx->transport_vft->flush_data)
 861         ctx->transport_vft->flush_data (ctx->tc);
 862       e->event_type = SESSION_IO_EVT_TX;
 863     }
 864
 865   if (ctx->s->flags & SESSION_F_CUSTOM_TX)
 866     {
 867       u32 n_custom_tx;
 868       ctx->s->flags &= ~SESSION_F_CUSTOM_TX;
 869       n_custom_tx = ctx->transport_vft->custom_tx (ctx->tc, max_burst);
 870       *n_tx_packets += n_custom_tx;
 871       if (PREDICT_FALSE
 872           (ctx->s->session_state >= SESSION_STATE_TRANSPORT_CLOSED))
 873         return SESSION_TX_OK;
 874       max_burst -= n_custom_tx;
 875       if (!max_burst)
 876         {
 877           session_evt_add_old (wrk, elt);
 878           return SESSION_TX_OK;
 879         }
 880     }
 881
 882   transport_connection_snd_params (ctx->tc, &ctx->sp);
 883
 884   if (!ctx->sp.snd_space)
 885     {
 886       /* This flow queue is "empty" so it should be re-evaluated before
 887        * the ones that have data to send. */
 888       if (PREDICT_TRUE (!ctx->sp.flags))
 889         session_evt_add_head_old (wrk, elt);
 890       /* Request to postpone the session, e.g., zero-wnd and transport
 891        * is not currently probing */
 892       else if (ctx->sp.flags & TRANSPORT_SND_F_POSTPONE)
 893         session_evt_add_old (wrk, elt);
 894       /* If the deschedule flag was set, remove session from scheduler.
 895        * Transport is responsible for rescheduling this session. */
 896       else
 897         transport_connection_deschedule (ctx->tc);
 898
 899       return SESSION_TX_NO_DATA;
 900     }
 901
 902   if (transport_connection_is_tx_paced (ctx->tc))
 903     {
 904       u32 snd_space = transport_connection_tx_pacer_burst (ctx->tc);
 905       if (snd_space < TRANSPORT_PACER_MIN_BURST)
 906         {
 907           session_evt_add_head_old (wrk, elt);
 908           return SESSION_TX_NO_DATA;
 909         }
 910       snd_space = clib_min (ctx->sp.snd_space, snd_space);
 911       ctx->sp.snd_space = snd_space >= ctx->sp.snd_mss ?
 912         snd_space - snd_space % ctx->sp.snd_mss : snd_space;
 913     }
 914
 915   /* Check how much we can pull. */
 916   session_tx_set_dequeue_params (vm, ctx, max_burst, peek_data);
 917
 918   if (PREDICT_FALSE (!ctx->max_len_to_snd))
 919     {
 920       transport_connection_tx_pacer_reset_bucket (ctx->tc, 0);
 921       session_tx_maybe_reschedule (wrk, ctx, elt);
 922       return SESSION_TX_NO_DATA;
 923     }
 924
 925   n_bufs_needed = ctx->n_segs_per_evt * ctx->n_bufs_per_seg;
 926   vec_validate_aligned (wrk->tx_buffers, n_bufs_needed - 1,
 927                         CLIB_CACHE_LINE_BYTES);
 928   n_bufs = vlib_buffer_alloc (vm, wrk->tx_buffers, n_bufs_needed);
 929   if (PREDICT_FALSE (n_bufs < n_bufs_needed))
 930     {
 931       if (n_bufs)
 932         vlib_buffer_free (vm, wrk->tx_buffers, n_bufs);
 933       session_evt_add_head_old (wrk, elt);
 934       vlib_node_increment_counter (wrk->vm, node->node_index,
 935                                    SESSION_QUEUE_ERROR_NO_BUFFER, 1);
 936       return SESSION_TX_NO_BUFFERS;
 937     }
 938
 939   ctx->left_to_snd = ctx->max_len_to_snd;
 940   n_left = ctx->n_segs_per_evt;
 941
 942   while (n_left >= 4)
 943     {
 944       vlib_buffer_t *b0, *b1;
 945       u32 bi0, bi1;
 946
 947       pbi = wrk->tx_buffers[n_bufs - 3];
 948       pb = vlib_get_buffer (vm, pbi);
 949       vlib_prefetch_buffer_header (pb, STORE);
 950       pbi = wrk->tx_buffers[n_bufs - 4];
 951       pb = vlib_get_buffer (vm, pbi);
 952       vlib_prefetch_buffer_header (pb, STORE);
 953
 954       bi0 = wrk->tx_buffers[--n_bufs];
 955       bi1 = wrk->tx_buffers[--n_bufs];
 956
 957       b0 = vlib_get_buffer (vm, bi0);
 958       b1 = vlib_get_buffer (vm, bi1);
 959
 960       session_tx_fill_buffer (vm, ctx, b0, &n_bufs, peek_data);
 961       session_tx_fill_buffer (vm, ctx, b1, &n_bufs, peek_data);
 962
 963       ctx->transport_vft->push_header (ctx->tc, b0);
 964       ctx->transport_vft->push_header (ctx->tc, b1);
 965
 966       n_left -= 2;
 967
 968       VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b0);
 969       VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b1);
 970
 971       vec_add1 (wrk->pending_tx_buffers, bi0);
 972       vec_add1 (wrk->pending_tx_buffers, bi1);
 973       vec_add1 (wrk->pending_tx_nexts, next_index);
 974       vec_add1 (wrk->pending_tx_nexts, next_index);
 975     }
 976   while (n_left)
 977     {
 978       vlib_buffer_t *b0;
 979       u32 bi0;
 980
 981       if (n_left > 1)
 982         {
 983           pbi = wrk->tx_buffers[n_bufs - 2];
 984           pb = vlib_get_buffer (vm, pbi);
 985           vlib_prefetch_buffer_header (pb, STORE);
 986         }
 987
 988       bi0 = wrk->tx_buffers[--n_bufs];
 989       b0 = vlib_get_buffer (vm, bi0);
 990       session_tx_fill_buffer (vm, ctx, b0, &n_bufs, peek_data);
 991
 992       /* Ask transport to push header after current_length and
 993        * total_length_not_including_first_buffer are updated */
 994       ctx->transport_vft->push_header (ctx->tc, b0);
 995
 996       n_left -= 1;
 997
 998       VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b0);
 999
1000       vec_add1 (wrk->pending_tx_buffers, bi0);
1001       vec_add1 (wrk->pending_tx_nexts, next_index);
1002     }
1003
1004   if (PREDICT_FALSE ((n_trace = vlib_get_trace_count (vm, node)) > 0))
1005     session_tx_trace_frame (vm, node, next_index, wrk->pending_tx_buffers,
1006                             ctx->n_segs_per_evt, ctx->s, n_trace);
1007
1008   if (PREDICT_FALSE (n_bufs))
1009     vlib_buffer_free (vm, wrk->tx_buffers, n_bufs);
1010
1011   *n_tx_packets += ctx->n_segs_per_evt;
1012   transport_connection_update_tx_bytes (ctx->tc, ctx->max_len_to_snd);
1013
1014   SESSION_EVT (SESSION_EVT_DEQ, ctx->s, ctx->max_len_to_snd, ctx->max_dequeue,
1015                ctx->s->tx_fifo->has_event, wrk->last_vlib_time);
1016
1017   ASSERT (ctx->left_to_snd == 0);
1018
1019   /* If we couldn't dequeue all bytes reschedule as old flow. Otherwise,
1020    * check if application enqueued more data and reschedule accordingly */
1021   if (ctx->max_len_to_snd < ctx->max_dequeue)
1022     session_evt_add_old (wrk, elt);
1023   else
1024     session_tx_maybe_reschedule (wrk, ctx, elt);
1025
1026   if (!peek_data
1027       && ctx->transport_vft->transport_options.tx_type == TRANSPORT_TX_DGRAM)
1028     {
1029       /* Fix dgram pre header */
1030       if (ctx->max_len_to_snd < ctx->max_dequeue)
1031         svm_fifo_overwrite_head (ctx->s->tx_fifo, (u8 *) & ctx->hdr,
1032                                  sizeof (session_dgram_pre_hdr_t));
1033       /* More data needs to be read */
1034       else if (svm_fifo_max_dequeue_cons (ctx->s->tx_fifo) > 0)
1035         if (svm_fifo_set_event (ctx->s->tx_fifo))
1036           session_evt_add_old (wrk, elt);
1037
1038       if (svm_fifo_needs_deq_ntf (ctx->s->tx_fifo, ctx->max_len_to_snd))
1039         session_dequeue_notify (ctx->s);
1040     }
1041   return SESSION_TX_OK;
1042 }
1043
1044 int
1045 session_tx_fifo_peek_and_snd (session_worker_t * wrk,
1046                               vlib_node_runtime_t * node,
1047                               session_evt_elt_t * e, int *n_tx_packets)
1048 {
1049   return session_tx_fifo_read_and_snd_i (wrk, node, e, n_tx_packets, 1);
1050 }
1051
1052 int
1053 session_tx_fifo_dequeue_and_snd (session_worker_t * wrk,
1054                                  vlib_node_runtime_t * node,
1055                                  session_evt_elt_t * e, int *n_tx_packets)
1056 {
1057   return session_tx_fifo_read_and_snd_i (wrk, node, e, n_tx_packets, 0);
1058 }
1059
1060 int
1061 session_tx_fifo_dequeue_internal (session_worker_t * wrk,
1062                                   vlib_node_runtime_t * node,
1063                                   session_evt_elt_t * e, int *n_tx_packets)
1064 {
1065   session_t *s = wrk->ctx.s;
1066
1067   if (PREDICT_FALSE (s->session_state >= SESSION_STATE_TRANSPORT_CLOSED))
1068     return 0;
1069   svm_fifo_unset_event (s->tx_fifo);
1070   return transport_custom_tx (session_get_transport_proto (s), s,
1071                               VLIB_FRAME_SIZE - *n_tx_packets);
1072 }
1073
1074 always_inline session_t *
1075 session_event_get_session (session_event_t * e, u8 thread_index)
1076 {
1077   return session_get_if_valid (e->session_index, thread_index);
1078 }
1079
1080 always_inline void
1081 session_event_dispatch_ctrl (session_worker_t * wrk, session_evt_elt_t * elt)
1082 {
1083   clib_llist_index_t ei;
1084   void (*fp) (void *);
1085   session_event_t *e;
1086   session_t *s;
1087
1088   ei = clib_llist_entry_index (wrk->event_elts, elt);
1089   e = &elt->evt;
1090
1091   switch (e->event_type)
1092     {
1093     case SESSION_CTRL_EVT_RPC:
1094       fp = e->rpc_args.fp;
1095       (*fp) (e->rpc_args.arg);
1096       break;
1097     case SESSION_CTRL_EVT_CLOSE:
1098       s = session_get_from_handle_if_valid (e->session_handle);
1099       if (PREDICT_FALSE (!s))
1100         break;
1101       session_transport_close (s);
1102       break;
1103     case SESSION_CTRL_EVT_RESET:
1104       s = session_get_from_handle_if_valid (e->session_handle);
1105       if (PREDICT_FALSE (!s))
1106         break;
1107       session_transport_reset (s);
1108       break;
1109     case SESSION_CTRL_EVT_LISTEN:
1110       session_mq_listen_handler (session_evt_ctrl_data (wrk, elt));
1111       break;
1112     case SESSION_CTRL_EVT_LISTEN_URI:
1113       session_mq_listen_uri_handler (session_evt_ctrl_data (wrk, elt));
1114       break;
1115     case SESSION_CTRL_EVT_UNLISTEN:
1116       session_mq_unlisten_handler (session_evt_ctrl_data (wrk, elt));
1117       break;
1118     case SESSION_CTRL_EVT_CONNECT:
1119       session_mq_connect_handler (session_evt_ctrl_data (wrk, elt));
1120       break;
1121     case SESSION_CTRL_EVT_CONNECT_URI:
1122       session_mq_connect_uri_handler (session_evt_ctrl_data (wrk, elt));
1123       break;
1124     case SESSION_CTRL_EVT_DISCONNECT:
1125       session_mq_disconnect_handler (session_evt_ctrl_data (wrk, elt));
1126       break;
1127     case SESSION_CTRL_EVT_DISCONNECTED:
1128       session_mq_disconnected_handler (session_evt_ctrl_data (wrk, elt));
1129       break;
1130     case SESSION_CTRL_EVT_ACCEPTED_REPLY:
1131       session_mq_accepted_reply_handler (session_evt_ctrl_data (wrk, elt));
1132       break;
1133     case SESSION_CTRL_EVT_DISCONNECTED_REPLY:
1134       session_mq_disconnected_reply_handler (session_evt_ctrl_data (wrk,
1135                                                                     elt));
1136       break;
1137     case SESSION_CTRL_EVT_RESET_REPLY:
1138       session_mq_reset_reply_handler (session_evt_ctrl_data (wrk, elt));
1139       break;
1140     case SESSION_CTRL_EVT_WORKER_UPDATE:
1141       session_mq_worker_update_handler (session_evt_ctrl_data (wrk, elt));
1142       break;
1143     case SESSION_CTRL_EVT_APP_DETACH:
1144       app_mq_detach_handler (session_evt_ctrl_data (wrk, elt));
1145       break;
1146     default:
1147       clib_warning ("unhandled event type %d", e->event_type);
1148     }
1149
1150   /* Regrab elements in case pool moved */
1151   elt = pool_elt_at_index (wrk->event_elts, ei);
1152   if (!clib_llist_elt_is_linked (elt, evt_list))
1153     {
1154       e = &elt->evt;
1155       if (e->event_type >= SESSION_CTRL_EVT_BOUND)
1156         session_evt_ctrl_data_free (wrk, elt);
1157       session_evt_elt_free (wrk, elt);
1158     }
1159 }
1160
1161 always_inline void
1162 session_event_dispatch_io (session_worker_t * wrk, vlib_node_runtime_t * node,
1163                            session_evt_elt_t * elt, u32 thread_index,
1164                            int *n_tx_packets)
1165 {
1166   session_main_t *smm = &session_main;
1167   app_worker_t *app_wrk;
1168   clib_llist_index_t ei;
1169   session_event_t *e;
1170   session_t *s;
1171
1172   ei = clib_llist_entry_index (wrk->event_elts, elt);
1173   e = &elt->evt;
1174
1175   switch (e->event_type)
1176     {
1177     case SESSION_IO_EVT_TX_FLUSH:
1178     case SESSION_IO_EVT_TX:
1179       s = session_event_get_session (e, thread_index);
1180       if (PREDICT_FALSE (!s))
1181         break;
1182       CLIB_PREFETCH (s->tx_fifo, 2 * CLIB_CACHE_LINE_BYTES, LOAD);
1183       wrk->ctx.s = s;
1184       /* Spray packets in per session type frames, since they go to
1185        * different nodes */
1186       (smm->session_tx_fns[s->session_type]) (wrk, node, elt, n_tx_packets);
1187       break;
1188     case SESSION_IO_EVT_RX:
1189       s = session_event_get_session (e, thread_index);
1190       if (!s)
1191         break;
1192       transport_app_rx_evt (session_get_transport_proto (s),
1193                             s->connection_index, s->thread_index);
1194       break;
1195     case SESSION_IO_EVT_BUILTIN_RX:
1196       s = session_event_get_session (e, thread_index);
1197       if (PREDICT_FALSE (!s || s->session_state >= SESSION_STATE_CLOSING))
1198         break;
1199       svm_fifo_unset_event (s->rx_fifo);
1200       app_wrk = app_worker_get (s->app_wrk_index);
1201       app_worker_builtin_rx (app_wrk, s);
1202       break;
1203     case SESSION_IO_EVT_BUILTIN_TX:
1204       s = session_get_from_handle_if_valid (e->session_handle);
1205       wrk->ctx.s = s;
1206       if (PREDICT_TRUE (s != 0))
1207         session_tx_fifo_dequeue_internal (wrk, node, elt, n_tx_packets);
1208       break;
1209     default:
1210       clib_warning ("unhandled event type %d", e->event_type);
1211     }
1212
1213   /* Regrab elements in case pool moved */
1214   elt = pool_elt_at_index (wrk->event_elts, ei);
1215   if (!clib_llist_elt_is_linked (elt, evt_list))
1216     session_evt_elt_free (wrk, elt);
1217 }
1218
1219 /* *INDENT-OFF* */
1220 static const u32 session_evt_msg_sizes[] = {
1221 #define _(symc, sym)                                                    \
1222   [SESSION_CTRL_EVT_ ## symc] = sizeof (session_ ## sym ##_msg_t),
1223   foreach_session_ctrl_evt
1224 #undef _
1225 };
1226 /* *INDENT-ON* */
1227
1228 always_inline void
1229 session_evt_add_to_list (session_worker_t * wrk, session_event_t * evt)
1230 {
1231   session_evt_elt_t *elt;
1232
1233   if (evt->event_type >= SESSION_CTRL_EVT_RPC)
1234     {
1235       elt = session_evt_alloc_ctrl (wrk);
1236       if (evt->event_type >= SESSION_CTRL_EVT_BOUND)
1237         {
1238           elt->evt.ctrl_data_index = session_evt_ctrl_data_alloc (wrk);
1239           elt->evt.event_type = evt->event_type;
1240           clib_memcpy_fast (session_evt_ctrl_data (wrk, elt), evt->data,
1241                             session_evt_msg_sizes[evt->event_type]);
1242         }
1243       else
1244         {
1245           /* Internal control events fit into io events footprint */
1246           clib_memcpy_fast (&elt->evt, evt, sizeof (elt->evt));
1247         }
1248     }
1249   else
1250     {
1251       elt = session_evt_alloc_new (wrk);
1252       clib_memcpy_fast (&elt->evt, evt, sizeof (elt->evt));
1253     }
1254 }
1255
1256 static void
1257 session_flush_pending_tx_buffers (session_worker_t * wrk,
1258                                   vlib_node_runtime_t * node)
1259 {
1260   vlib_buffer_enqueue_to_next (wrk->vm, node, wrk->pending_tx_buffers,
1261                                wrk->pending_tx_nexts,
1262                                vec_len (wrk->pending_tx_nexts));
1263   vec_reset_length (wrk->pending_tx_buffers);
1264   vec_reset_length (wrk->pending_tx_nexts);
1265 }
1266
1267 static uword
1268 session_queue_node_fn (vlib_main_t * vm, vlib_node_runtime_t * node,
1269                        vlib_frame_t * frame)
1270 {
1271   session_main_t *smm = vnet_get_session_main ();
1272   u32 thread_index = vm->thread_index, n_to_dequeue;
1273   session_worker_t *wrk = &smm->wrk[thread_index];
1274   session_evt_elt_t *elt, *ctrl_he, *new_he, *old_he;
1275   clib_llist_index_t ei, next_ei, old_ti;
1276   svm_msg_q_msg_t _msg, *msg = &_msg;
1277   int i, n_tx_packets;
1278   session_event_t *evt;
1279   svm_msg_q_t *mq;
1280
1281   SESSION_EVT (SESSION_EVT_DISPATCH_START, wrk);
1282
1283   wrk->last_vlib_time = vlib_time_now (vm);
1284   wrk->last_vlib_us_time = wrk->last_vlib_time * CLIB_US_TIME_FREQ;
1285
1286   /*
1287    *  Update transport time
1288    */
1289   transport_update_time (wrk->last_vlib_time, thread_index);
1290   n_tx_packets = vec_len (wrk->pending_tx_buffers);
1291
1292   /*
1293    *  Dequeue and handle new events
1294    */
1295
1296   /* Try to dequeue what is available. Don't wait for lock.
1297    * XXX: we may need priorities here */
1298   mq = wrk->vpp_event_queue;
1299   n_to_dequeue = svm_msg_q_size (mq);
1300   if (n_to_dequeue && svm_msg_q_try_lock (mq) == 0)
1301     {
1302       for (i = 0; i < n_to_dequeue; i++)
1303         {
1304           svm_msg_q_sub_w_lock (mq, msg);
1305           evt = svm_msg_q_msg_data (mq, msg);
1306           session_evt_add_to_list (wrk, evt);
1307           svm_msg_q_free_msg (mq, msg);
1308         }
1309       svm_msg_q_unlock (mq);
1310     }
1311
1312   /*
1313    * Handle control events
1314    */
1315
1316   ctrl_he = pool_elt_at_index (wrk->event_elts, wrk->ctrl_head);
1317
1318   /* *INDENT-OFF* */
1319   clib_llist_foreach_safe (wrk->event_elts, evt_list, ctrl_he, elt, ({
1320     clib_llist_remove (wrk->event_elts, evt_list, elt);
1321     session_event_dispatch_ctrl (wrk, elt);
1322   }));
1323   /* *INDENT-ON* */
1324
1325   /*
1326    * Handle the new io events.
1327    */
1328
1329   new_he = pool_elt_at_index (wrk->event_elts, wrk->new_head);
1330   old_he = pool_elt_at_index (wrk->event_elts, wrk->old_head);
1331   old_ti = clib_llist_prev_index (old_he, evt_list);
1332
1333   ei = clib_llist_next_index (new_he, evt_list);
1334   while (ei != wrk->new_head && n_tx_packets < VLIB_FRAME_SIZE)
1335     {
1336       elt = pool_elt_at_index (wrk->event_elts, ei);
1337       ei = clib_llist_next_index (elt, evt_list);
1338       clib_llist_remove (wrk->event_elts, evt_list, elt);
1339       session_event_dispatch_io (wrk, node, elt, thread_index, &n_tx_packets);
1340     }
1341
1342   /*
1343    * Handle the old io events, if we had any prior to processing the new ones
1344    */
1345
1346   if (old_ti != wrk->old_head)
1347     {
1348       old_he = pool_elt_at_index (wrk->event_elts, wrk->old_head);
1349       ei = clib_llist_next_index (old_he, evt_list);
1350
1351       while (n_tx_packets < VLIB_FRAME_SIZE)
1352         {
1353           elt = pool_elt_at_index (wrk->event_elts, ei);
1354           next_ei = clib_llist_next_index (elt, evt_list);
1355           clib_llist_remove (wrk->event_elts, evt_list, elt);
1356
1357           session_event_dispatch_io (wrk, node, elt, thread_index,
1358                                      &n_tx_packets);
1359
1360           if (ei == old_ti)
1361             break;
1362
1363           ei = next_ei;
1364         };
1365     }
1366
1367   if (vec_len (wrk->pending_tx_buffers))
1368     session_flush_pending_tx_buffers (wrk, node);
1369
1370   vlib_node_increment_counter (vm, session_queue_node.index,
1371                                SESSION_QUEUE_ERROR_TX, n_tx_packets);
1372
1373   SESSION_EVT (SESSION_EVT_DISPATCH_END, wrk, n_tx_packets);
1374
1375   return n_tx_packets;
1376 }
1377
1378 /* *INDENT-OFF* */
1379 VLIB_REGISTER_NODE (session_queue_node) =
1380 {
1381   .function = session_queue_node_fn,
1382   .flags = VLIB_NODE_FLAG_TRACE_SUPPORTED,
1383   .name = "session-queue",
1384   .format_trace = format_session_queue_trace,
1385   .type = VLIB_NODE_TYPE_INPUT,
1386   .n_errors = ARRAY_LEN (session_queue_error_strings),
1387   .error_strings = session_queue_error_strings,
1388   .state = VLIB_NODE_STATE_DISABLED,
1389 };
1390 /* *INDENT-ON* */
1391
1392 void
1393 dump_thread_0_event_queue (void)
1394 {
1395   session_main_t *smm = vnet_get_session_main ();
1396   vlib_main_t *vm = &vlib_global_main;
1397   u32 my_thread_index = vm->thread_index;
1398   session_event_t _e, *e = &_e;
1399   svm_msg_q_ring_t *ring;
1400   session_t *s0;
1401   svm_msg_q_msg_t *msg;
1402   svm_msg_q_t *mq;
1403   int i, index;
1404
1405   mq = smm->wrk[my_thread_index].vpp_event_queue;
1406   index = mq->q->head;
1407
1408   for (i = 0; i < mq->q->cursize; i++)
1409     {
1410       msg = (svm_msg_q_msg_t *) (&mq->q->data[0] + mq->q->elsize * index);
1411       ring = svm_msg_q_ring (mq, msg->ring_index);
1412       clib_memcpy_fast (e, svm_msg_q_msg_data (mq, msg), ring->elsize);
1413
1414       switch (e->event_type)
1415         {
1416         case SESSION_IO_EVT_TX:
1417           s0 = session_event_get_session (e, my_thread_index);
1418           fformat (stdout, "[%04d] TX session %d\n", i, s0->session_index);
1419           break;
1420
1421         case SESSION_CTRL_EVT_CLOSE:
1422           s0 = session_get_from_handle (e->session_handle);
1423           fformat (stdout, "[%04d] disconnect session %d\n", i,
1424                    s0->session_index);
1425           break;
1426
1427         case SESSION_IO_EVT_BUILTIN_RX:
1428           s0 = session_event_get_session (e, my_thread_index);
1429           fformat (stdout, "[%04d] builtin_rx %d\n", i, s0->session_index);
1430           break;
1431
1432         case SESSION_CTRL_EVT_RPC:
1433           fformat (stdout, "[%04d] RPC call %llx with %llx\n",
1434                    i, (u64) (uword) (e->rpc_args.fp),
1435                    (u64) (uword) (e->rpc_args.arg));
1436           break;
1437
1438         default:
1439           fformat (stdout, "[%04d] unhandled event type %d\n",
1440                    i, e->event_type);
1441           break;
1442         }
1443
1444       index++;
1445
1446       if (index == mq->q->maxsize)
1447         index = 0;
1448     }
1449 }
1450
1451 static u8
1452 session_node_cmp_event (session_event_t * e, svm_fifo_t * f)
1453 {
1454   session_t *s;
1455   switch (e->event_type)
1456     {
1457     case SESSION_IO_EVT_RX:
1458     case SESSION_IO_EVT_TX:
1459     case SESSION_IO_EVT_BUILTIN_RX:
1460     case SESSION_IO_EVT_BUILTIN_TX:
1461     case SESSION_IO_EVT_TX_FLUSH:
1462       if (e->session_index == f->master_session_index)
1463         return 1;
1464       break;
1465     case SESSION_CTRL_EVT_CLOSE:
1466       break;
1467     case SESSION_CTRL_EVT_RPC:
1468       s = session_get_from_handle (e->session_handle);
1469       if (!s)
1470         {
1471           clib_warning ("session has event but doesn't exist!");
1472           break;
1473         }
1474       if (s->rx_fifo == f || s->tx_fifo == f)
1475         return 1;
1476       break;
1477     default:
1478       break;
1479     }
1480   return 0;
1481 }
1482
1483 u8
1484 session_node_lookup_fifo_event (svm_fifo_t * f, session_event_t * e)
1485 {
1486   session_evt_elt_t *elt;
1487   session_worker_t *wrk;
1488   int i, index, found = 0;
1489   svm_msg_q_msg_t *msg;
1490   svm_msg_q_ring_t *ring;
1491   svm_msg_q_t *mq;
1492   u8 thread_index;
1493
1494   ASSERT (e);
1495   thread_index = f->master_thread_index;
1496   wrk = session_main_get_worker (thread_index);
1497
1498   /*
1499    * Search evt queue
1500    */
1501   mq = wrk->vpp_event_queue;
1502   index = mq->q->head;
1503   for (i = 0; i < mq->q->cursize; i++)
1504     {
1505       msg = (svm_msg_q_msg_t *) (&mq->q->data[0] + mq->q->elsize * index);
1506       ring = svm_msg_q_ring (mq, msg->ring_index);
1507       clib_memcpy_fast (e, svm_msg_q_msg_data (mq, msg), ring->elsize);
1508       found = session_node_cmp_event (e, f);
1509       if (found)
1510         return 1;
1511       index = (index + 1) % mq->q->maxsize;
1512     }
1513   /*
1514    * Search pending events vector
1515    */
1516
1517   /* *INDENT-OFF* */
1518   clib_llist_foreach (wrk->event_elts, evt_list,
1519                       pool_elt_at_index (wrk->event_elts, wrk->new_head),
1520                       elt, ({
1521     found = session_node_cmp_event (&elt->evt, f);
1522     if (found)
1523       {
1524         clib_memcpy_fast (e, &elt->evt, sizeof (*e));
1525         goto done;
1526       }
1527   }));
1528   /* *INDENT-ON* */
1529
1530   /* *INDENT-OFF* */
1531   clib_llist_foreach (wrk->event_elts, evt_list,
1532                       pool_elt_at_index (wrk->event_elts, wrk->old_head),
1533                       elt, ({
1534     found = session_node_cmp_event (&elt->evt, f);
1535     if (found)
1536       {
1537         clib_memcpy_fast (e, &elt->evt, sizeof (*e));
1538         goto done;
1539       }
1540   }));
1541   /* *INDENT-ON* */
1542
1543 done:
1544   return found;
1545 }
1546
1547 static clib_error_t *
1548 session_queue_exit (vlib_main_t * vm)
1549 {
1550   if (vec_len (vlib_mains) < 2)
1551     return 0;
1552
1553   /*
1554    * Shut off (especially) worker-thread session nodes.
1555    * Otherwise, vpp can crash as the main thread unmaps the
1556    * API segment.
1557    */
1558   vlib_worker_thread_barrier_sync (vm);
1559   session_node_enable_disable (0 /* is_enable */ );
1560   vlib_worker_thread_barrier_release (vm);
1561   return 0;
1562 }
1563
1564 VLIB_MAIN_LOOP_EXIT_FUNCTION (session_queue_exit);
1565
1566 static uword
1567 session_queue_process (vlib_main_t * vm, vlib_node_runtime_t * rt,
1568                        vlib_frame_t * f)
1569 {
1570   f64 now, timeout = 1.0;
1571   uword *event_data = 0;
1572   uword event_type;
1573
1574   while (1)
1575     {
1576       vlib_process_wait_for_event_or_clock (vm, timeout);
1577       now = vlib_time_now (vm);
1578       event_type = vlib_process_get_events (vm, (uword **) & event_data);
1579
1580       switch (event_type)
1581         {
1582         case SESSION_Q_PROCESS_FLUSH_FRAMES:
1583           /* Flush the frames by updating all transports times */
1584           transport_update_time (now, 0);
1585           break;
1586         case SESSION_Q_PROCESS_STOP:
1587           timeout = 100000.0;
1588           break;
1589         case ~0:
1590           /* Timed out. Update time for all transports to trigger all
1591            * outstanding retransmits. */
1592           transport_update_time (now, 0);
1593           break;
1594         }
1595       vec_reset_length (event_data);
1596     }
1597   return 0;
1598 }
1599
1600 /* *INDENT-OFF* */
1601 VLIB_REGISTER_NODE (session_queue_process_node) =
1602 {
1603   .function = session_queue_process,
1604   .type = VLIB_NODE_TYPE_PROCESS,
1605   .name = "session-queue-process",
1606   .state = VLIB_NODE_STATE_DISABLED,
1607 };
1608 /* *INDENT-ON* */
1609
1610 static_always_inline uword
1611 session_queue_pre_input_inline (vlib_main_t * vm, vlib_node_runtime_t * node,
1612                                 vlib_frame_t * frame)
1613 {
1614   session_main_t *sm = &session_main;
1615   if (!sm->wrk[0].vpp_event_queue)
1616     return 0;
1617   node = vlib_node_get_runtime (vm, session_queue_node.index);
1618   return session_queue_node_fn (vm, node, frame);
1619 }
1620
1621 /* *INDENT-OFF* */
1622 VLIB_REGISTER_NODE (session_queue_pre_input_node) =
1623 {
1624   .function = session_queue_pre_input_inline,
1625   .type = VLIB_NODE_TYPE_PRE_INPUT,
1626   .name = "session-queue-main",
1627   .state = VLIB_NODE_STATE_DISABLED,
1628 };
1629 /* *INDENT-ON* */
1630
1631 /*
1632  * fd.io coding-style-patch-verification: ON
1633  *
1634  * Local Variables:
1635  * eval: (c-set-style "gnu")
1636  * End:
1637  */