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