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