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