src/vnet/session/session_node.c

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