2 *------------------------------------------------------------------
3 * Copyright (c) 2017 Cisco and/or its affiliates.
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at:
8 * http://www.apache.org/licenses/LICENSE-2.0
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
15 *------------------------------------------------------------------
22 #include <sys/types.h>
24 #include <sys/ioctl.h>
25 #include <sys/socket.h>
29 #include <sys/prctl.h>
30 #include <sys/eventfd.h>
34 #include <vlib/vlib.h>
35 #include <vlib/unix/unix.h>
36 #include <vppinfra/linux/syscall.h>
37 #include <vnet/plugin/plugin.h>
38 #include <vnet/ethernet/ethernet.h>
39 #include <vpp/app/version.h>
40 #include <memif/memif.h>
41 #include <memif/private.h>
43 memif_main_t memif_main;
46 memif_eth_flag_change (vnet_main_t * vnm, vnet_hw_interface_t * hi, u32 flags)
53 memif_queue_intfd_close (memif_queue_t * mq)
55 if (mq->int_clib_file_index != ~0)
57 memif_file_del_by_index (mq->int_clib_file_index);
58 mq->int_clib_file_index = ~0;
61 else if (mq->int_fd > -1)
69 memif_disconnect (memif_if_t * mif, clib_error_t * err)
71 memif_main_t *mm = &memif_main;
72 vnet_main_t *vnm = vnet_get_main ();
80 DBG ("disconnect %u (%v)", mif->dev_instance, err ? err->what : 0);
85 mif->local_disc_string = vec_dup (err->what);
86 if (mif->conn_fd > -1)
87 e = memif_msg_send_disconnect (mif, err);
91 /* set interface down */
92 mif->flags &= ~(MEMIF_IF_FLAG_CONNECTED | MEMIF_IF_FLAG_CONNECTING);
93 if (mif->hw_if_index != ~0)
94 vnet_hw_interface_set_flags (vnm, mif->hw_if_index, 0);
96 /* close connection socket */
97 if (mif->conn_clib_file_index != ~0)
99 memif_socket_file_t *msf = vec_elt_at_index (mm->socket_files,
100 mif->socket_file_index);
101 hash_unset (msf->dev_instance_by_fd, mif->conn_fd);
102 memif_file_del_by_index (mif->conn_clib_file_index);
103 mif->conn_clib_file_index = ~0;
105 else if (mif->conn_fd > -1)
106 close (mif->conn_fd);
109 vec_foreach_index (i, mif->rx_queues)
111 mq = vec_elt_at_index (mif->rx_queues, i);
115 rv = vnet_hw_interface_unassign_rx_thread (vnm, mif->hw_if_index, i);
117 DBG ("Warning: unable to unassign interface %d, "
118 "queue %d: rc=%d", mif->hw_if_index, i, rv);
123 /* free tx and rx queues */
124 vec_foreach (mq, mif->rx_queues) memif_queue_intfd_close (mq);
125 vec_free (mif->rx_queues);
127 vec_foreach (mq, mif->tx_queues) memif_queue_intfd_close (mq);
128 vec_free (mif->tx_queues);
130 /* free memory regions */
131 vec_foreach (mr, mif->regions)
134 if ((rv = munmap (mr->shm, mr->region_size)))
135 clib_warning ("munmap failed, rv = %d", rv);
139 vec_free (mif->regions);
142 vec_free (mif->remote_name);
143 vec_free (mif->remote_if_name);
144 clib_fifo_free (mif->msg_queue);
147 static clib_error_t *
148 memif_int_fd_read_ready (clib_file_t * uf)
150 memif_main_t *mm = &memif_main;
151 vnet_main_t *vnm = vnet_get_main ();
152 u16 qid = uf->private_data & 0xFFFF;
153 memif_if_t *mif = vec_elt_at_index (mm->interfaces, uf->private_data >> 16);
154 memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, qid);
158 size = read (uf->file_descriptor, &b, sizeof (b));
161 DBG_UNIX_LOG ("Failed to read from socket");
165 vnet_device_input_set_interrupt_pending (vnm, mif->hw_if_index, qid);
173 memif_connect (memif_if_t * mif)
175 vnet_main_t *vnm = vnet_get_main ();
176 clib_file_t template = { 0 };
180 DBG ("connect %u", mif->dev_instance);
182 vec_free (mif->local_disc_string);
183 vec_free (mif->remote_disc_string);
185 vec_foreach (mr, mif->regions)
191 clib_error_return (0, "no memory region fd");
193 if ((mr->shm = mmap (NULL, mr->region_size, PROT_READ | PROT_WRITE,
194 MAP_SHARED, mr->fd, 0)) == MAP_FAILED)
195 return clib_error_return_unix (0, "mmap");
198 template.read_function = memif_int_fd_read_ready;
200 vec_foreach_index (i, mif->tx_queues)
202 memif_queue_t *mq = vec_elt_at_index (mif->tx_queues, i);
204 mq->ring = mif->regions[mq->region].shm + mq->offset;
205 if (mq->ring->cookie != MEMIF_COOKIE)
206 return clib_error_return (0, "wrong cookie on tx ring %u", i);
209 vec_foreach_index (i, mif->rx_queues)
211 memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, i);
214 mq->ring = mif->regions[mq->region].shm + mq->offset;
215 if (mq->ring->cookie != MEMIF_COOKIE)
216 return clib_error_return (0, "wrong cookie on tx ring %u", i);
220 template.file_descriptor = mq->int_fd;
221 template.private_data = (mif->dev_instance << 16) | (i & 0xFFFF);
222 memif_file_add (&mq->int_clib_file_index, &template);
224 vnet_hw_interface_assign_rx_thread (vnm, mif->hw_if_index, i, ~0);
225 rv = vnet_hw_interface_set_rx_mode (vnm, mif->hw_if_index, i,
226 VNET_HW_INTERFACE_RX_MODE_DEFAULT);
229 ("Warning: unable to set rx mode for interface %d queue %d: "
230 "rc=%d", mif->hw_if_index, i, rv);
233 vnet_hw_interface_rx_mode rxmode;
234 vnet_hw_interface_get_rx_mode (vnm, mif->hw_if_index, i, &rxmode);
236 if (rxmode == VNET_HW_INTERFACE_RX_MODE_POLLING)
237 mq->ring->flags |= MEMIF_RING_FLAG_MASK_INT;
241 mif->flags &= ~MEMIF_IF_FLAG_CONNECTING;
242 mif->flags |= MEMIF_IF_FLAG_CONNECTED;
244 vnet_hw_interface_set_flags (vnm, mif->hw_if_index,
245 VNET_HW_INTERFACE_FLAG_LINK_UP);
249 static_always_inline memif_ring_t *
250 memif_get_ring (memif_if_t * mif, memif_ring_type_t type, u16 ring_num)
252 if (vec_len (mif->regions) == 0)
254 void *p = mif->regions[0].shm;
256 sizeof (memif_ring_t) +
257 sizeof (memif_desc_t) * (1 << mif->run.log2_ring_size);
258 p += (ring_num + type * mif->run.num_s2m_rings) * ring_size;
260 return (memif_ring_t *) p;
264 memif_init_regions_and_queues (memif_if_t * mif)
266 memif_ring_t *ring = NULL;
270 clib_mem_vm_alloc_t alloc = { 0 };
273 vec_validate_aligned (mif->regions, 0, CLIB_CACHE_LINE_BYTES);
274 r = vec_elt_at_index (mif->regions, 0);
276 buffer_offset = (mif->run.num_s2m_rings + mif->run.num_m2s_rings) *
277 (sizeof (memif_ring_t) +
278 sizeof (memif_desc_t) * (1 << mif->run.log2_ring_size));
280 r->region_size = buffer_offset +
281 mif->run.buffer_size * (1 << mif->run.log2_ring_size) *
282 (mif->run.num_s2m_rings + mif->run.num_m2s_rings);
284 alloc.name = "memif region";
285 alloc.size = r->region_size;
286 alloc.flags = CLIB_MEM_VM_F_SHARED;
288 err = clib_mem_vm_ext_alloc (&alloc);
294 for (i = 0; i < mif->run.num_s2m_rings; i++)
296 ring = memif_get_ring (mif, MEMIF_RING_S2M, i);
297 ring->head = ring->tail = 0;
298 ring->cookie = MEMIF_COOKIE;
299 for (j = 0; j < (1 << mif->run.log2_ring_size); j++)
301 u16 slot = i * (1 << mif->run.log2_ring_size) + j;
302 ring->desc[j].region = 0;
303 ring->desc[j].offset =
304 buffer_offset + (u32) (slot * mif->run.buffer_size);
305 ring->desc[j].buffer_length = mif->run.buffer_size;
308 for (i = 0; i < mif->run.num_m2s_rings; i++)
310 ring = memif_get_ring (mif, MEMIF_RING_M2S, i);
311 ring->head = ring->tail = 0;
312 ring->cookie = MEMIF_COOKIE;
313 for (j = 0; j < (1 << mif->run.log2_ring_size); j++)
316 (i + mif->run.num_s2m_rings) * (1 << mif->run.log2_ring_size) + j;
317 ring->desc[j].region = 0;
318 ring->desc[j].offset =
319 buffer_offset + (u32) (slot * mif->run.buffer_size);
320 ring->desc[j].buffer_length = mif->run.buffer_size;
324 ASSERT (mif->tx_queues == 0);
325 vec_validate_aligned (mif->tx_queues, mif->run.num_s2m_rings - 1,
326 CLIB_CACHE_LINE_BYTES);
327 vec_foreach_index (i, mif->tx_queues)
329 memif_queue_t *mq = vec_elt_at_index (mif->tx_queues, i);
330 if ((mq->int_fd = eventfd (0, EFD_NONBLOCK)) < 0)
331 return clib_error_return_unix (0, "eventfd[tx queue %u]", i);
332 mq->int_clib_file_index = ~0;
333 mq->ring = memif_get_ring (mif, MEMIF_RING_S2M, i);
334 mq->log2_ring_size = mif->cfg.log2_ring_size;
336 mq->offset = (void *) mq->ring - (void *) mif->regions[mq->region].shm;
340 ASSERT (mif->rx_queues == 0);
341 vec_validate_aligned (mif->rx_queues, mif->run.num_m2s_rings - 1,
342 CLIB_CACHE_LINE_BYTES);
343 vec_foreach_index (i, mif->rx_queues)
345 memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, i);
346 if ((mq->int_fd = eventfd (0, EFD_NONBLOCK)) < 0)
347 return clib_error_return_unix (0, "eventfd[rx queue %u]", i);
348 mq->int_clib_file_index = ~0;
349 mq->ring = memif_get_ring (mif, MEMIF_RING_M2S, i);
350 mq->log2_ring_size = mif->cfg.log2_ring_size;
352 mq->offset = (void *) mq->ring - (void *) mif->regions[mq->region].shm;
360 memif_process (vlib_main_t * vm, vlib_node_runtime_t * rt, vlib_frame_t * f)
362 memif_main_t *mm = &memif_main;
364 struct sockaddr_un sun;
366 uword *event_data = 0, event_type;
368 f64 start_time, last_run_duration = 0, now;
370 sockfd = socket (AF_UNIX, SOCK_SEQPACKET, 0);
373 DBG_UNIX_LOG ("socket AF_UNIX");
376 sun.sun_family = AF_UNIX;
381 vlib_process_wait_for_event_or_clock (vm, (f64) 3 -
384 vlib_process_wait_for_event (vm);
386 event_type = vlib_process_get_events (vm, &event_data);
387 vec_reset_length (event_data);
393 case MEMIF_PROCESS_EVENT_START:
396 case MEMIF_PROCESS_EVENT_STOP:
403 last_run_duration = start_time = vlib_time_now (vm);
405 pool_foreach (mif, mm->interfaces,
407 memif_socket_file_t * msf = vec_elt_at_index (mm->socket_files, mif->socket_file_index);
408 /* Allow no more than 10us without a pause */
409 now = vlib_time_now (vm);
410 if (now > start_time + 10e-6)
412 vlib_process_suspend (vm, 100e-6); /* suspend for 100 us */
413 start_time = vlib_time_now (vm);
416 if ((mif->flags & MEMIF_IF_FLAG_ADMIN_UP) == 0)
419 if (mif->flags & MEMIF_IF_FLAG_CONNECTING)
422 if (mif->flags & MEMIF_IF_FLAG_CONNECTED)
425 if (mif->flags & MEMIF_IF_FLAG_IS_SLAVE)
427 strncpy (sun.sun_path, (char *) msf->filename,
428 sizeof (sun.sun_path) - 1);
431 (sockfd, (struct sockaddr *) &sun,
432 sizeof (struct sockaddr_un)) == 0)
434 clib_file_t t = { 0 };
436 mif->conn_fd = sockfd;
437 t.read_function = memif_slave_conn_fd_read_ready;
438 t.write_function = memif_slave_conn_fd_write_ready;
439 t.error_function = memif_slave_conn_fd_error;
440 t.file_descriptor = mif->conn_fd;
441 t.private_data = mif->dev_instance;
442 memif_file_add (&mif->conn_clib_file_index, &t);
443 hash_set (msf->dev_instance_by_fd, mif->conn_fd, mif->dev_instance);
445 mif->flags |= MEMIF_IF_FLAG_CONNECTING;
447 /* grab another fd */
448 sockfd = socket (AF_UNIX, SOCK_SEQPACKET, 0);
451 DBG_UNIX_LOG ("socket AF_UNIX");
458 last_run_duration = vlib_time_now (vm) - last_run_duration;
464 VLIB_REGISTER_NODE (memif_process_node,static) = {
465 .function = memif_process,
466 .type = VLIB_NODE_TYPE_PROCESS,
467 .name = "memif-process",
472 memif_delete_if (vlib_main_t * vm, memif_if_t * mif)
474 vnet_main_t *vnm = vnet_get_main ();
475 memif_main_t *mm = &memif_main;
476 memif_socket_file_t *msf =
477 vec_elt_at_index (mm->socket_files, mif->socket_file_index);
480 mif->flags |= MEMIF_IF_FLAG_DELETING;
481 vec_free (mif->local_disc_string);
482 vec_free (mif->remote_disc_string);
484 /* bring down the interface */
485 vnet_hw_interface_set_flags (vnm, mif->hw_if_index, 0);
486 vnet_sw_interface_set_flags (vnm, mif->sw_if_index, 0);
488 err = clib_error_return (0, "interface deleted");
489 memif_disconnect (mif, err);
490 clib_error_free (err);
492 /* remove the interface */
493 if (mif->mode == MEMIF_INTERFACE_MODE_IP)
494 vnet_delete_hw_interface (vnm, mif->hw_if_index);
496 ethernet_delete_interface (vnm, mif->hw_if_index);
497 mif->hw_if_index = ~0;
499 /* free interface data structures */
500 clib_spinlock_free (&mif->lockp);
501 mhash_unset (&msf->dev_instance_by_id, &mif->id, 0);
503 /* remove socket file */
504 if (--(msf->ref_cnt) == 0)
506 if (msf->is_listener)
509 memif_file_del_by_index (msf->clib_file_index);
510 vec_foreach (x, msf->pending_file_indices)
512 memif_file_del_by_index (*x);
514 vec_free (msf->pending_file_indices);
516 mhash_free (&msf->dev_instance_by_id);
517 hash_free (msf->dev_instance_by_fd);
518 mhash_unset (&mm->socket_file_index_by_filename, msf->filename, 0);
519 vec_free (msf->filename);
520 pool_put (mm->socket_files, msf);
523 memset (mif, 0, sizeof (*mif));
524 pool_put (mm->interfaces, mif);
526 if (pool_elts (mm->interfaces) == 0)
527 vlib_process_signal_event (vm, memif_process_node.index,
528 MEMIF_PROCESS_EVENT_STOP, 0);
534 VNET_HW_INTERFACE_CLASS (memif_ip_hw_if_class, static) =
537 .flags = VNET_HW_INTERFACE_CLASS_FLAG_P2P,
542 memif_create_if (vlib_main_t * vm, memif_create_if_args_t * args)
544 memif_main_t *mm = &memif_main;
545 vlib_thread_main_t *tm = vlib_get_thread_main ();
546 vnet_main_t *vnm = vnet_get_main ();
548 vnet_sw_interface_t *sw;
549 clib_error_t *error = 0;
552 vnet_hw_interface_t *hw;
553 memif_socket_file_t *msf = 0;
557 if (args->socket_filename == 0 || args->socket_filename[0] != '/')
560 error = vlib_unix_recursive_mkdir (vlib_unix_get_runtime_dir ());
563 clib_error_free (error);
564 return VNET_API_ERROR_SYSCALL_ERROR_1;
567 if (args->socket_filename == 0)
568 socket_filename = format (0, "%s/%s%c", vlib_unix_get_runtime_dir (),
569 MEMIF_DEFAULT_SOCKET_FILENAME, 0);
571 socket_filename = format (0, "%s/%s%c", vlib_unix_get_runtime_dir (),
572 args->socket_filename, 0);
576 socket_filename = vec_dup (args->socket_filename);
578 p = mhash_get (&mm->socket_file_index_by_filename, socket_filename);
582 msf = vec_elt_at_index (mm->socket_files, p[0]);
584 /* existing socket file can be either master or slave but cannot be both */
585 if (!msf->is_listener != !args->is_master)
587 rv = VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
591 p = mhash_get (&msf->dev_instance_by_id, &args->id);
594 rv = VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
599 /* Create new socket file */
602 struct stat file_stat;
603 /* If we are creating listener make sure file doesn't exist or if it
604 * exists thn delete it if it is old socket file */
605 if (args->is_master &&
606 (stat ((char *) socket_filename, &file_stat) == 0))
608 if (S_ISSOCK (file_stat.st_mode))
610 unlink ((char *) socket_filename);
614 error = clib_error_return (0, "File exists for %s",
616 clib_error_report (error);
617 rv = VNET_API_ERROR_VALUE_EXIST;
621 pool_get (mm->socket_files, msf);
622 memset (msf, 0, sizeof (memif_socket_file_t));
623 mhash_init (&msf->dev_instance_by_id, sizeof (uword),
624 sizeof (memif_interface_id_t));
625 msf->dev_instance_by_fd = hash_create (0, sizeof (uword));
626 msf->filename = socket_filename;
628 msf->is_listener = (args->is_master != 0);
630 mhash_set (&mm->socket_file_index_by_filename, msf->filename,
631 msf - mm->socket_files, 0);
632 DBG ("creating socket file %s", msf->filename);
635 pool_get (mm->interfaces, mif);
636 memset (mif, 0, sizeof (*mif));
637 mif->dev_instance = mif - mm->interfaces;
638 mif->socket_file_index = msf - mm->socket_files;
640 mif->sw_if_index = mif->hw_if_index = mif->per_interface_next_index = ~0;
641 mif->conn_clib_file_index = ~0;
643 mif->mode = args->mode;
645 mif->secret = vec_dup (args->secret);
647 if (tm->n_vlib_mains > 1)
648 clib_spinlock_init (&mif->lockp);
651 if (mif->mode == MEMIF_INTERFACE_MODE_ETHERNET)
654 if (!args->hw_addr_set)
656 f64 now = vlib_time_now (vm);
658 rnd = (u32) (now * 1e6);
659 rnd = random_u32 (&rnd);
661 memcpy (args->hw_addr + 2, &rnd, sizeof (rnd));
662 args->hw_addr[0] = 2;
663 args->hw_addr[1] = 0xfe;
665 error = ethernet_register_interface (vnm, memif_device_class.index,
666 mif->dev_instance, args->hw_addr,
668 memif_eth_flag_change);
670 else if (mif->mode == MEMIF_INTERFACE_MODE_IP)
673 vnet_register_interface (vnm, memif_device_class.index,
675 memif_ip_hw_if_class.index,
679 error = clib_error_return (0, "unsupported interface mode");
683 clib_error_report (error);
684 ret = VNET_API_ERROR_SYSCALL_ERROR_2;
688 sw = vnet_get_hw_sw_interface (vnm, mif->hw_if_index);
689 mif->sw_if_index = sw->sw_if_index;
691 mif->cfg.log2_ring_size = args->log2_ring_size;
692 mif->cfg.buffer_size = args->buffer_size;
693 mif->cfg.num_s2m_rings =
694 args->is_master ? args->rx_queues : args->tx_queues;
695 mif->cfg.num_m2s_rings =
696 args->is_master ? args->tx_queues : args->rx_queues;
698 args->sw_if_index = mif->sw_if_index;
700 /* If this is new one, start listening */
701 if (msf->is_listener && msf->ref_cnt == 0)
703 struct sockaddr_un un = { 0 };
704 struct stat file_stat;
707 if ((msf->fd = socket (AF_UNIX, SOCK_SEQPACKET, 0)) < 0)
709 ret = VNET_API_ERROR_SYSCALL_ERROR_4;
713 un.sun_family = AF_UNIX;
714 strncpy ((char *) un.sun_path, (char *) msf->filename,
715 sizeof (un.sun_path) - 1);
717 if (setsockopt (msf->fd, SOL_SOCKET, SO_PASSCRED, &on, sizeof (on)) < 0)
719 ret = VNET_API_ERROR_SYSCALL_ERROR_5;
722 if (bind (msf->fd, (struct sockaddr *) &un, sizeof (un)) == -1)
724 ret = VNET_API_ERROR_SYSCALL_ERROR_6;
727 if (listen (msf->fd, 1) == -1)
729 ret = VNET_API_ERROR_SYSCALL_ERROR_7;
733 if (stat ((char *) msf->filename, &file_stat) == -1)
735 ret = VNET_API_ERROR_SYSCALL_ERROR_8;
739 msf->clib_file_index = ~0;
740 clib_file_t template = { 0 };
741 template.read_function = memif_conn_fd_accept_ready;
742 template.file_descriptor = msf->fd;
743 template.private_data = mif->socket_file_index;
744 memif_file_add (&msf->clib_file_index, &template);
749 if (args->is_master == 0)
750 mif->flags |= MEMIF_IF_FLAG_IS_SLAVE;
752 hw = vnet_get_hw_interface (vnm, mif->hw_if_index);
753 hw->flags |= VNET_HW_INTERFACE_FLAG_SUPPORTS_INT_MODE;
754 vnet_hw_interface_set_input_node (vnm, mif->hw_if_index,
755 memif_input_node.index);
757 mhash_set (&msf->dev_instance_by_id, &mif->id, mif->dev_instance, 0);
759 if (pool_elts (mm->interfaces) == 1)
761 vlib_process_signal_event (vm, memif_process_node.index,
762 MEMIF_PROCESS_EVENT_START, 0);
767 if (mif->hw_if_index != ~0)
769 if (mif->mode == MEMIF_INTERFACE_MODE_IP)
770 vnet_delete_hw_interface (vnm, mif->hw_if_index);
772 ethernet_delete_interface (vnm, mif->hw_if_index);
773 mif->hw_if_index = ~0;
775 memif_delete_if (vm, mif);
779 vec_free (socket_filename);
784 static clib_error_t *
785 memif_init (vlib_main_t * vm)
787 memif_main_t *mm = &memif_main;
788 vlib_thread_main_t *tm = vlib_get_thread_main ();
790 memset (mm, 0, sizeof (memif_main_t));
792 /* initialize binary API */
793 memif_plugin_api_hookup (vm);
795 mhash_init_c_string (&mm->socket_file_index_by_filename, sizeof (uword));
797 vec_validate_aligned (mm->rx_buffers, tm->n_vlib_mains - 1,
798 CLIB_CACHE_LINE_BYTES);
803 VLIB_INIT_FUNCTION (memif_init);
806 VLIB_PLUGIN_REGISTER () = {
807 .version = VPP_BUILD_VER,
808 .description = "Packet Memory Interface (experimetal)",
813 * fd.io coding-style-patch-verification: ON
816 * eval: (c-set-style "gnu")