| /* |
| * Copyright (c) 2017-2019 Cisco and/or its affiliates. |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at: |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| |
| #include <math.h> |
| #include <vlib/vlib.h> |
| #include <vnet/vnet.h> |
| #include <vppinfra/elog.h> |
| #include <vnet/session/transport.h> |
| #include <vnet/session/session.h> |
| #include <vnet/session/application.h> |
| #include <vnet/session/application_interface.h> |
| #include <vnet/session/application_local.h> |
| #include <vnet/session/session_debug.h> |
| #include <svm/queue.h> |
| |
| static void session_mq_accepted_reply_handler (void *data); |
| |
| static void |
| accepted_notify_cb (void *data, u32 data_len) |
| { |
| session_mq_accepted_reply_handler (data); |
| } |
| |
| static void |
| session_mq_accepted_reply_handler (void *data) |
| { |
| session_accepted_reply_msg_t *mp = (session_accepted_reply_msg_t *) data; |
| vnet_disconnect_args_t _a = { 0 }, *a = &_a; |
| session_state_t old_state; |
| app_worker_t *app_wrk; |
| session_t *s; |
| |
| /* Server isn't interested, kill the session */ |
| if (mp->retval) |
| { |
| a->app_index = mp->context; |
| a->handle = mp->handle; |
| vnet_disconnect_session (a); |
| return; |
| } |
| |
| /* Mail this back from the main thread. We're not polling in main |
| * thread so we're using other workers for notifications. */ |
| if (vlib_num_workers () && vlib_get_thread_index () != 0 |
| && session_thread_from_handle (mp->handle) == 0) |
| { |
| vl_api_rpc_call_main_thread (accepted_notify_cb, data, |
| sizeof (session_accepted_reply_msg_t)); |
| return; |
| } |
| |
| s = session_get_from_handle_if_valid (mp->handle); |
| if (!s) |
| return; |
| |
| app_wrk = app_worker_get (s->app_wrk_index); |
| if (app_wrk->app_index != mp->context) |
| { |
| clib_warning ("app doesn't own session"); |
| return; |
| } |
| |
| if (!session_has_transport (s)) |
| { |
| s->session_state = SESSION_STATE_READY; |
| if (ct_session_connect_notify (s)) |
| return; |
| } |
| else |
| { |
| old_state = s->session_state; |
| s->session_state = SESSION_STATE_READY; |
| if (!svm_fifo_is_empty (s->rx_fifo)) |
| app_worker_lock_and_send_event (app_wrk, s, SESSION_IO_EVT_RX); |
| |
| /* Closed while waiting for app to reply. Resend disconnect */ |
| if (old_state >= SESSION_STATE_TRANSPORT_CLOSING) |
| { |
| application_t *app = application_get (app_wrk->app_index); |
| app->cb_fns.session_disconnect_callback (s); |
| s->session_state = old_state; |
| return; |
| } |
| } |
| } |
| |
| static void |
| session_mq_reset_reply_handler (void *data) |
| { |
| vnet_disconnect_args_t _a = { 0 }, *a = &_a; |
| session_reset_reply_msg_t *mp; |
| app_worker_t *app_wrk; |
| session_t *s; |
| application_t *app; |
| u32 index, thread_index; |
| |
| mp = (session_reset_reply_msg_t *) data; |
| app = application_lookup (mp->context); |
| if (!app) |
| return; |
| |
| session_parse_handle (mp->handle, &index, &thread_index); |
| s = session_get_if_valid (index, thread_index); |
| |
| /* Session was already closed or already cleaned up */ |
| if (!s || s->session_state != SESSION_STATE_TRANSPORT_CLOSING) |
| return; |
| |
| app_wrk = app_worker_get (s->app_wrk_index); |
| if (!app_wrk || app_wrk->app_index != app->app_index) |
| { |
| clib_warning ("App % does not own handle 0x%lx!", app->app_index, |
| mp->handle); |
| return; |
| } |
| |
| /* Client objected to resetting the session, log and continue */ |
| if (mp->retval) |
| { |
| clib_warning ("client retval %d", mp->retval); |
| return; |
| } |
| |
| /* This comes as a response to a reset, transport only waiting for |
| * confirmation to remove connection state, no need to disconnect */ |
| a->handle = mp->handle; |
| a->app_index = app->app_index; |
| vnet_disconnect_session (a); |
| } |
| |
| static void |
| session_mq_disconnected_handler (void *data) |
| { |
| session_disconnected_reply_msg_t *rmp; |
| vnet_disconnect_args_t _a, *a = &_a; |
| svm_msg_q_msg_t _msg, *msg = &_msg; |
| session_disconnected_msg_t *mp; |
| app_worker_t *app_wrk; |
| session_event_t *evt; |
| session_t *s; |
| application_t *app; |
| int rv = 0; |
| |
| mp = (session_disconnected_msg_t *) data; |
| if (!(s = session_get_from_handle_if_valid (mp->handle))) |
| { |
| clib_warning ("could not disconnect handle %llu", mp->handle); |
| return; |
| } |
| app_wrk = app_worker_get (s->app_wrk_index); |
| app = application_lookup (mp->client_index); |
| if (!(app_wrk && app && app->app_index == app_wrk->app_index)) |
| { |
| clib_warning ("could not disconnect session: %llu app: %u", |
| mp->handle, mp->client_index); |
| return; |
| } |
| |
| a->handle = mp->handle; |
| a->app_index = app_wrk->wrk_index; |
| rv = vnet_disconnect_session (a); |
| |
| svm_msg_q_lock_and_alloc_msg_w_ring (app_wrk->event_queue, |
| SESSION_MQ_CTRL_EVT_RING, |
| SVM_Q_WAIT, msg); |
| svm_msg_q_unlock (app_wrk->event_queue); |
| evt = svm_msg_q_msg_data (app_wrk->event_queue, msg); |
| clib_memset (evt, 0, sizeof (*evt)); |
| evt->event_type = SESSION_CTRL_EVT_DISCONNECTED_REPLY; |
| rmp = (session_disconnected_reply_msg_t *) evt->data; |
| rmp->handle = mp->handle; |
| rmp->context = mp->context; |
| rmp->retval = rv; |
| svm_msg_q_add (app_wrk->event_queue, msg, SVM_Q_WAIT); |
| } |
| |
| static void |
| session_mq_disconnected_reply_handler (void *data) |
| { |
| session_disconnected_reply_msg_t *mp; |
| vnet_disconnect_args_t _a, *a = &_a; |
| application_t *app; |
| |
| mp = (session_disconnected_reply_msg_t *) data; |
| |
| /* Client objected to disconnecting the session, log and continue */ |
| if (mp->retval) |
| { |
| clib_warning ("client retval %d", mp->retval); |
| return; |
| } |
| |
| /* Disconnect has been confirmed. Confirm close to transport */ |
| app = application_lookup (mp->context); |
| if (app) |
| { |
| a->handle = mp->handle; |
| a->app_index = app->app_index; |
| vnet_disconnect_session (a); |
| } |
| } |
| |
| static void |
| session_mq_worker_update_handler (void *data) |
| { |
| session_worker_update_msg_t *mp = (session_worker_update_msg_t *) data; |
| session_worker_update_reply_msg_t *rmp; |
| svm_msg_q_msg_t _msg, *msg = &_msg; |
| app_worker_t *app_wrk; |
| u32 owner_app_wrk_map; |
| session_event_t *evt; |
| session_t *s; |
| application_t *app; |
| |
| app = application_lookup (mp->client_index); |
| if (!app) |
| return; |
| if (!(s = session_get_from_handle_if_valid (mp->handle))) |
| { |
| clib_warning ("invalid handle %llu", mp->handle); |
| return; |
| } |
| app_wrk = app_worker_get (s->app_wrk_index); |
| if (app_wrk->app_index != app->app_index) |
| { |
| clib_warning ("app %u does not own session %llu", app->app_index, |
| mp->handle); |
| return; |
| } |
| owner_app_wrk_map = app_wrk->wrk_map_index; |
| app_wrk = application_get_worker (app, mp->wrk_index); |
| |
| /* This needs to come from the new owner */ |
| if (mp->req_wrk_index == owner_app_wrk_map) |
| { |
| session_req_worker_update_msg_t *wump; |
| |
| svm_msg_q_lock_and_alloc_msg_w_ring (app_wrk->event_queue, |
| SESSION_MQ_CTRL_EVT_RING, |
| SVM_Q_WAIT, msg); |
| svm_msg_q_unlock (app_wrk->event_queue); |
| evt = svm_msg_q_msg_data (app_wrk->event_queue, msg); |
| clib_memset (evt, 0, sizeof (*evt)); |
| evt->event_type = SESSION_CTRL_EVT_REQ_WORKER_UPDATE; |
| wump = (session_req_worker_update_msg_t *) evt->data; |
| wump->session_handle = mp->handle; |
| svm_msg_q_add (app_wrk->event_queue, msg, SVM_Q_WAIT); |
| return; |
| } |
| |
| app_worker_own_session (app_wrk, s); |
| |
| /* |
| * Send reply |
| */ |
| svm_msg_q_lock_and_alloc_msg_w_ring (app_wrk->event_queue, |
| SESSION_MQ_CTRL_EVT_RING, |
| SVM_Q_WAIT, msg); |
| svm_msg_q_unlock (app_wrk->event_queue); |
| evt = svm_msg_q_msg_data (app_wrk->event_queue, msg); |
| clib_memset (evt, 0, sizeof (*evt)); |
| evt->event_type = SESSION_CTRL_EVT_WORKER_UPDATE_REPLY; |
| rmp = (session_worker_update_reply_msg_t *) evt->data; |
| rmp->handle = mp->handle; |
| rmp->rx_fifo = pointer_to_uword (s->rx_fifo); |
| rmp->tx_fifo = pointer_to_uword (s->tx_fifo); |
| rmp->segment_handle = session_segment_handle (s); |
| svm_msg_q_add (app_wrk->event_queue, msg, SVM_Q_WAIT); |
| |
| /* |
| * Retransmit messages that may have been lost |
| */ |
| if (s->tx_fifo && !svm_fifo_is_empty (s->tx_fifo)) |
| session_send_io_evt_to_thread (s->tx_fifo, SESSION_IO_EVT_TX); |
| |
| if (s->rx_fifo && !svm_fifo_is_empty (s->rx_fifo)) |
| app_worker_lock_and_send_event (app_wrk, s, SESSION_IO_EVT_RX); |
| |
| if (s->session_state >= SESSION_STATE_TRANSPORT_CLOSING) |
| app->cb_fns.session_disconnect_callback (s); |
| } |
| |
| vlib_node_registration_t session_queue_node; |
| |
| typedef struct |
| { |
| u32 session_index; |
| u32 server_thread_index; |
| } session_queue_trace_t; |
| |
| /* packet trace format function */ |
| static u8 * |
| format_session_queue_trace (u8 * s, va_list * args) |
| { |
| CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *); |
| CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *); |
| session_queue_trace_t *t = va_arg (*args, session_queue_trace_t *); |
| |
| s = format (s, "SESSION_QUEUE: session index %d, server thread index %d", |
| t->session_index, t->server_thread_index); |
| return s; |
| } |
| |
| #define foreach_session_queue_error \ |
| _(TX, "Packets transmitted") \ |
| _(TIMER, "Timer events") \ |
| _(NO_BUFFER, "Out of buffers") |
| |
| typedef enum |
| { |
| #define _(sym,str) SESSION_QUEUE_ERROR_##sym, |
| foreach_session_queue_error |
| #undef _ |
| SESSION_QUEUE_N_ERROR, |
| } session_queue_error_t; |
| |
| static char *session_queue_error_strings[] = { |
| #define _(sym,string) string, |
| foreach_session_queue_error |
| #undef _ |
| }; |
| |
| enum |
| { |
| SESSION_TX_NO_BUFFERS = -2, |
| SESSION_TX_NO_DATA, |
| SESSION_TX_OK |
| }; |
| |
| static void |
| session_tx_trace_frame (vlib_main_t * vm, vlib_node_runtime_t * node, |
| u32 next_index, u32 * to_next, u16 n_segs, |
| session_t * s, u32 n_trace) |
| { |
| session_queue_trace_t *t; |
| vlib_buffer_t *b; |
| int i; |
| |
| for (i = 0; i < clib_min (n_trace, n_segs); i++) |
| { |
| b = vlib_get_buffer (vm, to_next[i - n_segs]); |
| vlib_trace_buffer (vm, node, next_index, b, 1 /* follow_chain */ ); |
| t = vlib_add_trace (vm, node, b, sizeof (*t)); |
| t->session_index = s->session_index; |
| t->server_thread_index = s->thread_index; |
| } |
| vlib_set_trace_count (vm, node, n_trace - i); |
| } |
| |
| always_inline void |
| session_tx_fifo_chain_tail (vlib_main_t * vm, session_tx_context_t * ctx, |
| vlib_buffer_t * b, u16 * n_bufs, u8 peek_data) |
| { |
| vlib_buffer_t *chain_b, *prev_b; |
| u32 chain_bi0, to_deq, left_from_seg; |
| session_worker_t *wrk; |
| u16 len_to_deq, n_bytes_read; |
| u8 *data, j; |
| |
| wrk = session_main_get_worker (ctx->s->thread_index); |
| b->flags |= VLIB_BUFFER_TOTAL_LENGTH_VALID; |
| b->total_length_not_including_first_buffer = 0; |
| |
| chain_b = b; |
| left_from_seg = clib_min (ctx->snd_mss - b->current_length, |
| ctx->left_to_snd); |
| to_deq = left_from_seg; |
| for (j = 1; j < ctx->n_bufs_per_seg; j++) |
| { |
| prev_b = chain_b; |
| len_to_deq = clib_min (to_deq, ctx->deq_per_buf); |
| |
| *n_bufs -= 1; |
| chain_bi0 = wrk->tx_buffers[*n_bufs]; |
| chain_b = vlib_get_buffer (vm, chain_bi0); |
| chain_b->current_data = 0; |
| data = vlib_buffer_get_current (chain_b); |
| if (peek_data) |
| { |
| n_bytes_read = svm_fifo_peek (ctx->s->tx_fifo, |
| ctx->tx_offset, len_to_deq, data); |
| ctx->tx_offset += n_bytes_read; |
| } |
| else |
| { |
| if (ctx->transport_vft->tx_type == TRANSPORT_TX_DGRAM) |
| { |
| svm_fifo_t *f = ctx->s->tx_fifo; |
| session_dgram_hdr_t *hdr = &ctx->hdr; |
| u16 deq_now; |
| deq_now = clib_min (hdr->data_length - hdr->data_offset, |
| len_to_deq); |
| n_bytes_read = svm_fifo_peek (f, hdr->data_offset, deq_now, |
| data); |
| ASSERT (n_bytes_read > 0); |
| |
| hdr->data_offset += n_bytes_read; |
| if (hdr->data_offset == hdr->data_length) |
| { |
| u32 offset = hdr->data_length + SESSION_CONN_HDR_LEN; |
| svm_fifo_dequeue_drop (f, offset); |
| } |
| } |
| else |
| n_bytes_read = svm_fifo_dequeue_nowait (ctx->s->tx_fifo, |
| len_to_deq, data); |
| } |
| ASSERT (n_bytes_read == len_to_deq); |
| chain_b->current_length = n_bytes_read; |
| b->total_length_not_including_first_buffer += chain_b->current_length; |
| |
| /* update previous buffer */ |
| prev_b->next_buffer = chain_bi0; |
| prev_b->flags |= VLIB_BUFFER_NEXT_PRESENT; |
| |
| /* update current buffer */ |
| chain_b->next_buffer = 0; |
| |
| to_deq -= n_bytes_read; |
| if (to_deq == 0) |
| break; |
| } |
| ASSERT (to_deq == 0 |
| && b->total_length_not_including_first_buffer == left_from_seg); |
| ctx->left_to_snd -= left_from_seg; |
| } |
| |
| always_inline void |
| session_tx_fill_buffer (vlib_main_t * vm, session_tx_context_t * ctx, |
| vlib_buffer_t * b, u16 * n_bufs, u8 peek_data) |
| { |
| u32 len_to_deq; |
| u8 *data0; |
| int n_bytes_read; |
| |
| /* |
| * Start with the first buffer in chain |
| */ |
| b->error = 0; |
| b->flags = VNET_BUFFER_F_LOCALLY_ORIGINATED; |
| b->current_data = 0; |
| |
| data0 = vlib_buffer_make_headroom (b, TRANSPORT_MAX_HDRS_LEN); |
| len_to_deq = clib_min (ctx->left_to_snd, ctx->deq_per_first_buf); |
| |
| if (peek_data) |
| { |
| n_bytes_read = svm_fifo_peek (ctx->s->tx_fifo, ctx->tx_offset, |
| len_to_deq, data0); |
| ASSERT (n_bytes_read > 0); |
| /* Keep track of progress locally, transport is also supposed to |
| * increment it independently when pushing the header */ |
| ctx->tx_offset += n_bytes_read; |
| } |
| else |
| { |
| if (ctx->transport_vft->tx_type == TRANSPORT_TX_DGRAM) |
| { |
| session_dgram_hdr_t *hdr = &ctx->hdr; |
| svm_fifo_t *f = ctx->s->tx_fifo; |
| u16 deq_now; |
| u32 offset; |
| |
| ASSERT (hdr->data_length > hdr->data_offset); |
| deq_now = clib_min (hdr->data_length - hdr->data_offset, |
| len_to_deq); |
| offset = hdr->data_offset + SESSION_CONN_HDR_LEN; |
| n_bytes_read = svm_fifo_peek (f, offset, deq_now, data0); |
| ASSERT (n_bytes_read > 0); |
| |
| if (ctx->s->session_state == SESSION_STATE_LISTENING) |
| { |
| ip_copy (&ctx->tc->rmt_ip, &hdr->rmt_ip, ctx->tc->is_ip4); |
| ctx->tc->rmt_port = hdr->rmt_port; |
| } |
| hdr->data_offset += n_bytes_read; |
| if (hdr->data_offset == hdr->data_length) |
| { |
| offset = hdr->data_length + SESSION_CONN_HDR_LEN; |
| svm_fifo_dequeue_drop (f, offset); |
| } |
| } |
| else |
| { |
| n_bytes_read = svm_fifo_dequeue_nowait (ctx->s->tx_fifo, |
| len_to_deq, data0); |
| ASSERT (n_bytes_read > 0); |
| } |
| } |
| b->current_length = n_bytes_read; |
| ctx->left_to_snd -= n_bytes_read; |
| |
| /* |
| * Fill in the remaining buffers in the chain, if any |
| */ |
| if (PREDICT_FALSE (ctx->n_bufs_per_seg > 1 && ctx->left_to_snd)) |
| session_tx_fifo_chain_tail (vm, ctx, b, n_bufs, peek_data); |
| |
| /* *INDENT-OFF* */ |
| SESSION_EVT_DBG(SESSION_EVT_DEQ, ctx->s, ({ |
| ed->data[0] = SESSION_IO_EVT_TX; |
| ed->data[1] = ctx->max_dequeue; |
| ed->data[2] = len_to_deq; |
| ed->data[3] = ctx->left_to_snd; |
| })); |
| /* *INDENT-ON* */ |
| } |
| |
| always_inline u8 |
| session_tx_not_ready (session_t * s, u8 peek_data) |
| { |
| if (peek_data) |
| { |
| /* Can retransmit for closed sessions but can't send new data if |
| * session is not ready or closed */ |
| if (s->session_state < SESSION_STATE_READY) |
| return 1; |
| if (s->session_state >= SESSION_STATE_TRANSPORT_CLOSED) |
| return 2; |
| } |
| return 0; |
| } |
| |
| always_inline transport_connection_t * |
| session_tx_get_transport (session_tx_context_t * ctx, u8 peek_data) |
| { |
| if (peek_data) |
| { |
| return ctx->transport_vft->get_connection (ctx->s->connection_index, |
| ctx->s->thread_index); |
| } |
| else |
| { |
| if (ctx->s->session_state == SESSION_STATE_LISTENING) |
| return ctx->transport_vft->get_listener (ctx->s->connection_index); |
| else |
| { |
| return ctx->transport_vft->get_connection (ctx->s->connection_index, |
| ctx->s->thread_index); |
| } |
| } |
| } |
| |
| always_inline void |
| session_tx_set_dequeue_params (vlib_main_t * vm, session_tx_context_t * ctx, |
| u32 max_segs, u8 peek_data) |
| { |
| u32 n_bytes_per_buf, n_bytes_per_seg; |
| ctx->max_dequeue = svm_fifo_max_dequeue (ctx->s->tx_fifo); |
| if (peek_data) |
| { |
| /* Offset in rx fifo from where to peek data */ |
| ctx->tx_offset = ctx->transport_vft->tx_fifo_offset (ctx->tc); |
| if (PREDICT_FALSE (ctx->tx_offset >= ctx->max_dequeue)) |
| { |
| ctx->max_len_to_snd = 0; |
| return; |
| } |
| ctx->max_dequeue -= ctx->tx_offset; |
| } |
| else |
| { |
| if (ctx->transport_vft->tx_type == TRANSPORT_TX_DGRAM) |
| { |
| if (ctx->max_dequeue <= sizeof (ctx->hdr)) |
| { |
| ctx->max_len_to_snd = 0; |
| return; |
| } |
| svm_fifo_peek (ctx->s->tx_fifo, 0, sizeof (ctx->hdr), |
| (u8 *) & ctx->hdr); |
| ASSERT (ctx->hdr.data_length > ctx->hdr.data_offset); |
| ctx->max_dequeue = ctx->hdr.data_length - ctx->hdr.data_offset; |
| } |
| } |
| ASSERT (ctx->max_dequeue > 0); |
| |
| /* Ensure we're not writing more than transport window allows */ |
| if (ctx->max_dequeue < ctx->snd_space) |
| { |
| /* Constrained by tx queue. Try to send only fully formed segments */ |
| ctx->max_len_to_snd = |
| (ctx->max_dequeue > ctx->snd_mss) ? |
| ctx->max_dequeue - ctx->max_dequeue % ctx->snd_mss : ctx->max_dequeue; |
| /* TODO Nagle ? */ |
| } |
| else |
| { |
| /* Expectation is that snd_space0 is already a multiple of snd_mss */ |
| ctx->max_len_to_snd = ctx->snd_space; |
| } |
| |
| /* Check if we're tx constrained by the node */ |
| ctx->n_segs_per_evt = ceil ((f64) ctx->max_len_to_snd / ctx->snd_mss); |
| if (ctx->n_segs_per_evt > max_segs) |
| { |
| ctx->n_segs_per_evt = max_segs; |
| ctx->max_len_to_snd = max_segs * ctx->snd_mss; |
| } |
| |
| n_bytes_per_buf = vlib_buffer_get_default_data_size (vm); |
| ASSERT (n_bytes_per_buf > TRANSPORT_MAX_HDRS_LEN); |
| n_bytes_per_seg = TRANSPORT_MAX_HDRS_LEN + ctx->snd_mss; |
| ctx->n_bufs_per_seg = ceil ((f64) n_bytes_per_seg / n_bytes_per_buf); |
| ctx->deq_per_buf = clib_min (ctx->snd_mss, n_bytes_per_buf); |
| ctx->deq_per_first_buf = clib_min (ctx->snd_mss, |
| n_bytes_per_buf - |
| TRANSPORT_MAX_HDRS_LEN); |
| } |
| |
| always_inline int |
| session_tx_fifo_read_and_snd_i (vlib_main_t * vm, vlib_node_runtime_t * node, |
| session_worker_t * wrk, |
| session_event_t * e, int *n_tx_packets, |
| u8 peek_data) |
| { |
| u32 next_index, next0, next1, *to_next, n_left_to_next, n_left, pbi; |
| u32 n_trace = vlib_get_trace_count (vm, node), n_bufs_needed = 0; |
| session_main_t *smm = &session_main; |
| session_tx_context_t *ctx = &wrk->ctx; |
| transport_proto_t tp; |
| vlib_buffer_t *pb; |
| u16 n_bufs, rv; |
| |
| if (PREDICT_FALSE ((rv = session_tx_not_ready (ctx->s, peek_data)))) |
| { |
| if (rv < 2) |
| vec_add1 (wrk->pending_event_vector, *e); |
| return SESSION_TX_NO_DATA; |
| } |
| |
| next_index = smm->session_type_to_next[ctx->s->session_type]; |
| next0 = next1 = next_index; |
| |
| tp = session_get_transport_proto (ctx->s); |
| ctx->transport_vft = transport_protocol_get_vft (tp); |
| ctx->tc = session_tx_get_transport (ctx, peek_data); |
| ctx->snd_mss = ctx->transport_vft->send_mss (ctx->tc); |
| |
| if (PREDICT_FALSE (e->event_type == SESSION_IO_EVT_TX_FLUSH)) |
| { |
| if (ctx->transport_vft->flush_data) |
| ctx->transport_vft->flush_data (ctx->tc); |
| } |
| |
| ctx->snd_space = transport_connection_snd_space (ctx->tc, |
| vm->clib_time. |
| last_cpu_time, |
| ctx->snd_mss); |
| if (ctx->snd_space == 0 || ctx->snd_mss == 0) |
| { |
| vec_add1 (wrk->pending_event_vector, *e); |
| return SESSION_TX_NO_DATA; |
| } |
| |
| /* Allow enqueuing of a new event */ |
| svm_fifo_unset_event (ctx->s->tx_fifo); |
| |
| /* Check how much we can pull. */ |
| session_tx_set_dequeue_params (vm, ctx, VLIB_FRAME_SIZE - *n_tx_packets, |
| peek_data); |
| |
| if (PREDICT_FALSE (!ctx->max_len_to_snd)) |
| return SESSION_TX_NO_DATA; |
| |
| n_bufs_needed = ctx->n_segs_per_evt * ctx->n_bufs_per_seg; |
| vec_validate_aligned (wrk->tx_buffers, n_bufs_needed - 1, |
| CLIB_CACHE_LINE_BYTES); |
| n_bufs = vlib_buffer_alloc (vm, wrk->tx_buffers, n_bufs_needed); |
| if (PREDICT_FALSE (n_bufs < n_bufs_needed)) |
| { |
| if (n_bufs) |
| vlib_buffer_free (vm, wrk->tx_buffers, n_bufs); |
| vec_add1 (wrk->pending_event_vector, *e); |
| return SESSION_TX_NO_BUFFERS; |
| } |
| |
| /* |
| * Write until we fill up a frame |
| */ |
| vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next); |
| if (PREDICT_FALSE (ctx->n_segs_per_evt > n_left_to_next)) |
| { |
| ctx->n_segs_per_evt = n_left_to_next; |
| ctx->max_len_to_snd = ctx->snd_mss * n_left_to_next; |
| } |
| ctx->left_to_snd = ctx->max_len_to_snd; |
| n_left = ctx->n_segs_per_evt; |
| |
| while (n_left >= 4) |
| { |
| vlib_buffer_t *b0, *b1; |
| u32 bi0, bi1; |
| |
| pbi = wrk->tx_buffers[n_bufs - 3]; |
| pb = vlib_get_buffer (vm, pbi); |
| vlib_prefetch_buffer_header (pb, STORE); |
| pbi = wrk->tx_buffers[n_bufs - 4]; |
| pb = vlib_get_buffer (vm, pbi); |
| vlib_prefetch_buffer_header (pb, STORE); |
| |
| to_next[0] = bi0 = wrk->tx_buffers[--n_bufs]; |
| to_next[1] = bi1 = wrk->tx_buffers[--n_bufs]; |
| |
| b0 = vlib_get_buffer (vm, bi0); |
| b1 = vlib_get_buffer (vm, bi1); |
| |
| session_tx_fill_buffer (vm, ctx, b0, &n_bufs, peek_data); |
| session_tx_fill_buffer (vm, ctx, b1, &n_bufs, peek_data); |
| |
| ctx->transport_vft->push_header (ctx->tc, b0); |
| ctx->transport_vft->push_header (ctx->tc, b1); |
| |
| to_next += 2; |
| n_left_to_next -= 2; |
| n_left -= 2; |
| |
| VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b0); |
| VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b1); |
| |
| vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next, |
| n_left_to_next, bi0, bi1, next0, |
| next1); |
| } |
| while (n_left) |
| { |
| vlib_buffer_t *b0; |
| u32 bi0; |
| |
| if (n_left > 1) |
| { |
| pbi = wrk->tx_buffers[n_bufs - 2]; |
| pb = vlib_get_buffer (vm, pbi); |
| vlib_prefetch_buffer_header (pb, STORE); |
| } |
| |
| to_next[0] = bi0 = wrk->tx_buffers[--n_bufs]; |
| b0 = vlib_get_buffer (vm, bi0); |
| session_tx_fill_buffer (vm, ctx, b0, &n_bufs, peek_data); |
| |
| /* Ask transport to push header after current_length and |
| * total_length_not_including_first_buffer are updated */ |
| ctx->transport_vft->push_header (ctx->tc, b0); |
| |
| to_next += 1; |
| n_left_to_next -= 1; |
| n_left -= 1; |
| |
| VLIB_BUFFER_TRACE_TRAJECTORY_INIT (b0); |
| |
| vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next, |
| n_left_to_next, bi0, next0); |
| } |
| |
| if (PREDICT_FALSE (n_trace > 0)) |
| session_tx_trace_frame (vm, node, next_index, to_next, |
| ctx->n_segs_per_evt, ctx->s, n_trace); |
| if (PREDICT_FALSE (n_bufs)) |
| { |
| clib_warning ("not all buffers consumed"); |
| vlib_buffer_free (vm, wrk->tx_buffers, n_bufs); |
| } |
| *n_tx_packets += ctx->n_segs_per_evt; |
| transport_connection_update_tx_stats (ctx->tc, ctx->max_len_to_snd); |
| vlib_put_next_frame (vm, node, next_index, n_left_to_next); |
| |
| /* If we couldn't dequeue all bytes mark as partially read */ |
| ASSERT (ctx->left_to_snd == 0); |
| if (ctx->max_len_to_snd < ctx->max_dequeue) |
| if (svm_fifo_set_event (ctx->s->tx_fifo)) |
| vec_add1 (wrk->pending_event_vector, *e); |
| |
| if (!peek_data && ctx->transport_vft->tx_type == TRANSPORT_TX_DGRAM) |
| { |
| /* Fix dgram pre header */ |
| if (ctx->max_len_to_snd < ctx->max_dequeue) |
| svm_fifo_overwrite_head (ctx->s->tx_fifo, (u8 *) & ctx->hdr, |
| sizeof (session_dgram_pre_hdr_t)); |
| /* More data needs to be read */ |
| else if (svm_fifo_max_dequeue (ctx->s->tx_fifo) > 0) |
| if (svm_fifo_set_event (ctx->s->tx_fifo)) |
| vec_add1 (wrk->pending_event_vector, *e); |
| } |
| return SESSION_TX_OK; |
| } |
| |
| int |
| session_tx_fifo_peek_and_snd (vlib_main_t * vm, vlib_node_runtime_t * node, |
| session_worker_t * wrk, |
| session_event_t * e, int *n_tx_pkts) |
| { |
| return session_tx_fifo_read_and_snd_i (vm, node, wrk, e, n_tx_pkts, 1); |
| } |
| |
| int |
| session_tx_fifo_dequeue_and_snd (vlib_main_t * vm, vlib_node_runtime_t * node, |
| session_worker_t * wrk, |
| session_event_t * e, int *n_tx_pkts) |
| { |
| return session_tx_fifo_read_and_snd_i (vm, node, wrk, e, n_tx_pkts, 0); |
| } |
| |
| int |
| session_tx_fifo_dequeue_internal (vlib_main_t * vm, |
| vlib_node_runtime_t * node, |
| session_worker_t * wrk, |
| session_event_t * e, int *n_tx_pkts) |
| { |
| session_t *s = wrk->ctx.s; |
| |
| if (PREDICT_FALSE (s->session_state >= SESSION_STATE_TRANSPORT_CLOSED)) |
| return 0; |
| svm_fifo_unset_event (s->tx_fifo); |
| return transport_custom_tx (session_get_transport_proto (s), s); |
| } |
| |
| always_inline session_t * |
| session_event_get_session (session_event_t * e, u8 thread_index) |
| { |
| return session_get_if_valid (e->session_index, thread_index); |
| } |
| |
| static void |
| session_update_dispatch_period (session_worker_t * wrk, f64 now, |
| u32 thread_index) |
| { |
| if (wrk->last_tx_packets) |
| { |
| f64 sample = now - wrk->last_vlib_time; |
| wrk->dispatch_period = (wrk->dispatch_period + sample) * 0.5; |
| } |
| wrk->last_vlib_time = now; |
| } |
| |
| static uword |
| session_queue_node_fn (vlib_main_t * vm, vlib_node_runtime_t * node, |
| vlib_frame_t * frame) |
| { |
| session_main_t *smm = vnet_get_session_main (); |
| u32 thread_index = vm->thread_index, n_to_dequeue, n_events; |
| session_worker_t *wrk = &smm->wrk[thread_index]; |
| session_event_t *e, *fifo_events; |
| svm_msg_q_msg_t _msg, *msg = &_msg; |
| f64 now = vlib_time_now (vm); |
| int n_tx_packets = 0, i, rv; |
| app_worker_t *app_wrk; |
| application_t *app; |
| svm_msg_q_t *mq; |
| void (*fp) (void *); |
| |
| SESSION_EVT_DBG (SESSION_EVT_POLL_GAP_TRACK, smm, thread_index); |
| |
| /* |
| * Update transport time |
| */ |
| session_update_dispatch_period (wrk, now, thread_index); |
| transport_update_time (now, thread_index); |
| |
| SESSION_EVT_DBG (SESSION_EVT_DEQ_NODE, 0); |
| |
| /* Make sure postponed events are handled first */ |
| fifo_events = wrk->free_event_vector; |
| vec_append (fifo_events, wrk->postponed_event_vector); |
| _vec_len (wrk->postponed_event_vector) = 0; |
| |
| /* Try to dequeue what is available. Don't wait for lock. |
| * XXX: we may need priorities here */ |
| mq = wrk->vpp_event_queue; |
| n_to_dequeue = svm_msg_q_size (mq); |
| if (n_to_dequeue && svm_msg_q_try_lock (mq) == 0) |
| { |
| for (i = 0; i < n_to_dequeue; i++) |
| { |
| vec_add2 (fifo_events, e, 1); |
| svm_msg_q_sub_w_lock (mq, msg); |
| /* Works because reply messages are smaller than a session evt. |
| * If we ever need to support bigger messages this needs to be |
| * fixed */ |
| clib_memcpy_fast (e, svm_msg_q_msg_data (mq, msg), sizeof (*e)); |
| svm_msg_q_free_msg (mq, msg); |
| } |
| svm_msg_q_unlock (mq); |
| } |
| |
| vec_append (fifo_events, wrk->pending_event_vector); |
| vec_append (fifo_events, wrk->pending_disconnects); |
| |
| _vec_len (wrk->pending_event_vector) = 0; |
| _vec_len (wrk->pending_disconnects) = 0; |
| |
| n_events = vec_len (fifo_events); |
| if (PREDICT_FALSE (!n_events)) |
| return 0; |
| |
| for (i = 0; i < n_events; i++) |
| { |
| session_t *s; /* $$$ prefetch 1 ahead maybe */ |
| session_event_t *e; |
| u8 need_tx_ntf; |
| |
| e = &fifo_events[i]; |
| switch (e->event_type) |
| { |
| case SESSION_IO_EVT_TX_FLUSH: |
| case SESSION_IO_EVT_TX: |
| /* Don't try to send more that one frame per dispatch cycle */ |
| if (n_tx_packets == VLIB_FRAME_SIZE) |
| { |
| vec_add1 (wrk->postponed_event_vector, *e); |
| break; |
| } |
| |
| s = session_event_get_session (e, thread_index); |
| if (PREDICT_FALSE (!s)) |
| { |
| clib_warning ("session was freed!"); |
| continue; |
| } |
| CLIB_PREFETCH (s->tx_fifo, 2 * CLIB_CACHE_LINE_BYTES, LOAD); |
| wrk->ctx.s = s; |
| /* Spray packets in per session type frames, since they go to |
| * different nodes */ |
| rv = (smm->session_tx_fns[s->session_type]) (vm, node, wrk, e, |
| &n_tx_packets); |
| if (PREDICT_TRUE (rv == SESSION_TX_OK)) |
| { |
| need_tx_ntf = svm_fifo_needs_tx_ntf (s->tx_fifo, |
| wrk->ctx.max_len_to_snd); |
| if (PREDICT_FALSE (need_tx_ntf)) |
| session_dequeue_notify (s); |
| } |
| else if (PREDICT_FALSE (rv == SESSION_TX_NO_BUFFERS)) |
| { |
| vlib_node_increment_counter (vm, node->node_index, |
| SESSION_QUEUE_ERROR_NO_BUFFER, 1); |
| continue; |
| } |
| break; |
| case SESSION_CTRL_EVT_CLOSE: |
| s = session_get_from_handle_if_valid (e->session_handle); |
| if (PREDICT_FALSE (!s)) |
| break; |
| |
| /* Make sure session disconnects run after the pending list is |
| * drained, i.e., postpone if the first time. If not the first |
| * and the tx queue is still not empty, try to wait for some |
| * dispatch cycles */ |
| if (!e->postponed |
| || (e->postponed < 200 && svm_fifo_max_dequeue (s->tx_fifo))) |
| { |
| e->postponed += 1; |
| vec_add1 (wrk->pending_disconnects, *e); |
| continue; |
| } |
| |
| session_transport_close (s); |
| break; |
| case SESSION_IO_EVT_BUILTIN_RX: |
| s = session_event_get_session (e, thread_index); |
| if (PREDICT_FALSE (!s || s->session_state >= SESSION_STATE_CLOSING)) |
| continue; |
| svm_fifo_unset_event (s->rx_fifo); |
| app_wrk = app_worker_get (s->app_wrk_index); |
| app = application_get (app_wrk->app_index); |
| app->cb_fns.builtin_app_rx_callback (s); |
| break; |
| case SESSION_IO_EVT_BUILTIN_TX: |
| s = session_get_from_handle_if_valid (e->session_handle); |
| wrk->ctx.s = s; |
| if (PREDICT_TRUE (s != 0)) |
| session_tx_fifo_dequeue_internal (vm, node, wrk, e, |
| &n_tx_packets); |
| break; |
| case SESSION_CTRL_EVT_RPC: |
| fp = e->rpc_args.fp; |
| (*fp) (e->rpc_args.arg); |
| break; |
| case SESSION_CTRL_EVT_DISCONNECTED: |
| session_mq_disconnected_handler (e->data); |
| break; |
| case SESSION_CTRL_EVT_ACCEPTED_REPLY: |
| session_mq_accepted_reply_handler (e->data); |
| break; |
| case SESSION_CTRL_EVT_CONNECTED_REPLY: |
| break; |
| case SESSION_CTRL_EVT_DISCONNECTED_REPLY: |
| session_mq_disconnected_reply_handler (e->data); |
| break; |
| case SESSION_CTRL_EVT_RESET_REPLY: |
| session_mq_reset_reply_handler (e->data); |
| break; |
| case SESSION_CTRL_EVT_WORKER_UPDATE: |
| session_mq_worker_update_handler (e->data); |
| break; |
| default: |
| clib_warning ("unhandled event type %d", e->event_type); |
| } |
| } |
| |
| _vec_len (fifo_events) = 0; |
| wrk->free_event_vector = fifo_events; |
| wrk->last_tx_packets = n_tx_packets; |
| |
| vlib_node_increment_counter (vm, session_queue_node.index, |
| SESSION_QUEUE_ERROR_TX, n_tx_packets); |
| |
| SESSION_EVT_DBG (SESSION_EVT_DISPATCH_END, smm, thread_index); |
| |
| return n_tx_packets; |
| } |
| |
| /* *INDENT-OFF* */ |
| VLIB_REGISTER_NODE (session_queue_node) = |
| { |
| .function = session_queue_node_fn, |
| .name = "session-queue", |
| .format_trace = format_session_queue_trace, |
| .type = VLIB_NODE_TYPE_INPUT, |
| .n_errors = ARRAY_LEN (session_queue_error_strings), |
| .error_strings = session_queue_error_strings, |
| .state = VLIB_NODE_STATE_DISABLED, |
| }; |
| /* *INDENT-ON* */ |
| |
| void |
| dump_thread_0_event_queue (void) |
| { |
| session_main_t *smm = vnet_get_session_main (); |
| vlib_main_t *vm = &vlib_global_main; |
| u32 my_thread_index = vm->thread_index; |
| session_event_t _e, *e = &_e; |
| svm_msg_q_ring_t *ring; |
| session_t *s0; |
| svm_msg_q_msg_t *msg; |
| svm_msg_q_t *mq; |
| int i, index; |
| |
| mq = smm->wrk[my_thread_index].vpp_event_queue; |
| index = mq->q->head; |
| |
| for (i = 0; i < mq->q->cursize; i++) |
| { |
| msg = (svm_msg_q_msg_t *) (&mq->q->data[0] + mq->q->elsize * index); |
| ring = svm_msg_q_ring (mq, msg->ring_index); |
| clib_memcpy_fast (e, svm_msg_q_msg_data (mq, msg), ring->elsize); |
| |
| switch (e->event_type) |
| { |
| case SESSION_IO_EVT_TX: |
| s0 = session_event_get_session (e, my_thread_index); |
| fformat (stdout, "[%04d] TX session %d\n", i, s0->session_index); |
| break; |
| |
| case SESSION_CTRL_EVT_CLOSE: |
| s0 = session_get_from_handle (e->session_handle); |
| fformat (stdout, "[%04d] disconnect session %d\n", i, |
| s0->session_index); |
| break; |
| |
| case SESSION_IO_EVT_BUILTIN_RX: |
| s0 = session_event_get_session (e, my_thread_index); |
| fformat (stdout, "[%04d] builtin_rx %d\n", i, s0->session_index); |
| break; |
| |
| case SESSION_CTRL_EVT_RPC: |
| fformat (stdout, "[%04d] RPC call %llx with %llx\n", |
| i, (u64) (uword) (e->rpc_args.fp), |
| (u64) (uword) (e->rpc_args.arg)); |
| break; |
| |
| default: |
| fformat (stdout, "[%04d] unhandled event type %d\n", |
| i, e->event_type); |
| break; |
| } |
| |
| index++; |
| |
| if (index == mq->q->maxsize) |
| index = 0; |
| } |
| } |
| |
| static u8 |
| session_node_cmp_event (session_event_t * e, svm_fifo_t * f) |
| { |
| session_t *s; |
| switch (e->event_type) |
| { |
| case SESSION_IO_EVT_RX: |
| case SESSION_IO_EVT_TX: |
| case SESSION_IO_EVT_BUILTIN_RX: |
| if (e->session_index == f->master_session_index) |
| return 1; |
| break; |
| case SESSION_CTRL_EVT_CLOSE: |
| break; |
| case SESSION_CTRL_EVT_RPC: |
| s = session_get_from_handle (e->session_handle); |
| if (!s) |
| { |
| clib_warning ("session has event but doesn't exist!"); |
| break; |
| } |
| if (s->rx_fifo == f || s->tx_fifo == f) |
| return 1; |
| break; |
| default: |
| break; |
| } |
| return 0; |
| } |
| |
| u8 |
| session_node_lookup_fifo_event (svm_fifo_t * f, session_event_t * e) |
| { |
| session_event_t *pending_event_vector, *evt; |
| session_worker_t *wrk; |
| int i, index, found = 0; |
| svm_msg_q_msg_t *msg; |
| svm_msg_q_ring_t *ring; |
| svm_msg_q_t *mq; |
| u8 thread_index; |
| |
| ASSERT (e); |
| thread_index = f->master_thread_index; |
| wrk = session_main_get_worker (thread_index); |
| |
| /* |
| * Search evt queue |
| */ |
| mq = wrk->vpp_event_queue; |
| index = mq->q->head; |
| for (i = 0; i < mq->q->cursize; i++) |
| { |
| msg = (svm_msg_q_msg_t *) (&mq->q->data[0] + mq->q->elsize * index); |
| ring = svm_msg_q_ring (mq, msg->ring_index); |
| clib_memcpy_fast (e, svm_msg_q_msg_data (mq, msg), ring->elsize); |
| found = session_node_cmp_event (e, f); |
| if (found) |
| return 1; |
| if (++index == mq->q->maxsize) |
| index = 0; |
| } |
| /* |
| * Search pending events vector |
| */ |
| pending_event_vector = wrk->pending_event_vector; |
| vec_foreach (evt, pending_event_vector) |
| { |
| found = session_node_cmp_event (evt, f); |
| if (found) |
| { |
| clib_memcpy_fast (e, evt, sizeof (*evt)); |
| break; |
| } |
| } |
| return found; |
| } |
| |
| static clib_error_t * |
| session_queue_exit (vlib_main_t * vm) |
| { |
| if (vec_len (vlib_mains) < 2) |
| return 0; |
| |
| /* |
| * Shut off (especially) worker-thread session nodes. |
| * Otherwise, vpp can crash as the main thread unmaps the |
| * API segment. |
| */ |
| vlib_worker_thread_barrier_sync (vm); |
| session_node_enable_disable (0 /* is_enable */ ); |
| vlib_worker_thread_barrier_release (vm); |
| return 0; |
| } |
| |
| VLIB_MAIN_LOOP_EXIT_FUNCTION (session_queue_exit); |
| |
| static uword |
| session_queue_process (vlib_main_t * vm, vlib_node_runtime_t * rt, |
| vlib_frame_t * f) |
| { |
| f64 now, timeout = 1.0; |
| uword *event_data = 0; |
| uword event_type; |
| |
| while (1) |
| { |
| vlib_process_wait_for_event_or_clock (vm, timeout); |
| now = vlib_time_now (vm); |
| event_type = vlib_process_get_events (vm, (uword **) & event_data); |
| |
| switch (event_type) |
| { |
| case SESSION_Q_PROCESS_FLUSH_FRAMES: |
| /* Flush the frames by updating all transports times */ |
| transport_update_time (now, 0); |
| break; |
| case SESSION_Q_PROCESS_STOP: |
| timeout = 100000.0; |
| break; |
| case ~0: |
| /* Timed out. Update time for all transports to trigger all |
| * outstanding retransmits. */ |
| transport_update_time (now, 0); |
| break; |
| } |
| vec_reset_length (event_data); |
| } |
| return 0; |
| } |
| |
| /* *INDENT-OFF* */ |
| VLIB_REGISTER_NODE (session_queue_process_node) = |
| { |
| .function = session_queue_process, |
| .type = VLIB_NODE_TYPE_PROCESS, |
| .name = "session-queue-process", |
| .state = VLIB_NODE_STATE_DISABLED, |
| }; |
| /* *INDENT-ON* */ |
| |
| static_always_inline uword |
| session_queue_pre_input_inline (vlib_main_t * vm, vlib_node_runtime_t * node, |
| vlib_frame_t * frame) |
| { |
| session_main_t *sm = &session_main; |
| if (!sm->wrk[0].vpp_event_queue) |
| return 0; |
| return session_queue_node_fn (vm, node, frame); |
| } |
| |
| /* *INDENT-OFF* */ |
| VLIB_REGISTER_NODE (session_queue_pre_input_node) = |
| { |
| .function = session_queue_pre_input_inline, |
| .type = VLIB_NODE_TYPE_PRE_INPUT, |
| .name = "session-queue-main", |
| .state = VLIB_NODE_STATE_DISABLED, |
| }; |
| /* *INDENT-ON* */ |
| |
| /* |
| * fd.io coding-style-patch-verification: ON |
| * |
| * Local Variables: |
| * eval: (c-set-style "gnu") |
| * End: |
| */ |