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);
295 for (i = 0; i < mif->run.num_s2m_rings; i++)
297 ring = memif_get_ring (mif, MEMIF_RING_S2M, i);
298 ring->head = ring->tail = 0;
299 ring->cookie = MEMIF_COOKIE;
300 for (j = 0; j < (1 << mif->run.log2_ring_size); j++)
302 u16 slot = i * (1 << mif->run.log2_ring_size) + j;
303 ring->desc[j].region = 0;
304 ring->desc[j].offset =
305 buffer_offset + (u32) (slot * mif->run.buffer_size);
306 ring->desc[j].buffer_length = mif->run.buffer_size;
309 for (i = 0; i < mif->run.num_m2s_rings; i++)
311 ring = memif_get_ring (mif, MEMIF_RING_M2S, i);
312 ring->head = ring->tail = 0;
313 ring->cookie = MEMIF_COOKIE;
314 for (j = 0; j < (1 << mif->run.log2_ring_size); j++)
317 (i + mif->run.num_s2m_rings) * (1 << mif->run.log2_ring_size) + j;
318 ring->desc[j].region = 0;
319 ring->desc[j].offset =
320 buffer_offset + (u32) (slot * mif->run.buffer_size);
321 ring->desc[j].buffer_length = mif->run.buffer_size;
325 ASSERT (mif->tx_queues == 0);
326 vec_validate_aligned (mif->tx_queues, mif->run.num_s2m_rings - 1,
327 CLIB_CACHE_LINE_BYTES);
328 vec_foreach_index (i, mif->tx_queues)
330 memif_queue_t *mq = vec_elt_at_index (mif->tx_queues, i);
331 if ((mq->int_fd = eventfd (0, EFD_NONBLOCK)) < 0)
332 return clib_error_return_unix (0, "eventfd[tx queue %u]", i);
333 mq->int_clib_file_index = ~0;
334 mq->ring = memif_get_ring (mif, MEMIF_RING_S2M, i);
335 mq->log2_ring_size = mif->cfg.log2_ring_size;
337 mq->offset = (void *) mq->ring - (void *) mif->regions[mq->region].shm;
341 ASSERT (mif->rx_queues == 0);
342 vec_validate_aligned (mif->rx_queues, mif->run.num_m2s_rings - 1,
343 CLIB_CACHE_LINE_BYTES);
344 vec_foreach_index (i, mif->rx_queues)
346 memif_queue_t *mq = vec_elt_at_index (mif->rx_queues, i);
347 if ((mq->int_fd = eventfd (0, EFD_NONBLOCK)) < 0)
348 return clib_error_return_unix (0, "eventfd[rx queue %u]", i);
349 mq->int_clib_file_index = ~0;
350 mq->ring = memif_get_ring (mif, MEMIF_RING_M2S, i);
351 mq->log2_ring_size = mif->cfg.log2_ring_size;
353 mq->offset = (void *) mq->ring - (void *) mif->regions[mq->region].shm;
361 memif_process (vlib_main_t * vm, vlib_node_runtime_t * rt, vlib_frame_t * f)
363 memif_main_t *mm = &memif_main;
365 struct sockaddr_un sun;
367 uword *event_data = 0, event_type;
369 f64 start_time, last_run_duration = 0, now;
371 sockfd = socket (AF_UNIX, SOCK_SEQPACKET, 0);
374 DBG_UNIX_LOG ("socket AF_UNIX");
377 sun.sun_family = AF_UNIX;
382 vlib_process_wait_for_event_or_clock (vm, (f64) 3 -
385 vlib_process_wait_for_event (vm);
387 event_type = vlib_process_get_events (vm, &event_data);
388 vec_reset_length (event_data);
394 case MEMIF_PROCESS_EVENT_START:
397 case MEMIF_PROCESS_EVENT_STOP:
404 last_run_duration = start_time = vlib_time_now (vm);
406 pool_foreach (mif, mm->interfaces,
408 memif_socket_file_t * msf = vec_elt_at_index (mm->socket_files, mif->socket_file_index);
409 /* Allow no more than 10us without a pause */
410 now = vlib_time_now (vm);
411 if (now > start_time + 10e-6)
413 vlib_process_suspend (vm, 100e-6); /* suspend for 100 us */
414 start_time = vlib_time_now (vm);
417 if ((mif->flags & MEMIF_IF_FLAG_ADMIN_UP) == 0)
420 if (mif->flags & MEMIF_IF_FLAG_CONNECTING)
423 if (mif->flags & MEMIF_IF_FLAG_CONNECTED)
426 if (mif->flags & MEMIF_IF_FLAG_IS_SLAVE)
428 strncpy (sun.sun_path, (char *) msf->filename,
429 sizeof (sun.sun_path) - 1);
432 (sockfd, (struct sockaddr *) &sun,
433 sizeof (struct sockaddr_un)) == 0)
435 clib_file_t t = { 0 };
437 mif->conn_fd = sockfd;
438 t.read_function = memif_slave_conn_fd_read_ready;
439 t.write_function = memif_slave_conn_fd_write_ready;
440 t.error_function = memif_slave_conn_fd_error;
441 t.file_descriptor = mif->conn_fd;
442 t.private_data = mif->dev_instance;
443 memif_file_add (&mif->conn_clib_file_index, &t);
444 hash_set (msf->dev_instance_by_fd, mif->conn_fd, mif->dev_instance);
446 mif->flags |= MEMIF_IF_FLAG_CONNECTING;
448 /* grab another fd */
449 sockfd = socket (AF_UNIX, SOCK_SEQPACKET, 0);
452 DBG_UNIX_LOG ("socket AF_UNIX");
459 last_run_duration = vlib_time_now (vm) - last_run_duration;
465 VLIB_REGISTER_NODE (memif_process_node,static) = {
466 .function = memif_process,
467 .type = VLIB_NODE_TYPE_PROCESS,
468 .name = "memif-process",
473 memif_delete_if (vlib_main_t * vm, memif_if_t * mif)
475 vnet_main_t *vnm = vnet_get_main ();
476 memif_main_t *mm = &memif_main;
477 memif_socket_file_t *msf =
478 vec_elt_at_index (mm->socket_files, mif->socket_file_index);
481 mif->flags |= MEMIF_IF_FLAG_DELETING;
482 vec_free (mif->local_disc_string);
483 vec_free (mif->remote_disc_string);
485 /* bring down the interface */
486 vnet_hw_interface_set_flags (vnm, mif->hw_if_index, 0);
487 vnet_sw_interface_set_flags (vnm, mif->sw_if_index, 0);
489 err = clib_error_return (0, "interface deleted");
490 memif_disconnect (mif, err);
491 clib_error_free (err);
493 /* remove the interface */
494 if (mif->mode == MEMIF_INTERFACE_MODE_IP)
495 vnet_delete_hw_interface (vnm, mif->hw_if_index);
497 ethernet_delete_interface (vnm, mif->hw_if_index);
498 mif->hw_if_index = ~0;
500 /* free interface data structures */
501 clib_spinlock_free (&mif->lockp);
502 mhash_unset (&msf->dev_instance_by_id, &mif->id, 0);
504 /* remove socket file */
505 if (--(msf->ref_cnt) == 0)
507 if (msf->is_listener)
510 memif_file_del_by_index (msf->clib_file_index);
511 vec_foreach (x, msf->pending_file_indices)
513 memif_file_del_by_index (*x);
515 vec_free (msf->pending_file_indices);
517 mhash_free (&msf->dev_instance_by_id);
518 hash_free (msf->dev_instance_by_fd);
519 mhash_unset (&mm->socket_file_index_by_filename, msf->filename, 0);
520 vec_free (msf->filename);
521 pool_put (mm->socket_files, msf);
524 memset (mif, 0, sizeof (*mif));
525 pool_put (mm->interfaces, mif);
527 if (pool_elts (mm->interfaces) == 0)
528 vlib_process_signal_event (vm, memif_process_node.index,
529 MEMIF_PROCESS_EVENT_STOP, 0);
535 VNET_HW_INTERFACE_CLASS (memif_ip_hw_if_class, static) =
538 .flags = VNET_HW_INTERFACE_CLASS_FLAG_P2P,
543 memif_create_if (vlib_main_t * vm, memif_create_if_args_t * args)
545 memif_main_t *mm = &memif_main;
546 vlib_thread_main_t *tm = vlib_get_thread_main ();
547 vnet_main_t *vnm = vnet_get_main ();
549 vnet_sw_interface_t *sw;
550 clib_error_t *error = 0;
553 vnet_hw_interface_t *hw;
554 memif_socket_file_t *msf = 0;
558 if (args->socket_filename == 0 || args->socket_filename[0] != '/')
561 error = vlib_unix_recursive_mkdir (vlib_unix_get_runtime_dir ());
564 clib_error_free (error);
565 return VNET_API_ERROR_SYSCALL_ERROR_1;
568 if (args->socket_filename == 0)
569 socket_filename = format (0, "%s/%s%c", vlib_unix_get_runtime_dir (),
570 MEMIF_DEFAULT_SOCKET_FILENAME, 0);
572 socket_filename = format (0, "%s/%s%c", vlib_unix_get_runtime_dir (),
573 args->socket_filename, 0);
577 socket_filename = vec_dup (args->socket_filename);
579 p = mhash_get (&mm->socket_file_index_by_filename, socket_filename);
583 msf = vec_elt_at_index (mm->socket_files, p[0]);
585 /* existing socket file can be either master or slave but cannot be both */
586 if (!msf->is_listener != !args->is_master)
588 rv = VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
592 p = mhash_get (&msf->dev_instance_by_id, &args->id);
595 rv = VNET_API_ERROR_SUBIF_ALREADY_EXISTS;
600 /* Create new socket file */
603 struct stat file_stat;
604 /* If we are creating listener make sure file doesn't exist or if it
605 * exists thn delete it if it is old socket file */
606 if (args->is_master &&
607 (stat ((char *) socket_filename, &file_stat) == 0))
609 if (S_ISSOCK (file_stat.st_mode))
611 unlink ((char *) socket_filename);
615 error = clib_error_return (0, "File exists for %s",
617 clib_error_report (error);
618 rv = VNET_API_ERROR_VALUE_EXIST;
622 pool_get (mm->socket_files, msf);
623 memset (msf, 0, sizeof (memif_socket_file_t));
624 mhash_init (&msf->dev_instance_by_id, sizeof (uword),
625 sizeof (memif_interface_id_t));
626 msf->dev_instance_by_fd = hash_create (0, sizeof (uword));
627 msf->filename = socket_filename;
629 msf->is_listener = (args->is_master != 0);
631 mhash_set (&mm->socket_file_index_by_filename, msf->filename,
632 msf - mm->socket_files, 0);
633 DBG ("creating socket file %s", msf->filename);
636 pool_get (mm->interfaces, mif);
637 memset (mif, 0, sizeof (*mif));
638 mif->dev_instance = mif - mm->interfaces;
639 mif->socket_file_index = msf - mm->socket_files;
641 mif->sw_if_index = mif->hw_if_index = mif->per_interface_next_index = ~0;
642 mif->conn_clib_file_index = ~0;
644 mif->mode = args->mode;
646 mif->secret = vec_dup (args->secret);
648 if (tm->n_vlib_mains > 1)
649 clib_spinlock_init (&mif->lockp);
652 if (mif->mode == MEMIF_INTERFACE_MODE_ETHERNET)
655 if (!args->hw_addr_set)
657 f64 now = vlib_time_now (vm);
659 rnd = (u32) (now * 1e6);
660 rnd = random_u32 (&rnd);
662 memcpy (args->hw_addr + 2, &rnd, sizeof (rnd));
663 args->hw_addr[0] = 2;
664 args->hw_addr[1] = 0xfe;
666 error = ethernet_register_interface (vnm, memif_device_class.index,
667 mif->dev_instance, args->hw_addr,
669 memif_eth_flag_change);
671 else if (mif->mode == MEMIF_INTERFACE_MODE_IP)
674 vnet_register_interface (vnm, memif_device_class.index,
676 memif_ip_hw_if_class.index,
680 error = clib_error_return (0, "unsupported interface mode");
684 clib_error_report (error);
685 ret = VNET_API_ERROR_SYSCALL_ERROR_2;
689 sw = vnet_get_hw_sw_interface (vnm, mif->hw_if_index);
690 mif->sw_if_index = sw->sw_if_index;
692 mif->cfg.log2_ring_size = args->log2_ring_size;
693 mif->cfg.buffer_size = args->buffer_size;
694 mif->cfg.num_s2m_rings =
695 args->is_master ? args->rx_queues : args->tx_queues;
696 mif->cfg.num_m2s_rings =
697 args->is_master ? args->tx_queues : args->rx_queues;
699 args->sw_if_index = mif->sw_if_index;
701 /* If this is new one, start listening */
702 if (msf->is_listener && msf->ref_cnt == 0)
704 struct sockaddr_un un = { 0 };
705 struct stat file_stat;
708 if ((msf->fd = socket (AF_UNIX, SOCK_SEQPACKET, 0)) < 0)
710 ret = VNET_API_ERROR_SYSCALL_ERROR_4;
714 un.sun_family = AF_UNIX;
715 strncpy ((char *) un.sun_path, (char *) msf->filename,
716 sizeof (un.sun_path) - 1);
718 if (setsockopt (msf->fd, SOL_SOCKET, SO_PASSCRED, &on, sizeof (on)) < 0)
720 ret = VNET_API_ERROR_SYSCALL_ERROR_5;
723 if (bind (msf->fd, (struct sockaddr *) &un, sizeof (un)) == -1)
725 ret = VNET_API_ERROR_SYSCALL_ERROR_6;
728 if (listen (msf->fd, 1) == -1)
730 ret = VNET_API_ERROR_SYSCALL_ERROR_7;
734 if (stat ((char *) msf->filename, &file_stat) == -1)
736 ret = VNET_API_ERROR_SYSCALL_ERROR_8;
740 msf->clib_file_index = ~0;
741 clib_file_t template = { 0 };
742 template.read_function = memif_conn_fd_accept_ready;
743 template.file_descriptor = msf->fd;
744 template.private_data = mif->socket_file_index;
745 memif_file_add (&msf->clib_file_index, &template);
750 if (args->is_master == 0)
751 mif->flags |= MEMIF_IF_FLAG_IS_SLAVE;
753 hw = vnet_get_hw_interface (vnm, mif->hw_if_index);
754 hw->flags |= VNET_HW_INTERFACE_FLAG_SUPPORTS_INT_MODE;
755 vnet_hw_interface_set_input_node (vnm, mif->hw_if_index,
756 memif_input_node.index);
758 mhash_set (&msf->dev_instance_by_id, &mif->id, mif->dev_instance, 0);
760 if (pool_elts (mm->interfaces) == 1)
762 vlib_process_signal_event (vm, memif_process_node.index,
763 MEMIF_PROCESS_EVENT_START, 0);
768 if (mif->hw_if_index != ~0)
770 if (mif->mode == MEMIF_INTERFACE_MODE_IP)
771 vnet_delete_hw_interface (vnm, mif->hw_if_index);
773 ethernet_delete_interface (vnm, mif->hw_if_index);
774 mif->hw_if_index = ~0;
776 memif_delete_if (vm, mif);
780 vec_free (socket_filename);
785 static clib_error_t *
786 memif_init (vlib_main_t * vm)
788 memif_main_t *mm = &memif_main;
789 vlib_thread_main_t *tm = vlib_get_thread_main ();
791 memset (mm, 0, sizeof (memif_main_t));
793 /* initialize binary API */
794 memif_plugin_api_hookup (vm);
796 mhash_init_c_string (&mm->socket_file_index_by_filename, sizeof (uword));
798 vec_validate_aligned (mm->rx_buffers, tm->n_vlib_mains - 1,
799 CLIB_CACHE_LINE_BYTES);
804 VLIB_INIT_FUNCTION (memif_init);
807 VLIB_PLUGIN_REGISTER () = {
808 .version = VPP_BUILD_VER,
809 .description = "Packet Memory Interface (experimetal)",
814 * fd.io coding-style-patch-verification: ON
817 * eval: (c-set-style "gnu")