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