2 * Copyright (c) 2018-2019 Cisco and/or its affiliates.
3 * Licensed under the Apache License, Version 2.0 (the "License");
5 * You may obtain a copy of the License at:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
16 #include <vcl/vcl_private.h>
18 static pthread_key_t vcl_worker_stop_key;
21 vcl_mq_evt_conn_alloc (vcl_worker_t * wrk)
23 vcl_mq_evt_conn_t *mqc;
24 pool_get (wrk->mq_evt_conns, mqc);
25 memset (mqc, 0, sizeof (*mqc));
30 vcl_mq_evt_conn_index (vcl_worker_t * wrk, vcl_mq_evt_conn_t * mqc)
32 return (mqc - wrk->mq_evt_conns);
36 vcl_mq_evt_conn_get (vcl_worker_t * wrk, u32 mq_conn_idx)
38 return pool_elt_at_index (wrk->mq_evt_conns, mq_conn_idx);
42 vcl_mq_epoll_add_evfd (vcl_worker_t * wrk, svm_msg_q_t * mq)
44 struct epoll_event e = { 0 };
45 vcl_mq_evt_conn_t *mqc;
49 mq_fd = svm_msg_q_get_eventfd (mq);
51 if (wrk->mqs_epfd < 0 || mq_fd == -1)
54 mqc = vcl_mq_evt_conn_alloc (wrk);
55 mqc_index = vcl_mq_evt_conn_index (wrk, mqc);
60 e.data.u32 = mqc_index;
61 if (epoll_ctl (wrk->mqs_epfd, EPOLL_CTL_ADD, mq_fd, &e) < 0)
63 VDBG (0, "failed to add mq eventfd to mq epoll fd");
71 vcl_mq_epoll_del_evfd (vcl_worker_t * wrk, u32 mqc_index)
73 vcl_mq_evt_conn_t *mqc;
75 if (wrk->mqs_epfd || mqc_index == ~0)
78 mqc = vcl_mq_evt_conn_get (wrk, mqc_index);
79 if (epoll_ctl (wrk->mqs_epfd, EPOLL_CTL_DEL, mqc->mq_fd, 0) < 0)
81 VDBG (0, "failed to del mq eventfd to mq epoll fd");
88 vcl_worker_alloc (void)
91 pool_get (vcm->workers, wrk);
92 memset (wrk, 0, sizeof (*wrk));
93 wrk->wrk_index = wrk - vcm->workers;
94 wrk->forked_child = ~0;
99 vcl_worker_free (vcl_worker_t * wrk)
101 pool_put (vcm->workers, wrk);
105 vcl_api_app_worker_add (void)
107 if (vcm->cfg.vpp_app_socket_api)
108 return vcl_sapi_app_worker_add ();
110 return vcl_bapi_app_worker_add ();
114 vcl_api_app_worker_del (vcl_worker_t * wrk)
116 if (vcm->cfg.vpp_app_socket_api)
117 return vcl_sapi_app_worker_del (wrk);
119 vcl_bapi_app_worker_del (wrk);
123 vcl_worker_cleanup (vcl_worker_t * wrk, u8 notify_vpp)
125 clib_spinlock_lock (&vcm->workers_lock);
127 vcl_api_app_worker_del (wrk);
129 if (wrk->mqs_epfd > 0)
130 close (wrk->mqs_epfd);
131 pool_free (wrk->sessions);
132 pool_free (wrk->mq_evt_conns);
133 hash_free (wrk->session_index_by_vpp_handles);
134 vec_free (wrk->mq_events);
135 vec_free (wrk->mq_msg_vector);
136 vec_free (wrk->unhandled_evts_vector);
137 vec_free (wrk->pending_session_wrk_updates);
138 clib_bitmap_free (wrk->rd_bitmap);
139 clib_bitmap_free (wrk->wr_bitmap);
140 clib_bitmap_free (wrk->ex_bitmap);
141 vcl_worker_free (wrk);
142 clib_spinlock_unlock (&vcm->workers_lock);
146 vcl_worker_cleanup_cb (void *arg)
151 wrk_index = vcl_get_worker_index ();
152 wrk = vcl_worker_get_if_valid (wrk_index);
156 vcl_worker_cleanup (wrk, 1 /* notify vpp */ );
157 vcl_set_worker_index (~0);
158 VDBG (0, "cleaned up worker %u", wrk_index);
162 vcl_worker_alloc_and_init ()
166 /* This was initialized already */
167 if (vcl_get_worker_index () != ~0)
170 /* Grab lock before selecting mem thread index */
171 clib_spinlock_lock (&vcm->workers_lock);
173 /* Use separate heap map entry for worker */
174 clib_mem_set_thread_index ();
176 if (pool_elts (vcm->workers) == vcm->cfg.max_workers)
178 VDBG (0, "max-workers %u limit reached", vcm->cfg.max_workers);
183 wrk = vcl_worker_alloc ();
184 vcl_set_worker_index (wrk->wrk_index);
185 wrk->thread_id = pthread_self ();
186 wrk->current_pid = getpid ();
189 if (vcm->cfg.use_mq_eventfd)
191 wrk->vcl_needs_real_epoll = 1;
192 wrk->mqs_epfd = epoll_create (1);
193 wrk->vcl_needs_real_epoll = 0;
194 if (wrk->mqs_epfd < 0)
196 clib_unix_warning ("epoll_create() returned");
201 wrk->ep_lt_current = VCL_INVALID_SESSION_INDEX;
202 wrk->session_index_by_vpp_handles = hash_create (0, sizeof (uword));
203 clib_time_init (&wrk->clib_time);
204 vec_validate (wrk->mq_events, 64);
205 vec_validate (wrk->mq_msg_vector, 128);
206 vec_reset_length (wrk->mq_msg_vector);
207 vec_validate (wrk->unhandled_evts_vector, 128);
208 vec_reset_length (wrk->unhandled_evts_vector);
211 clib_spinlock_unlock (&vcm->workers_lock);
216 vcl_worker_register_with_vpp (void)
218 vcl_worker_t *wrk = vcl_worker_get_current ();
220 clib_spinlock_lock (&vcm->workers_lock);
222 if (vcl_api_app_worker_add ())
224 VDBG (0, "failed to add worker to vpp");
225 clib_spinlock_unlock (&vcm->workers_lock);
228 if (pthread_key_create (&vcl_worker_stop_key, vcl_worker_cleanup_cb))
229 VDBG (0, "failed to add pthread cleanup function");
230 if (pthread_setspecific (vcl_worker_stop_key, &wrk->thread_id))
231 VDBG (0, "failed to setup key value");
233 clib_spinlock_unlock (&vcm->workers_lock);
235 VDBG (0, "added worker %u", wrk->wrk_index);
240 vcl_worker_ctrl_mq (vcl_worker_t * wrk)
246 vcl_session_read_ready (vcl_session_t * s)
248 if (PREDICT_FALSE (s->flags & VCL_SESSION_F_IS_VEP))
250 VDBG (0, "ERROR: session %u: cannot read from an epoll session!",
252 return VPPCOM_EBADFD;
255 if (vcl_session_is_open (s))
257 if (vcl_session_is_ct (s))
258 return svm_fifo_max_dequeue_cons (s->ct_rx_fifo);
262 session_dgram_pre_hdr_t ph;
265 max_deq = svm_fifo_max_dequeue_cons (s->rx_fifo);
266 if (max_deq <= SESSION_CONN_HDR_LEN)
268 if (svm_fifo_peek (s->rx_fifo, 0, sizeof (ph), (u8 *) & ph) < 0)
270 if (ph.data_length + SESSION_CONN_HDR_LEN > max_deq)
273 return ph.data_length;
276 return svm_fifo_max_dequeue_cons (s->rx_fifo);
278 else if (s->session_state == VCL_STATE_LISTEN)
280 return clib_fifo_elts (s->accept_evts_fifo);
284 return (s->session_state == VCL_STATE_DISCONNECT) ?
285 VPPCOM_ECONNRESET : VPPCOM_ENOTCONN;
290 vcl_session_write_ready (vcl_session_t * s)
292 if (PREDICT_FALSE (s->flags & VCL_SESSION_F_IS_VEP))
294 VDBG (0, "session %u [0x%llx]: cannot write to an epoll session!",
295 s->session_index, s->vpp_handle);
296 return VPPCOM_EBADFD;
299 if (vcl_session_is_open (s))
301 if (vcl_session_is_ct (s))
302 return svm_fifo_max_enqueue_prod (s->ct_tx_fifo);
306 u32 max_enq = svm_fifo_max_enqueue_prod (s->tx_fifo);
308 if (max_enq <= sizeof (session_dgram_hdr_t))
310 return max_enq - sizeof (session_dgram_hdr_t);
313 return svm_fifo_max_enqueue_prod (s->tx_fifo);
315 else if (s->session_state == VCL_STATE_LISTEN)
318 return svm_fifo_max_enqueue_prod (s->tx_fifo);
320 return VPPCOM_EBADFD;
322 else if (s->session_state == VCL_STATE_UPDATED)
328 return (s->session_state == VCL_STATE_DISCONNECT) ?
329 VPPCOM_ECONNRESET : VPPCOM_ENOTCONN;
334 vcl_session_alloc_ext_cfg (vcl_session_t *s,
335 transport_endpt_ext_cfg_type_t type, u32 len)
340 s->ext_config = clib_mem_alloc (len);
341 clib_memset (s->ext_config, 0, len);
342 s->ext_config->len = len;
343 s->ext_config->type = type;
349 vcl_segment_attach (u64 segment_handle, char *name, ssvm_segment_type_t type,
352 fifo_segment_create_args_t _a, *a = &_a;
355 memset (a, 0, sizeof (*a));
356 a->segment_name = name;
357 a->segment_type = type;
359 if (type == SSVM_SEGMENT_MEMFD)
362 clib_rwlock_writer_lock (&vcm->segment_table_lock);
364 if ((rv = fifo_segment_attach (&vcm->segment_main, a)))
366 clib_warning ("svm_fifo_segment_attach ('%s') failed", name);
369 hash_set (vcm->segment_table, segment_handle, a->new_segment_indices[0]);
371 clib_rwlock_writer_unlock (&vcm->segment_table_lock);
373 vec_free (a->new_segment_indices);
378 vcl_segment_table_lookup (u64 segment_handle)
382 clib_rwlock_reader_lock (&vcm->segment_table_lock);
383 seg_indexp = hash_get (vcm->segment_table, segment_handle);
384 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
387 return VCL_INVALID_SEGMENT_INDEX;
388 return ((u32) * seg_indexp);
392 vcl_segment_detach (u64 segment_handle)
394 fifo_segment_main_t *sm = &vcm->segment_main;
395 fifo_segment_t *segment;
398 segment_index = vcl_segment_table_lookup (segment_handle);
399 if (segment_index == (u32) ~ 0)
402 clib_rwlock_writer_lock (&vcm->segment_table_lock);
404 segment = fifo_segment_get_segment (sm, segment_index);
405 fifo_segment_delete (sm, segment);
406 hash_unset (vcm->segment_table, segment_handle);
408 clib_rwlock_writer_unlock (&vcm->segment_table_lock);
410 VDBG (0, "detached segment %u handle %u", segment_index, segment_handle);
414 vcl_segment_attach_session (uword segment_handle, uword rxf_offset,
415 uword txf_offset, uword mq_offset, u32 mq_index,
416 u8 is_ct, vcl_session_t *s)
418 u32 fs_index, eqs_index;
419 svm_fifo_t *rxf, *txf;
423 fs_index = vcl_segment_table_lookup (segment_handle);
424 if (fs_index == VCL_INVALID_SEGMENT_INDEX)
426 VDBG (0, "ERROR: segment for session %u is not mounted!",
431 if (!is_ct && mq_offset != (uword) ~0)
433 eqs_handle = vcl_vpp_worker_segment_handle (0);
434 eqs_index = vcl_segment_table_lookup (eqs_handle);
435 ASSERT (eqs_index != VCL_INVALID_SEGMENT_INDEX);
438 clib_rwlock_reader_lock (&vcm->segment_table_lock);
440 fs = fifo_segment_get_segment (&vcm->segment_main, fs_index);
441 rxf = fifo_segment_alloc_fifo_w_offset (fs, rxf_offset);
442 txf = fifo_segment_alloc_fifo_w_offset (fs, txf_offset);
443 rxf->segment_index = fs_index;
444 txf->segment_index = fs_index;
446 if (!is_ct && mq_offset != (uword) ~0)
448 fs = fifo_segment_get_segment (&vcm->segment_main, eqs_index);
449 s->vpp_evt_q = fifo_segment_msg_q_attach (fs, mq_offset, mq_index);
452 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
456 rxf->shr->client_session_index = s->session_index;
457 txf->shr->client_session_index = s->session_index;
458 rxf->client_thread_index = vcl_get_worker_index ();
459 txf->client_thread_index = vcl_get_worker_index ();
473 vcl_session_detach_fifos (vcl_session_t *s)
480 clib_rwlock_reader_lock (&vcm->segment_table_lock);
482 fs = fifo_segment_get_segment_if_valid (&vcm->segment_main,
483 s->rx_fifo->segment_index);
487 fifo_segment_free_client_fifo (fs, s->rx_fifo);
488 fifo_segment_free_client_fifo (fs, s->tx_fifo);
491 fs = fifo_segment_get_segment_if_valid (&vcm->segment_main,
492 s->ct_rx_fifo->segment_index);
496 fifo_segment_free_client_fifo (fs, s->ct_rx_fifo);
497 fifo_segment_free_client_fifo (fs, s->ct_tx_fifo);
501 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
505 vcl_segment_attach_mq (uword segment_handle, uword mq_offset, u32 mq_index,
511 fs_index = vcl_segment_table_lookup (segment_handle);
512 if (fs_index == VCL_INVALID_SEGMENT_INDEX)
514 VDBG (0, "ERROR: mq segment %lx for is not attached!", segment_handle);
518 clib_rwlock_reader_lock (&vcm->segment_table_lock);
520 fs = fifo_segment_get_segment (&vcm->segment_main, fs_index);
521 *mq = fifo_segment_msg_q_attach (fs, mq_offset, mq_index);
523 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
529 vcl_segment_discover_mqs (uword segment_handle, int *fds, u32 n_fds)
534 fs_index = vcl_segment_table_lookup (segment_handle);
535 if (fs_index == VCL_INVALID_SEGMENT_INDEX)
537 VDBG (0, "ERROR: mq segment %lx for is not attached!", segment_handle);
541 clib_rwlock_reader_lock (&vcm->segment_table_lock);
543 fs = fifo_segment_get_segment (&vcm->segment_main, fs_index);
544 fifo_segment_msg_qs_discover (fs, fds, n_fds);
546 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
552 vcl_segment_alloc_chunk (uword segment_handle, u32 slice_index, u32 size,
559 fs_index = vcl_segment_table_lookup (segment_handle);
560 if (fs_index == VCL_INVALID_SEGMENT_INDEX)
562 VDBG (0, "ERROR: mq segment %lx for is not attached!", segment_handle);
566 clib_rwlock_reader_lock (&vcm->segment_table_lock);
568 fs = fifo_segment_get_segment (&vcm->segment_main, fs_index);
569 c = fifo_segment_alloc_chunk_w_slice (fs, slice_index, size);
570 *offset = fifo_segment_chunk_offset (fs, c);
572 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
578 vcl_session_share_fifos (vcl_session_t *s, svm_fifo_t *rxf, svm_fifo_t *txf)
580 vcl_worker_t *wrk = vcl_worker_get_current ();
583 clib_rwlock_reader_lock (&vcm->segment_table_lock);
585 fs = fifo_segment_get_segment (&vcm->segment_main, rxf->segment_index);
586 s->rx_fifo = fifo_segment_duplicate_fifo (fs, rxf);
587 s->tx_fifo = fifo_segment_duplicate_fifo (fs, txf);
589 clib_rwlock_reader_unlock (&vcm->segment_table_lock);
591 svm_fifo_add_subscriber (s->rx_fifo, wrk->vpp_wrk_index);
592 svm_fifo_add_subscriber (s->tx_fifo, wrk->vpp_wrk_index);
598 * fd.io coding-style-patch-verification: ON
601 * eval: (c-set-style "gnu")