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