2 * Copyright (c) 2015 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:
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 <sys/socket.h>
21 #include <vlib/vlib.h>
22 #include <vlib/unix/unix.h>
24 #include <vnet/vnet.h>
25 #include <vppinfra/vec.h>
26 #include <vppinfra/error.h>
27 #include <vppinfra/format.h>
29 #include <vnet/ethernet/ethernet.h>
30 #include <vnet/devices/dpdk/dpdk.h>
32 #include <vnet/devices/virtio/vhost-user.h>
34 #define VHOST_USER_DEBUG_SOCKET 0
36 #if VHOST_USER_DEBUG_SOCKET == 1
37 #define DBG_SOCK(args...) clib_warning(args);
39 #define DBG_SOCK(args...)
42 static const char *vhost_message_str[] __attribute__((unused)) = {
43 [VHOST_USER_NONE] = "VHOST_USER_NONE",
44 [VHOST_USER_GET_FEATURES] = "VHOST_USER_GET_FEATURES",
45 [VHOST_USER_SET_FEATURES] = "VHOST_USER_SET_FEATURES",
46 [VHOST_USER_SET_OWNER] = "VHOST_USER_SET_OWNER",
47 [VHOST_USER_RESET_OWNER] = "VHOST_USER_RESET_OWNER",
48 [VHOST_USER_SET_MEM_TABLE] = "VHOST_USER_SET_MEM_TABLE",
49 [VHOST_USER_SET_LOG_BASE] = "VHOST_USER_SET_LOG_BASE",
50 [VHOST_USER_SET_LOG_FD] = "VHOST_USER_SET_LOG_FD",
51 [VHOST_USER_SET_VRING_NUM] = "VHOST_USER_SET_VRING_NUM",
52 [VHOST_USER_SET_VRING_ADDR] = "VHOST_USER_SET_VRING_ADDR",
53 [VHOST_USER_SET_VRING_BASE] = "VHOST_USER_SET_VRING_BASE",
54 [VHOST_USER_GET_VRING_BASE] = "VHOST_USER_GET_VRING_BASE",
55 [VHOST_USER_SET_VRING_KICK] = "VHOST_USER_SET_VRING_KICK",
56 [VHOST_USER_SET_VRING_CALL] = "VHOST_USER_SET_VRING_CALL",
57 [VHOST_USER_SET_VRING_ERR] = "VHOST_USER_SET_VRING_ERR",
58 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
59 [VHOST_USER_GET_PROTOCOL_FEATURES] = "VHOST_USER_GET_PROTOCOL_FEATURES",
60 [VHOST_USER_SET_PROTOCOL_FEATURES] = "VHOST_USER_SET_PROTOCOL_FEATURES",
61 [VHOST_USER_GET_QUEUE_NUM] = "VHOST_USER_GET_QUEUE_NUM",
62 [VHOST_USER_SET_VRING_ENABLE] = "VHOST_USER_SET_VRING_ENABLE",
66 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
67 static int dpdk_vhost_user_set_vring_enable(u32 hw_if_index,
72 * DPDK vhost-user functions
75 /* portions taken from dpdk
78 * Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
79 * All rights reserved.
81 * Redistribution and use in source and binary forms, with or without
82 * modification, are permitted provided that the following conditions
85 * * Redistributions of source code must retain the above copyright
86 * notice, this list of conditions and the following disclaimer.
87 * * Redistributions in binary form must reproduce the above copyright
88 * notice, this list of conditions and the following disclaimer in
89 * the documentation and/or other materials provided with the
91 * * Neither the name of Intel Corporation nor the names of its
92 * contributors may be used to endorse or promote products derived
93 * from this software without specific prior written permission.
95 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
96 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
97 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
98 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
99 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
100 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
101 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
102 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
103 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
104 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
105 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
110 qva_to_vva(struct virtio_net *dev, uword qemu_va)
112 struct virtio_memory_regions *region;
114 uint32_t regionidx = 0;
116 /* Find the region where the address lives. */
117 for (regionidx = 0; regionidx < dev->mem->nregions; regionidx++) {
118 region = &dev->mem->regions[regionidx];
119 if ((qemu_va >= region->userspace_address) &&
120 (qemu_va <= region->userspace_address +
121 region->memory_size)) {
122 vhost_va = qemu_va + region->guest_phys_address +
123 region->address_offset -
124 region->userspace_address;
131 static dpdk_device_t *
132 dpdk_vhost_user_device_from_hw_if_index(u32 hw_if_index)
134 vnet_main_t *vnm = vnet_get_main();
135 dpdk_main_t * dm = &dpdk_main;
136 vnet_hw_interface_t * hi = vnet_get_hw_interface (vnm, hw_if_index);
137 dpdk_device_t * xd = vec_elt_at_index (dm->devices, hi->dev_instance);
139 if (xd->dev_type != VNET_DPDK_DEV_VHOST_USER)
145 static dpdk_device_t *
146 dpdk_vhost_user_device_from_sw_if_index(u32 sw_if_index)
148 vnet_main_t *vnm = vnet_get_main();
149 vnet_sw_interface_t * sw = vnet_get_sw_interface (vnm, sw_if_index);
150 ASSERT (sw->type == VNET_SW_INTERFACE_TYPE_HARDWARE);
152 return dpdk_vhost_user_device_from_hw_if_index(sw->hw_if_index);
155 static void stop_processing_packets(u32 hw_if_index, u8 idx)
158 dpdk_vhost_user_device_from_hw_if_index(hw_if_index);
160 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
161 xd->vu_vhost_dev.virtqueue[idx]->enabled = 0;
163 xd->vu_is_running = 0;
167 static void disable_interface(dpdk_device_t * xd)
169 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
171 int numqs = xd->vu_vhost_dev.virt_qp_nb * VIRTIO_QNUM;
172 for (idx = 0; idx < numqs; idx++)
173 xd->vu_vhost_dev.virtqueue[idx]->enabled = 0;
176 xd->vu_is_running = 0;
179 static inline void * map_guest_mem(dpdk_device_t * xd, uword addr)
181 dpdk_vu_intf_t * vui = xd->vu_intf;
182 struct virtio_memory * mem = xd->vu_vhost_dev.mem;
184 for (i=0; i<mem->nregions; i++) {
185 if ((mem->regions[i].guest_phys_address <= addr) &&
186 ((mem->regions[i].guest_phys_address + mem->regions[i].memory_size) > addr)) {
187 return (void *) ((uword)vui->region_addr[i] + addr - (uword)mem->regions[i].guest_phys_address);
190 DBG_SOCK("failed to map guest mem addr %lx", addr);
194 static clib_error_t *
195 dpdk_create_vhost_user_if_internal (u32 * hw_if_index, u32 if_id, u8 *hwaddr)
197 dpdk_main_t * dm = &dpdk_main;
198 vlib_main_t * vm = vlib_get_main();
199 vlib_thread_main_t * tm = vlib_get_thread_main();
200 vnet_sw_interface_t * sw;
201 clib_error_t * error;
202 dpdk_device_and_queue_t * dq;
204 dpdk_vu_intf_t *vui = NULL;
206 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
207 num_qpairs = dm->use_rss < 1 ? 1 : tm->n_vlib_mains;
210 dpdk_device_t * xd = NULL;
214 vlib_worker_thread_barrier_sync (vm);
216 int inactive_cnt = vec_len(dm->vu_inactive_interfaces_device_index);
217 // if there are any inactive ifaces
218 if (inactive_cnt > 0) {
220 u32 vui_idx = dm->vu_inactive_interfaces_device_index[inactive_cnt - 1];
221 if (vec_len(dm->devices) > vui_idx) {
222 xd = vec_elt_at_index (dm->devices, vui_idx);
223 if (xd->dev_type == VNET_DPDK_DEV_VHOST_USER) {
224 DBG_SOCK("reusing inactive vhost-user interface sw_if_index %d", xd->vlib_sw_if_index);
226 clib_warning("error: inactive vhost-user interface sw_if_index %d not VHOST_USER type!",
227 xd->vlib_sw_if_index);
228 // reset so new interface is created
232 // "remove" from inactive list
233 _vec_len(dm->vu_inactive_interfaces_device_index) -= 1;
237 // existing interface used - do not overwrite if_id if not needed
238 if (if_id != (u32)~0)
239 xd->vu_if_id = if_id;
243 for (j = 0; j < num_qpairs * VIRTIO_QNUM; j++) {
244 memset(xd->vu_vhost_dev.virtqueue[j], 0, sizeof(struct vhost_virtqueue));
245 xd->vu_vhost_dev.virtqueue[j]->kickfd = -1;
246 xd->vu_vhost_dev.virtqueue[j]->callfd = -1;
247 xd->vu_vhost_dev.virtqueue[j]->backend = -1;
248 vui->vrings[j].packets = 0;
249 vui->vrings[j].bytes = 0;
253 dpdk_device_lock_free(xd);
254 dpdk_device_lock_init(xd);
257 for (j = 0; j < tm->n_vlib_mains; j++)
259 vec_validate_ha (xd->tx_vectors[j], DPDK_TX_RING_SIZE,
260 sizeof(tx_ring_hdr_t), CLIB_CACHE_LINE_BYTES);
261 vec_reset_length (xd->tx_vectors[j]);
265 for (j = 0; j < xd->rx_q_used; j++)
267 vec_validate_aligned (xd->rx_vectors[j], VLIB_FRAME_SIZE-1,
268 CLIB_CACHE_LINE_BYTES);
269 vec_reset_length (xd->rx_vectors[j]);
272 // vui was not retrieved from inactive ifaces - create new
273 vec_add2_aligned (dm->devices, xd, 1, CLIB_CACHE_LINE_BYTES);
274 xd->dev_type = VNET_DPDK_DEV_VHOST_USER;
275 xd->rx_q_used = num_qpairs;
276 xd->tx_q_used = num_qpairs;
277 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
278 xd->vu_vhost_dev.virt_qp_nb = num_qpairs;
281 vec_validate_aligned (xd->rx_vectors, xd->rx_q_used, CLIB_CACHE_LINE_BYTES);
283 if (if_id == (u32)~0)
284 xd->vu_if_id = dm->next_vu_if_id++;
286 xd->vu_if_id = if_id;
288 xd->device_index = xd - dm->devices;
289 xd->per_interface_next_index = ~0;
290 xd->vu_intf = clib_mem_alloc (sizeof(*(xd->vu_intf)));
292 xd->vu_vhost_dev.mem = clib_mem_alloc (sizeof(struct virtio_memory) +
293 VHOST_MEMORY_MAX_NREGIONS *
294 sizeof(struct virtio_memory_regions));
296 /* Will be set when guest sends VHOST_USER_SET_MEM_TABLE cmd */
297 xd->vu_vhost_dev.mem->nregions = 0;
300 * New virtqueue structure is an array of VHOST_MAX_QUEUE_PAIRS * 2
301 * We need to allocate numq pairs.
304 for (j = 0; j < num_qpairs * VIRTIO_QNUM; j++) {
305 xd->vu_vhost_dev.virtqueue[j] = clib_mem_alloc (sizeof(struct vhost_virtqueue));
306 memset(xd->vu_vhost_dev.virtqueue[j], 0, sizeof(struct vhost_virtqueue));
307 xd->vu_vhost_dev.virtqueue[j]->kickfd = -1;
308 xd->vu_vhost_dev.virtqueue[j]->callfd = -1;
309 xd->vu_vhost_dev.virtqueue[j]->backend = -1;
310 vui->vrings[j].packets = 0;
311 vui->vrings[j].bytes = 0;
314 dpdk_device_lock_init(xd);
316 DBG_SOCK("tm->n_vlib_mains: %d. TX %d, RX: %d, num_qpairs: %d, Lock: %p",
317 tm->n_vlib_mains, xd->tx_q_used, xd->rx_q_used, num_qpairs, xd->lockp);
319 vec_validate_aligned (xd->tx_vectors, tm->n_vlib_mains,
320 CLIB_CACHE_LINE_BYTES);
322 for (j = 0; j < tm->n_vlib_mains; j++)
324 vec_validate_ha (xd->tx_vectors[j], DPDK_TX_RING_SIZE,
325 sizeof(tx_ring_hdr_t), CLIB_CACHE_LINE_BYTES);
326 vec_reset_length (xd->tx_vectors[j]);
330 for (j = 0; j < xd->rx_q_used; j++)
332 vec_validate_aligned (xd->rx_vectors[j], VLIB_FRAME_SIZE-1,
333 CLIB_CACHE_LINE_BYTES);
334 vec_reset_length (xd->rx_vectors[j]);
337 vec_validate_aligned (xd->frames, tm->n_vlib_mains,
338 CLIB_CACHE_LINE_BYTES);
342 * Generate random MAC address for the interface
345 clib_memcpy(addr, hwaddr, sizeof(addr));
347 f64 now = vlib_time_now(vm);
349 rnd = (u32) (now * 1e6);
350 rnd = random_u32 (&rnd);
352 clib_memcpy (addr+2, &rnd, sizeof(rnd));
357 error = ethernet_register_interface
359 dpdk_device_class.index,
361 /* ethernet address */ addr,
362 &xd->vlib_hw_if_index,
368 sw = vnet_get_hw_sw_interface (dm->vnet_main, xd->vlib_hw_if_index);
369 xd->vlib_sw_if_index = sw->sw_if_index;
371 *hw_if_index = xd->vlib_hw_if_index;
373 DBG_SOCK("xd->device_index: %d, dm->input_cpu_count: %d, "
374 "dm->input_cpu_first_index: %d\n", xd->device_index,
375 dm->input_cpu_count, dm->input_cpu_first_index);
378 for (q = 0; q < num_qpairs; q++) {
379 int cpu = dm->input_cpu_first_index +
380 (next_cpu % dm->input_cpu_count);
382 unsigned lcore = vlib_worker_threads[cpu].dpdk_lcore_id;
383 vec_validate(xd->cpu_socket_id_by_queue, q);
384 xd->cpu_socket_id_by_queue[q] = rte_lcore_to_socket_id(lcore);
386 vec_add2(dm->devices_by_cpu[cpu], dq, 1);
387 dq->device = xd->device_index;
389 DBG_SOCK("CPU for %d = %d. QID: %d", *hw_if_index, cpu, dq->queue_id);
391 // start polling if it was not started yet (because of no phys ifaces)
392 if (tm->n_vlib_mains == 1 && dpdk_input_node.state != VLIB_NODE_STATE_POLLING)
393 vlib_node_set_state (vm, dpdk_input_node.index, VLIB_NODE_STATE_POLLING);
395 if (tm->n_vlib_mains > 1)
396 vlib_node_set_state (vlib_mains[cpu], dpdk_input_node.index,
397 VLIB_NODE_STATE_POLLING);
401 vlib_worker_thread_barrier_release (vm);
405 #if RTE_VERSION >= RTE_VERSION_NUM(16, 4, 0, 0)
406 static long get_huge_page_size(int fd)
414 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
415 static clib_error_t *
416 dpdk_vhost_user_set_protocol_features(u32 hw_if_index, u64 prot_features)
419 xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index);
421 xd->vu_vhost_dev.protocol_features = prot_features;
426 static clib_error_t *
427 dpdk_vhost_user_get_features(u32 hw_if_index, u64 * features)
429 *features = rte_vhost_feature_get();
431 #if RTE_VERSION >= RTE_VERSION_NUM(16, 4, 0, 0)
432 #define OFFLOAD_FEATURES ((1ULL << VIRTIO_NET_F_HOST_TSO4) | \
433 (1ULL << VIRTIO_NET_F_HOST_TSO6) | \
434 (1ULL << VIRTIO_NET_F_CSUM) | \
435 (1ULL << VIRTIO_NET_F_GUEST_CSUM) | \
436 (1ULL << VIRTIO_NET_F_GUEST_TSO4) | \
437 (1ULL << VIRTIO_NET_F_GUEST_TSO6))
439 /* These are not suppoted as bridging/tunneling VHOST
440 * interfaces with hardware interfaces/drivers that does
441 * not support offloading breaks L4 traffic.
443 *features &= (~OFFLOAD_FEATURES);
446 DBG_SOCK("supported features: 0x%lx", *features);
450 static clib_error_t *
451 dpdk_vhost_user_set_features(u32 hw_if_index, u64 features)
454 u16 hdr_len = sizeof(struct virtio_net_hdr);
457 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
458 clib_warning("not a vhost-user interface");
462 xd->vu_vhost_dev.features = features;
464 if (xd->vu_vhost_dev.features & (1 << VIRTIO_NET_F_MRG_RXBUF))
465 hdr_len = sizeof(struct virtio_net_hdr_mrg_rxbuf);
467 int numqs = VIRTIO_QNUM;
469 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
470 int prot_feature = features &
471 (1ULL << VHOST_USER_F_PROTOCOL_FEATURES);
472 numqs = xd->vu_vhost_dev.virt_qp_nb * VIRTIO_QNUM;
474 for (idx = 0; idx < numqs; idx++) {
475 xd->vu_vhost_dev.virtqueue[idx]->vhost_hlen = hdr_len;
476 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
478 * Spec says, if F_PROTOCOL_FEATURE is not set by the
479 * slave, then all the vrings should start off as
480 * enabled. If slave negotiates F_PROTOCOL_FEATURE, then
481 * slave is responsible to enable it.
484 dpdk_vhost_user_set_vring_enable(hw_if_index, idx, 1);
491 static clib_error_t *
492 dpdk_vhost_user_set_mem_table(u32 hw_if_index, vhost_user_memory_t * vum, int fd[])
494 struct virtio_memory * mem;
497 dpdk_vu_intf_t * vui;
499 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
500 clib_warning("not a vhost-user interface");
505 mem = xd->vu_vhost_dev.mem;
507 mem->nregions = vum->nregions;
509 for (i=0; i < mem->nregions; i++) {
510 u64 mapped_size, mapped_address;
512 mem->regions[i].guest_phys_address = vum->regions[i].guest_phys_addr;
513 mem->regions[i].guest_phys_address_end = vum->regions[i].guest_phys_addr +
514 vum->regions[i].memory_size;
515 mem->regions[i].memory_size = vum->regions[i].memory_size;
516 mem->regions[i].userspace_address = vum->regions[i].userspace_addr;
518 mapped_size = mem->regions[i].memory_size + vum->regions[i].mmap_offset;
519 mapped_address = pointer_to_uword(mmap(NULL, mapped_size, PROT_READ | PROT_WRITE, MAP_SHARED, fd[i], 0));
521 if (uword_to_pointer(mapped_address, void*) == MAP_FAILED)
523 clib_warning("mmap error");
527 mapped_address += vum->regions[i].mmap_offset;
528 vui->region_addr[i] = mapped_address;
529 vui->region_fd[i] = fd[i];
530 mem->regions[i].address_offset = mapped_address - mem->regions[i].guest_phys_address;
532 if (vum->regions[i].guest_phys_addr == 0) {
533 mem->base_address = vum->regions[i].userspace_addr;
534 mem->mapped_address = mem->regions[i].address_offset;
538 disable_interface(xd);
542 static clib_error_t *
543 dpdk_vhost_user_set_vring_num(u32 hw_if_index, u8 idx, u32 num)
546 struct vhost_virtqueue *vq;
548 DBG_SOCK("idx %u num %u", idx, num);
550 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
551 clib_warning("not a vhost-user interface");
554 vq = xd->vu_vhost_dev.virtqueue[idx];
557 stop_processing_packets(hw_if_index, idx);
562 static clib_error_t *
563 dpdk_vhost_user_set_vring_addr(u32 hw_if_index, u8 idx, uword desc, \
564 uword used, uword avail, uword log)
567 struct vhost_virtqueue *vq;
569 DBG_SOCK("idx %u desc 0x%lx used 0x%lx avail 0x%lx log 0x%lx",
570 idx, desc, used, avail, log);
572 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
573 clib_warning("not a vhost-user interface");
576 vq = xd->vu_vhost_dev.virtqueue[idx];
578 vq->desc = (struct vring_desc *) qva_to_vva(&xd->vu_vhost_dev, desc);
579 vq->used = (struct vring_used *) qva_to_vva(&xd->vu_vhost_dev, used);
580 vq->avail = (struct vring_avail *) qva_to_vva(&xd->vu_vhost_dev, avail);
581 #if RTE_VERSION >= RTE_VERSION_NUM(16, 4, 0, 0)
582 vq->log_guest_addr = log;
585 if (!(vq->desc && vq->used && vq->avail)) {
586 clib_warning("falied to set vring addr");
589 if (vq->last_used_idx != vq->used->idx) {
590 clib_warning("last_used_idx (%u) and vq->used->idx (%u) mismatches; "
591 "some packets maybe resent for Tx and dropped for Rx",
592 vq->last_used_idx, vq->used->idx);
593 vq->last_used_idx = vq->used->idx;
594 vq->last_used_idx_res = vq->used->idx;
598 * Inform the guest that there is no need to inform (kick) the
599 * host when it adds buffers. kick results in vmexit and will
600 * incur performance degradation.
602 * The below function sets a flag in used table. Therefore,
603 * should be initialized after initializing vq->used.
605 rte_vhost_enable_guest_notification(&xd->vu_vhost_dev, idx, 0);
606 stop_processing_packets(hw_if_index, idx);
611 static clib_error_t *
612 dpdk_vhost_user_get_vring_base(u32 hw_if_index, u8 idx, u32 * num)
615 struct vhost_virtqueue *vq;
617 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
618 clib_warning("not a vhost-user interface");
622 vq = xd->vu_vhost_dev.virtqueue[idx];
623 *num = vq->last_used_idx;
627 * Client must start ring upon receiving a kick
628 * (that is, detecting that file descriptor is readable)
629 * on the descriptor specified by VHOST_USER_SET_VRING_KICK,
630 * and stop ring upon receiving VHOST_USER_GET_VRING_BASE.
632 DBG_SOCK("Stopping vring Q %u of device %d", idx, hw_if_index);
633 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
634 dpdk_vu_intf_t *vui = xd->vu_intf;
635 vui->vrings[idx].enabled = 0; /* Reset local copy */
636 vui->vrings[idx].callfd = -1; /* Reset FD */
641 #if RTE_VERSION >= RTE_VERSION_NUM(16, 4, 0, 0)
642 vq->log_guest_addr = 0;
645 /* Check if all Qs are disabled */
646 int numqs = xd->vu_vhost_dev.virt_qp_nb * VIRTIO_QNUM;
647 for (idx = 0; idx < numqs; idx++) {
648 if (xd->vu_vhost_dev.virtqueue[idx]->enabled)
652 /* If all vrings are disabed then disable device */
654 DBG_SOCK("Device %d disabled", hw_if_index);
655 xd->vu_is_running = 0;
661 xd->vu_is_running = 0;
667 static clib_error_t *
668 dpdk_vhost_user_set_vring_base(u32 hw_if_index, u8 idx, u32 num)
671 struct vhost_virtqueue *vq;
673 DBG_SOCK("idx %u num %u", idx, num);
675 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
676 clib_warning("not a vhost-user interface");
680 vq = xd->vu_vhost_dev.virtqueue[idx];
681 vq->last_used_idx = num;
682 vq->last_used_idx_res = num;
684 stop_processing_packets(hw_if_index, idx);
689 static clib_error_t *
690 dpdk_vhost_user_set_vring_kick(u32 hw_if_index, u8 idx, int fd)
692 dpdk_main_t * dm = &dpdk_main;
694 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
695 dpdk_vu_vring *vring;
697 struct vhost_virtqueue *vq0, *vq1, *vq;
698 int index, vu_is_running = 0;
700 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
701 clib_warning("not a vhost-user interface");
705 vq = xd->vu_vhost_dev.virtqueue[idx];
708 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
709 vring = &xd->vu_intf->vrings[idx];
710 vq->enabled = (vq->desc && vq->avail && vq->used && vring->enabled) ? 1 : 0;
714 * Set xd->vu_is_running if at least one pair of
715 * RX/TX queues are enabled.
717 int numqs = VIRTIO_QNUM;
718 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
719 numqs = xd->vu_vhost_dev.virt_qp_nb * VIRTIO_QNUM;
722 for (index = 0; index < numqs; index += 2) {
723 vq0 = xd->vu_vhost_dev.virtqueue[index]; /* RX */
724 vq1 = xd->vu_vhost_dev.virtqueue[index + 1]; /* TX */
725 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
726 if (vq0->enabled && vq1->enabled)
728 if (vq0->desc && vq0->avail && vq0->used &&
729 vq1->desc && vq1->avail && vq1->used)
736 DBG_SOCK("SET_VRING_KICK - idx %d, running %d, fd: %d",
737 idx, vu_is_running, fd);
739 xd->vu_is_running = vu_is_running;
740 if (xd->vu_is_running && xd->admin_up) {
741 vnet_hw_interface_set_flags (dm->vnet_main,
742 xd->vlib_hw_if_index, VNET_HW_INTERFACE_FLAG_LINK_UP |
743 ETH_LINK_FULL_DUPLEX );
749 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
751 dpdk_vhost_user_set_vring_enable(u32 hw_if_index, u8 idx, int enable)
754 struct vhost_virtqueue *vq;
757 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
758 clib_warning("not a vhost-user interface");
764 * Guest vhost driver wrongly enables queue before
765 * setting the vring address. Therefore, save a
766 * local copy. Reflect it in vq structure if addresses
767 * are set. If not, vq will be enabled when vring
770 vui->vrings[idx].enabled = enable; /* Save local copy */
772 int numqs = xd->vu_vhost_dev.virt_qp_nb * VIRTIO_QNUM;
774 if (! vui->vrings[numqs].enabled)
778 if (numqs == -1) /* All Qs are enabled */
783 vq = xd->vu_vhost_dev.virtqueue[idx];
784 if (vq->desc && vq->avail && vq->used)
785 xd->vu_vhost_dev.virtqueue[idx]->enabled = enable;
791 static clib_error_t * dpdk_vhost_user_callfd_read_ready (unix_file_t * uf)
793 __attribute__((unused)) int n;
795 n = read(uf->file_descriptor, ((char*)&buff), 8);
799 static clib_error_t *
800 dpdk_vhost_user_set_vring_call(u32 hw_if_index, u8 idx, int fd)
803 struct vhost_virtqueue *vq;
804 unix_file_t template = {0};
806 DBG_SOCK("SET_VRING_CALL - idx %d, fd %d", idx, fd);
808 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_index))) {
809 clib_warning("not a vhost-user interface");
813 dpdk_vu_intf_t *vui = xd->vu_intf;
815 /* if there is old fd, delete it */
816 if (vui->vrings[idx].callfd > 0) {
817 unix_file_t * uf = pool_elt_at_index (unix_main.file_pool,
818 vui->vrings[idx].callfd_idx);
819 unix_file_del (&unix_main, uf);
821 vui->vrings[idx].callfd = fd;
822 template.read_function = dpdk_vhost_user_callfd_read_ready;
823 template.file_descriptor = fd;
824 vui->vrings[idx].callfd_idx = unix_file_add (&unix_main, &template);
826 vq = xd->vu_vhost_dev.virtqueue[idx];
827 vq->callfd = -1; /* We use locally saved vring->callfd; */
833 dpdk_vhost_user_want_interrupt(dpdk_device_t *xd, int idx)
835 dpdk_vu_intf_t *vui = xd->vu_intf;
838 if (PREDICT_FALSE(vui->num_vrings <= 0))
841 dpdk_vu_vring *vring = &(vui->vrings[idx]);
842 struct vhost_virtqueue *vq = xd->vu_vhost_dev.virtqueue[idx];
844 /* return if vm is interested in interrupts */
845 return (vring->callfd > 0) && !(vq->avail->flags & VRING_AVAIL_F_NO_INTERRUPT);
849 dpdk_vhost_user_send_interrupt(vlib_main_t * vm, dpdk_device_t * xd, int idx)
851 dpdk_main_t * dm = &dpdk_main;
852 dpdk_vu_intf_t *vui = xd->vu_intf;
855 if (PREDICT_FALSE(vui->num_vrings <= 0))
858 dpdk_vu_vring *vring = &(vui->vrings[idx]);
859 struct vhost_virtqueue *vq = xd->vu_vhost_dev.virtqueue[idx];
861 /* if vm is interested in interrupts */
862 if((vring->callfd > 0) && !(vq->avail->flags & VRING_AVAIL_F_NO_INTERRUPT)) {
863 eventfd_write(vring->callfd, (eventfd_t)1);
864 vring->n_since_last_int = 0;
865 vring->int_deadline = vlib_time_now(vm) + dm->conf->vhost_coalesce_time;
870 * vhost-user interface management functions
873 // initialize vui with specified attributes
875 dpdk_vhost_user_vui_init(vnet_main_t * vnm,
876 dpdk_device_t *xd, int sockfd,
877 const char * sock_filename,
878 u8 is_server, u64 feature_mask,
881 dpdk_vu_intf_t *vui = xd->vu_intf;
882 memset(vui, 0, sizeof(*vui));
884 vui->unix_fd = sockfd;
885 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
886 vui->num_vrings = xd->vu_vhost_dev.virt_qp_nb * VIRTIO_QNUM;
888 vui->num_vrings = VIRTIO_QNUM;
890 DBG_SOCK("dpdk_vhost_user_vui_init VRINGS: %d", vui->num_vrings);
891 vui->sock_is_server = is_server;
892 strncpy(vui->sock_filename, sock_filename, ARRAY_LEN(vui->sock_filename)-1);
895 vui->feature_mask = feature_mask;
897 vui->unix_file_index = ~0;
899 vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index, 0);
902 *sw_if_index = xd->vlib_sw_if_index;
905 // register vui and start polling on it
907 dpdk_vhost_user_vui_register(vlib_main_t * vm, dpdk_device_t *xd)
909 dpdk_main_t * dm = &dpdk_main;
910 dpdk_vu_intf_t *vui = xd->vu_intf;
912 hash_set (dm->vu_sw_if_index_by_listener_fd, vui->unix_fd,
913 xd->vlib_sw_if_index);
917 dpdk_vhost_user_if_disconnect(dpdk_device_t * xd)
919 dpdk_vu_intf_t *vui = xd->vu_intf;
920 vnet_main_t * vnm = vnet_get_main();
921 dpdk_main_t * dm = &dpdk_main;
924 vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index, 0);
926 if (vui->unix_file_index != ~0) {
927 unix_file_del (&unix_main, unix_main.file_pool + vui->unix_file_index);
928 vui->unix_file_index = ~0;
931 hash_unset(dm->vu_sw_if_index_by_sock_fd, vui->unix_fd);
932 hash_unset(dm->vu_sw_if_index_by_listener_fd, vui->unix_fd);
937 DBG_SOCK("interface ifindex %d disconnected", xd->vlib_sw_if_index);
940 static clib_error_t * dpdk_vhost_user_socket_read (unix_file_t * uf)
943 int fd, number_of_fds = 0;
944 int fds[VHOST_MEMORY_MAX_NREGIONS];
945 vhost_user_msg_t msg;
948 dpdk_main_t * dm = &dpdk_main;
951 struct cmsghdr *cmsg;
954 vnet_main_t * vnm = vnet_get_main();
956 p = hash_get (dm->vu_sw_if_index_by_sock_fd, uf->file_descriptor);
958 DBG_SOCK ("FD %d doesn't belong to any interface",
959 uf->file_descriptor);
963 xd = dpdk_vhost_user_device_from_sw_if_index(p[0]);
968 char control[CMSG_SPACE(VHOST_MEMORY_MAX_NREGIONS * sizeof(int))];
970 memset(&mh, 0, sizeof(mh));
971 memset(control, 0, sizeof(control));
973 /* set the payload */
974 iov[0].iov_base = (void *) &msg;
975 iov[0].iov_len = VHOST_USER_MSG_HDR_SZ;
979 mh.msg_control = control;
980 mh.msg_controllen = sizeof(control);
982 n = recvmsg(uf->file_descriptor, &mh, 0);
984 if (n != VHOST_USER_MSG_HDR_SZ)
987 if (mh.msg_flags & MSG_CTRUNC) {
991 cmsg = CMSG_FIRSTHDR(&mh);
993 if (cmsg && (cmsg->cmsg_len > 0) && (cmsg->cmsg_level == SOL_SOCKET) &&
994 (cmsg->cmsg_type == SCM_RIGHTS) &&
995 (cmsg->cmsg_len - CMSG_LEN(0) <= VHOST_MEMORY_MAX_NREGIONS * sizeof(int))) {
996 number_of_fds = (cmsg->cmsg_len - CMSG_LEN(0)) / sizeof(int);
997 clib_memcpy(fds, CMSG_DATA(cmsg), number_of_fds * sizeof(int));
1000 /* version 1, no reply bit set*/
1001 if ((msg.flags & 7) != 1) {
1002 DBG_SOCK("malformed message received. closing socket");
1007 int rv __attribute__((unused));
1008 /* $$$$ pay attention to rv */
1009 rv = read(uf->file_descriptor, ((char*)&msg) + n, msg.size);
1012 DBG_SOCK("VPP VHOST message %s", vhost_message_str[msg.request]);
1013 switch (msg.request) {
1014 case VHOST_USER_GET_FEATURES:
1015 DBG_SOCK("if %d msg VHOST_USER_GET_FEATURES",
1016 xd->vlib_hw_if_index);
1018 msg.flags |= VHOST_USER_REPLY_MASK;
1020 dpdk_vhost_user_get_features(xd->vlib_hw_if_index, &msg.u64);
1021 msg.u64 &= vui->feature_mask;
1022 msg.size = sizeof(msg.u64);
1025 case VHOST_USER_SET_FEATURES:
1026 DBG_SOCK("if %d msg VHOST_USER_SET_FEATURES features 0x%016lx",
1027 xd->vlib_hw_if_index, msg.u64);
1029 dpdk_vhost_user_set_features(xd->vlib_hw_if_index, msg.u64);
1032 case VHOST_USER_SET_MEM_TABLE:
1033 DBG_SOCK("if %d msg VHOST_USER_SET_MEM_TABLE nregions %d",
1034 xd->vlib_hw_if_index, msg.memory.nregions);
1036 if ((msg.memory.nregions < 1) ||
1037 (msg.memory.nregions > VHOST_MEMORY_MAX_NREGIONS)) {
1039 DBG_SOCK("number of mem regions must be between 1 and %i",
1040 VHOST_MEMORY_MAX_NREGIONS);
1045 if (msg.memory.nregions != number_of_fds) {
1046 DBG_SOCK("each memory region must have FD");
1050 dpdk_vhost_user_set_mem_table(xd->vlib_hw_if_index, &msg.memory, fds);
1053 case VHOST_USER_SET_VRING_NUM:
1054 DBG_SOCK("if %d msg VHOST_USER_SET_VRING_NUM idx %d num %d",
1055 xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1057 if ((msg.state.num > 32768) || /* maximum ring size is 32768 */
1058 (msg.state.num == 0) || /* it cannot be zero */
1059 (msg.state.num % 2)) /* must be power of 2 */
1062 dpdk_vhost_user_set_vring_num(xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1065 case VHOST_USER_SET_VRING_ADDR:
1066 DBG_SOCK("if %d msg VHOST_USER_SET_VRING_ADDR idx %d",
1067 xd->vlib_hw_if_index, msg.state.index);
1069 dpdk_vhost_user_set_vring_addr(xd->vlib_hw_if_index, msg.state.index,
1070 msg.addr.desc_user_addr,
1071 msg.addr.used_user_addr,
1072 msg.addr.avail_user_addr,
1073 msg.addr.log_guest_addr);
1076 case VHOST_USER_SET_OWNER:
1077 DBG_SOCK("if %d msg VHOST_USER_SET_OWNER",
1078 xd->vlib_hw_if_index);
1081 case VHOST_USER_RESET_OWNER:
1082 DBG_SOCK("if %d msg VHOST_USER_RESET_OWNER",
1083 xd->vlib_hw_if_index);
1086 case VHOST_USER_SET_VRING_CALL:
1087 q = (u8) (msg.u64 & 0xFF);
1089 DBG_SOCK("if %d msg VHOST_USER_SET_VRING_CALL u64 %lx, idx: %d",
1090 xd->vlib_hw_if_index, msg.u64, q);
1092 if (!(msg.u64 & 0x100))
1094 if (number_of_fds != 1)
1100 dpdk_vhost_user_set_vring_call(xd->vlib_hw_if_index, q, fd);
1104 case VHOST_USER_SET_VRING_KICK:
1106 q = (u8) (msg.u64 & 0xFF);
1108 DBG_SOCK("if %d msg VHOST_USER_SET_VRING_KICK u64 %lx, idx: %d",
1109 xd->vlib_hw_if_index, msg.u64, q);
1111 if (!(msg.u64 & 0x100))
1113 if (number_of_fds != 1)
1116 vui->vrings[q].kickfd = fds[0];
1119 vui->vrings[q].kickfd = -1;
1121 dpdk_vhost_user_set_vring_kick(xd->vlib_hw_if_index, q, vui->vrings[q].kickfd);
1124 case VHOST_USER_SET_VRING_ERR:
1126 q = (u8) (msg.u64 & 0xFF);
1128 DBG_SOCK("if %d msg VHOST_USER_SET_VRING_ERR u64 %lx, idx: %d",
1129 xd->vlib_hw_if_index, msg.u64, q);
1131 if (!(msg.u64 & 0x100))
1133 if (number_of_fds != 1)
1141 vui->vrings[q].errfd = fd;
1144 case VHOST_USER_SET_VRING_BASE:
1145 DBG_SOCK("if %d msg VHOST_USER_SET_VRING_BASE idx %d num %d",
1146 xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1148 dpdk_vhost_user_set_vring_base(xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1151 case VHOST_USER_GET_VRING_BASE:
1152 DBG_SOCK("if %d msg VHOST_USER_GET_VRING_BASE idx %d num %d",
1153 xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1155 msg.flags |= VHOST_USER_REPLY_MASK;
1156 msg.size = sizeof(msg.state);
1158 dpdk_vhost_user_get_vring_base(xd->vlib_hw_if_index, msg.state.index, &msg.state.num);
1161 case VHOST_USER_NONE:
1162 DBG_SOCK("if %d msg VHOST_USER_NONE",
1163 xd->vlib_hw_if_index);
1166 case VHOST_USER_SET_LOG_BASE:
1167 #if RTE_VERSION >= RTE_VERSION_NUM(16, 4, 0, 0)
1168 DBG_SOCK("if %d msg VHOST_USER_SET_LOG_BASE",
1169 xd->vlib_hw_if_index);
1171 if (msg.size != sizeof(msg.log)) {
1172 DBG_SOCK("invalid msg size for VHOST_USER_SET_LOG_BASE: %u instead of %lu",
1173 msg.size, sizeof(msg.log));
1177 if (!(xd->vu_vhost_dev.protocol_features & (1 << VHOST_USER_PROTOCOL_F_LOG_SHMFD))) {
1178 DBG_SOCK("VHOST_USER_PROTOCOL_F_LOG_SHMFD not set but VHOST_USER_SET_LOG_BASE received");
1183 /* align size to 2M page */
1184 long page_sz = get_huge_page_size(fd);
1185 ssize_t map_sz = (msg.log.size + msg.log.offset + page_sz) & ~(page_sz - 1);
1187 void *addr = mmap(0, map_sz, PROT_READ | PROT_WRITE,
1190 DBG_SOCK("map log region addr 0 len 0x%lx off 0x%lx fd %d mapped %p",
1191 map_sz, msg.log.offset, fd, addr);
1193 if (addr == MAP_FAILED) {
1194 clib_warning("failed to map memory. errno is %d", errno);
1198 xd->vu_vhost_dev.log_base += pointer_to_uword(addr) + msg.log.offset;
1199 xd->vu_vhost_dev.log_size = msg.log.size;
1200 msg.flags |= VHOST_USER_REPLY_MASK;
1201 msg.size = sizeof(msg.u64);
1203 DBG_SOCK("if %d msg VHOST_USER_SET_LOG_BASE Not-Implemented",
1204 xd->vlib_hw_if_index);
1208 case VHOST_USER_SET_LOG_FD:
1209 DBG_SOCK("if %d msg VHOST_USER_SET_LOG_FD",
1210 xd->vlib_hw_if_index);
1213 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
1214 case VHOST_USER_GET_PROTOCOL_FEATURES:
1215 DBG_SOCK("if %d msg VHOST_USER_GET_PROTOCOL_FEATURES",
1216 xd->vlib_hw_if_index);
1218 msg.flags |= VHOST_USER_REPLY_MASK;
1219 msg.u64 = VHOST_USER_PROTOCOL_FEATURES;
1220 DBG_SOCK("VHOST_USER_PROTOCOL_FEATURES: %llx", VHOST_USER_PROTOCOL_FEATURES);
1221 msg.size = sizeof(msg.u64);
1224 case VHOST_USER_SET_PROTOCOL_FEATURES:
1225 DBG_SOCK("if %d msg VHOST_USER_SET_PROTOCOL_FEATURES",
1226 xd->vlib_hw_if_index);
1228 DBG_SOCK("VHOST_USER_SET_PROTOCOL_FEATURES: 0x%lx",
1230 dpdk_vhost_user_set_protocol_features(xd->vlib_hw_if_index,
1234 case VHOST_USER_SET_VRING_ENABLE:
1235 DBG_SOCK("%d VPP VHOST_USER_SET_VRING_ENABLE IDX: %d, Enable: %d",
1236 xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1237 dpdk_vhost_user_set_vring_enable
1238 (xd->vlib_hw_if_index, msg.state.index, msg.state.num);
1241 case VHOST_USER_GET_QUEUE_NUM:
1242 DBG_SOCK("if %d msg VHOST_USER_GET_QUEUE_NUM:",
1243 xd->vlib_hw_if_index);
1245 msg.flags |= VHOST_USER_REPLY_MASK;
1246 msg.u64 = xd->vu_vhost_dev.virt_qp_nb;
1247 msg.size = sizeof(msg.u64);
1252 DBG_SOCK("unknown vhost-user message %d received. closing socket",
1257 /* if we have pointers to descriptor table, go up*/
1259 xd->vu_vhost_dev.virtqueue[VHOST_NET_VRING_IDX_TX]->desc &&
1260 xd->vu_vhost_dev.virtqueue[VHOST_NET_VRING_IDX_RX]->desc) {
1262 DBG_SOCK("interface %d connected", xd->vlib_sw_if_index);
1264 vnet_hw_interface_set_flags (vnm, xd->vlib_hw_if_index, VNET_HW_INTERFACE_FLAG_LINK_UP);
1269 /* if we need to reply */
1270 if (msg.flags & VHOST_USER_REPLY_MASK)
1272 n = send(uf->file_descriptor, &msg, VHOST_USER_MSG_HDR_SZ + msg.size, 0);
1273 if (n != (msg.size + VHOST_USER_MSG_HDR_SZ))
1280 DBG_SOCK("error: close_socket");
1281 dpdk_vhost_user_if_disconnect(xd);
1285 static clib_error_t * dpdk_vhost_user_socket_error (unix_file_t * uf)
1287 dpdk_main_t * dm = &dpdk_main;
1291 p = hash_get (dm->vu_sw_if_index_by_sock_fd, uf->file_descriptor);
1293 DBG_SOCK ("FD %d doesn't belong to any interface",
1294 uf->file_descriptor);
1298 xd = dpdk_vhost_user_device_from_sw_if_index(p[0]);
1300 dpdk_vhost_user_if_disconnect(xd);
1304 static clib_error_t * dpdk_vhost_user_socksvr_accept_ready (unix_file_t * uf)
1306 int client_fd, client_len;
1307 struct sockaddr_un client;
1308 unix_file_t template = {0};
1309 dpdk_main_t * dm = &dpdk_main;
1310 dpdk_device_t * xd = NULL;
1311 dpdk_vu_intf_t * vui;
1314 p = hash_get (dm->vu_sw_if_index_by_listener_fd,
1315 uf->file_descriptor);
1317 DBG_SOCK ("fd %d doesn't belong to any interface",
1318 uf->file_descriptor);
1322 xd = dpdk_vhost_user_device_from_sw_if_index(p[0]);
1326 client_len = sizeof(client);
1327 client_fd = accept (uf->file_descriptor,
1328 (struct sockaddr *)&client,
1329 (socklen_t *)&client_len);
1332 return clib_error_return_unix (0, "accept");
1334 template.read_function = dpdk_vhost_user_socket_read;
1335 template.error_function = dpdk_vhost_user_socket_error;
1336 template.file_descriptor = client_fd;
1337 vui->unix_file_index = unix_file_add (&unix_main, &template);
1339 vui->client_fd = client_fd;
1340 hash_set (dm->vu_sw_if_index_by_sock_fd, vui->client_fd,
1341 xd->vlib_sw_if_index);
1346 // init server socket on specified sock_filename
1347 static int dpdk_vhost_user_init_server_sock(const char * sock_filename, int *sockfd)
1350 struct sockaddr_un un;
1352 /* create listening socket */
1353 fd = socket(AF_UNIX, SOCK_STREAM, 0);
1356 return VNET_API_ERROR_SYSCALL_ERROR_1;
1359 un.sun_family = AF_UNIX;
1360 strcpy((char *) un.sun_path, (char *) sock_filename);
1362 /* remove if exists */
1363 unlink( (char *) sock_filename);
1365 len = strlen((char *) un.sun_path) + strlen((char *) sock_filename);
1367 if (bind(fd, (struct sockaddr *) &un, len) == -1) {
1368 rv = VNET_API_ERROR_SYSCALL_ERROR_2;
1372 if (listen(fd, 1) == -1) {
1373 rv = VNET_API_ERROR_SYSCALL_ERROR_3;
1377 unix_file_t template = {0};
1378 template.read_function = dpdk_vhost_user_socksvr_accept_ready;
1379 template.file_descriptor = fd;
1380 unix_file_add (&unix_main, &template);
1390 * vhost-user interface control functions used from vpe api
1393 int dpdk_vhost_user_create_if(vnet_main_t * vnm, vlib_main_t * vm,
1394 const char * sock_filename,
1398 u8 renumber, u32 custom_dev_instance,
1401 dpdk_main_t * dm = &dpdk_main;
1407 // using virtio vhost user?
1408 if (dm->conf->use_virtio_vhost) {
1409 return vhost_user_create_if(vnm, vm, sock_filename, is_server,
1410 sw_if_index, feature_mask, renumber, custom_dev_instance, hwaddr);
1414 if ((rv = dpdk_vhost_user_init_server_sock (sock_filename, &sockfd)) != 0) {
1420 // set next vhost-user if id if custom one is higher or equal
1421 if (custom_dev_instance >= dm->next_vu_if_id)
1422 dm->next_vu_if_id = custom_dev_instance + 1;
1424 dpdk_create_vhost_user_if_internal(&hw_if_idx, custom_dev_instance, hwaddr);
1426 dpdk_create_vhost_user_if_internal(&hw_if_idx, (u32)~0, hwaddr);
1427 DBG_SOCK("dpdk vhost-user interface created hw_if_index %d", hw_if_idx);
1429 xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_idx);
1432 dpdk_vhost_user_vui_init (vnm, xd, sockfd, sock_filename, is_server,
1433 feature_mask, sw_if_index);
1435 dpdk_vhost_user_vui_register (vm, xd);
1439 int dpdk_vhost_user_modify_if(vnet_main_t * vnm, vlib_main_t * vm,
1440 const char * sock_filename,
1444 u8 renumber, u32 custom_dev_instance)
1446 dpdk_main_t * dm = &dpdk_main;
1448 dpdk_vu_intf_t * vui = NULL;
1453 // using virtio vhost user?
1454 if (dm->conf->use_virtio_vhost) {
1455 return vhost_user_modify_if(vnm, vm, sock_filename, is_server,
1456 sw_if_index, feature_mask, renumber, custom_dev_instance);
1459 xd = dpdk_vhost_user_device_from_sw_if_index(sw_if_index);
1462 return VNET_API_ERROR_INVALID_SW_IF_INDEX;
1466 // interface is inactive
1468 // disconnect interface sockets
1469 dpdk_vhost_user_if_disconnect(xd);
1472 if ((rv = dpdk_vhost_user_init_server_sock (sock_filename, &sockfd)) != 0) {
1477 dpdk_vhost_user_vui_init (vnm, xd, sockfd, sock_filename, is_server,
1478 feature_mask, &sw_if_idx);
1481 vnet_interface_name_renumber (sw_if_idx, custom_dev_instance);
1484 dpdk_vhost_user_vui_register (vm, xd);
1489 int dpdk_vhost_user_delete_if(vnet_main_t * vnm, vlib_main_t * vm,
1492 dpdk_main_t * dm = &dpdk_main;
1493 dpdk_device_t * xd = NULL;
1494 dpdk_vu_intf_t * vui;
1497 // using virtio vhost user?
1498 if (dm->conf->use_virtio_vhost) {
1499 return vhost_user_delete_if(vnm, vm, sw_if_index);
1502 xd = dpdk_vhost_user_device_from_sw_if_index(sw_if_index);
1505 return VNET_API_ERROR_INVALID_SW_IF_INDEX;
1509 // interface is inactive
1511 // disconnect interface sockets
1512 dpdk_vhost_user_if_disconnect(xd);
1513 // add to inactive interface list
1514 vec_add1 (dm->vu_inactive_interfaces_device_index, xd->device_index);
1516 ethernet_delete_interface (vnm, xd->vlib_hw_if_index);
1517 DBG_SOCK ("deleted (deactivated) vhost-user interface sw_if_index %d", sw_if_index);
1522 int dpdk_vhost_user_dump_ifs(vnet_main_t * vnm, vlib_main_t * vm, vhost_user_intf_details_t **out_vuids)
1525 dpdk_main_t * dm = &dpdk_main;
1527 dpdk_vu_intf_t * vui;
1528 struct virtio_net * vhost_dev;
1529 vhost_user_intf_details_t * r_vuids = NULL;
1530 vhost_user_intf_details_t * vuid = NULL;
1531 u32 * hw_if_indices = 0;
1532 vnet_hw_interface_t * hi;
1539 // using virtio vhost user?
1540 if (dm->conf->use_virtio_vhost) {
1541 return vhost_user_dump_ifs(vnm, vm, out_vuids);
1544 vec_foreach (xd, dm->devices) {
1545 if (xd->dev_type == VNET_DPDK_DEV_VHOST_USER &&
1546 xd->vu_intf->active)
1547 vec_add1(hw_if_indices, xd->vlib_hw_if_index);
1550 for (i = 0; i < vec_len (hw_if_indices); i++) {
1551 hi = vnet_get_hw_interface (vnm, hw_if_indices[i]);
1552 xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_indices[i]);
1554 clib_warning("invalid vhost-user interface hw_if_index %d", hw_if_indices[i]);
1559 ASSERT(vui != NULL);
1560 vhost_dev = &xd->vu_vhost_dev;
1561 u32 virtio_net_hdr_sz = (vui->num_vrings > 0 ?
1562 vhost_dev->virtqueue[0]->vhost_hlen : 0);
1564 vec_add2(r_vuids, vuid, 1);
1565 vuid->sw_if_index = xd->vlib_sw_if_index;
1566 vuid->virtio_net_hdr_sz = virtio_net_hdr_sz;
1567 vuid->features = vhost_dev->features;
1568 vuid->is_server = vui->sock_is_server;
1569 vuid->num_regions = (vhost_dev->mem != NULL ? vhost_dev->mem->nregions : 0);
1570 vuid->sock_errno = vui->sock_errno;
1571 strncpy((char *)vuid->sock_filename, (char *)vui->sock_filename,
1572 ARRAY_LEN(vuid->sock_filename)-1);
1574 s = format (s, "%v%c", hi->name, 0);
1576 strncpy((char *)vuid->if_name, (char *)s,
1577 ARRAY_LEN(vuid->if_name)-1);
1582 vec_free (hw_if_indices);
1584 *out_vuids = r_vuids;
1590 * Processing functions called from dpdk process fn
1594 struct sockaddr_un sun;
1596 unix_file_t template;
1598 } dpdk_vu_process_state;
1600 void dpdk_vhost_user_process_init (void **ctx)
1602 dpdk_vu_process_state *state = clib_mem_alloc (sizeof(dpdk_vu_process_state));
1603 memset(state, 0, sizeof(*state));
1604 state->sockfd = socket(AF_UNIX, SOCK_STREAM, 0);
1605 state->sun.sun_family = AF_UNIX;
1606 state->template.read_function = dpdk_vhost_user_socket_read;
1607 state->template.error_function = dpdk_vhost_user_socket_error;
1608 state->event_data = 0;
1612 void dpdk_vhost_user_process_cleanup (void *ctx)
1617 uword dpdk_vhost_user_process_if (vlib_main_t *vm, dpdk_device_t *xd, void *ctx)
1619 dpdk_main_t * dm = &dpdk_main;
1620 dpdk_vu_process_state *state = (dpdk_vu_process_state *)ctx;
1621 dpdk_vu_intf_t *vui = xd->vu_intf;
1623 if (vui->sock_is_server || !vui->active)
1626 if (vui->unix_fd == -1) {
1627 /* try to connect */
1628 strncpy(state->sun.sun_path, (char *) vui->sock_filename, sizeof(state->sun.sun_path) - 1);
1630 if (connect(state->sockfd, (struct sockaddr *) &(state->sun), sizeof(struct sockaddr_un)) == 0) {
1631 vui->sock_errno = 0;
1632 vui->unix_fd = state->sockfd;
1633 state->template.file_descriptor = state->sockfd;
1634 vui->unix_file_index = unix_file_add (&unix_main, &(state->template));
1635 hash_set (dm->vu_sw_if_index_by_sock_fd, state->sockfd, xd->vlib_sw_if_index);
1637 state->sockfd = socket(AF_UNIX, SOCK_STREAM, 0);
1638 if (state->sockfd < 0)
1641 vui->sock_errno = errno;
1644 /* check if socket is alive */
1646 socklen_t len = sizeof (error);
1647 int retval = getsockopt(vui->unix_fd, SOL_SOCKET, SO_ERROR, &error, &len);
1650 dpdk_vhost_user_if_disconnect(xd);
1659 static clib_error_t *
1660 dpdk_vhost_user_connect_command_fn (vlib_main_t * vm,
1661 unformat_input_t * input,
1662 vlib_cli_command_t * cmd)
1664 dpdk_main_t * dm = &dpdk_main;
1665 unformat_input_t _line_input, * line_input = &_line_input;
1666 u8 * sock_filename = NULL;
1669 u64 feature_mask = (u64)~0;
1671 u32 custom_dev_instance = ~0;
1675 if (dm->conf->use_virtio_vhost) {
1676 return vhost_user_connect_command_fn(vm, input, cmd);
1679 /* Get a line of input. */
1680 if (! unformat_user (input, unformat_line_input, line_input))
1683 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT) {
1684 if (unformat (line_input, "socket %s", &sock_filename))
1686 else if (unformat (line_input, "server"))
1688 else if (unformat (line_input, "feature-mask 0x%llx", &feature_mask))
1690 else if (unformat (line_input, "hwaddr %U", unformat_ethernet_address, hwaddr))
1692 else if (unformat (line_input, "renumber %d", &custom_dev_instance)) {
1696 return clib_error_return (0, "unknown input `%U'",
1697 format_unformat_error, input);
1699 unformat_free (line_input);
1701 vnet_main_t *vnm = vnet_get_main();
1702 if (sock_filename == NULL)
1703 return clib_error_return (0, "missing socket file");
1705 dpdk_vhost_user_create_if(vnm, vm, (char *)sock_filename,
1706 is_server, &sw_if_index, feature_mask,
1707 renumber, custom_dev_instance, hw);
1709 vec_free(sock_filename);
1710 vlib_cli_output(vm, "%U\n", format_vnet_sw_if_index_name, vnet_get_main(), sw_if_index);
1714 VLIB_CLI_COMMAND (dpdk_vhost_user_connect_command, static) = {
1715 .path = "create vhost-user",
1716 .short_help = "create vhost-user socket <socket-filename> [server] [feature-mask <hex>] [renumber <dev_instance>]",
1717 .function = dpdk_vhost_user_connect_command_fn,
1720 static clib_error_t *
1721 dpdk_vhost_user_delete_command_fn (vlib_main_t * vm,
1722 unformat_input_t * input,
1723 vlib_cli_command_t * cmd)
1725 dpdk_main_t * dm = &dpdk_main;
1726 clib_error_t * error = 0;
1727 unformat_input_t _line_input, * line_input = &_line_input;
1728 u32 sw_if_index = ~0;
1730 if (dm->conf->use_virtio_vhost) {
1731 return vhost_user_delete_command_fn(vm, input, cmd);
1734 /* Get a line of input. */
1735 if (! unformat_user (input, unformat_line_input, line_input))
1738 while (unformat_check_input (line_input) != UNFORMAT_END_OF_INPUT) {
1739 if (unformat (line_input, "sw_if_index %d", &sw_if_index))
1742 return clib_error_return (0, "unknown input `%U'",
1743 format_unformat_error, input);
1745 unformat_free (line_input);
1747 if (sw_if_index == ~0) {
1748 error = clib_error_return (0, "invalid sw_if_index",
1749 format_unformat_error, input);
1753 vnet_main_t *vnm = vnet_get_main();
1755 dpdk_vhost_user_delete_if(vnm, vm, sw_if_index);
1760 VLIB_CLI_COMMAND (dpdk_vhost_user_delete_command, static) = {
1761 .path = "delete vhost-user",
1762 .short_help = "delete vhost-user sw_if_index <nn>",
1763 .function = dpdk_vhost_user_delete_command_fn,
1766 #define foreach_dpdk_vhost_feature \
1767 _ (VIRTIO_NET_F_MRG_RXBUF) \
1768 _ (VIRTIO_NET_F_CTRL_VQ) \
1769 _ (VIRTIO_NET_F_CTRL_RX)
1771 static clib_error_t *
1772 show_dpdk_vhost_user_command_fn (vlib_main_t * vm,
1773 unformat_input_t * input,
1774 vlib_cli_command_t * cmd)
1776 clib_error_t * error = 0;
1777 dpdk_main_t * dm = &dpdk_main;
1778 vnet_main_t * vnm = vnet_get_main();
1780 dpdk_vu_intf_t * vui;
1781 struct virtio_net * vhost_dev;
1782 u32 hw_if_index, * hw_if_indices = 0;
1783 vnet_hw_interface_t * hi;
1786 struct virtio_memory * mem;
1787 struct feat_struct { u8 bit; char *str;};
1788 struct feat_struct *feat_entry;
1790 static struct feat_struct feat_array[] = {
1791 #define _(f) { .str = #f, .bit = f, },
1792 foreach_dpdk_vhost_feature
1797 if (dm->conf->use_virtio_vhost) {
1798 return show_vhost_user_command_fn(vm, input, cmd);
1801 while (unformat_check_input (input) != UNFORMAT_END_OF_INPUT) {
1802 if (unformat (input, "%U", unformat_vnet_hw_interface, vnm, &hw_if_index)) {
1803 vec_add1 (hw_if_indices, hw_if_index);
1804 vlib_cli_output(vm, "add %d", hw_if_index);
1806 else if (unformat (input, "descriptors") || unformat (input, "desc") )
1809 error = clib_error_return (0, "unknown input `%U'",
1810 format_unformat_error, input);
1814 if (vec_len (hw_if_indices) == 0) {
1815 vec_foreach (xd, dm->devices) {
1816 if (xd->dev_type == VNET_DPDK_DEV_VHOST_USER && xd->vu_intf->active)
1817 vec_add1(hw_if_indices, xd->vlib_hw_if_index);
1821 vlib_cli_output (vm, "DPDK vhost-user interfaces");
1822 vlib_cli_output (vm, "Global:\n coalesce frames %d time %e\n\n",
1823 dm->conf->vhost_coalesce_frames, dm->conf->vhost_coalesce_time);
1825 for (i = 0; i < vec_len (hw_if_indices); i++) {
1826 hi = vnet_get_hw_interface (vnm, hw_if_indices[i]);
1828 if (!(xd = dpdk_vhost_user_device_from_hw_if_index(hw_if_indices[i]))) {
1829 error = clib_error_return (0, "not dpdk vhost-user interface: '%s'",
1834 vhost_dev = &xd->vu_vhost_dev;
1835 mem = vhost_dev->mem;
1836 u32 virtio_net_hdr_sz = (vui->num_vrings > 0 ?
1837 vhost_dev->virtqueue[0]->vhost_hlen : 0);
1839 vlib_cli_output (vm, "Interface: %v (ifindex %d)",
1840 hi->name, hw_if_indices[i]);
1842 vlib_cli_output (vm, "virtio_net_hdr_sz %d\n features (0x%llx): \n",
1843 virtio_net_hdr_sz, xd->vu_vhost_dev.features);
1845 feat_entry = (struct feat_struct *) &feat_array;
1846 while(feat_entry->str) {
1847 if (xd->vu_vhost_dev.features & (1 << feat_entry->bit))
1848 vlib_cli_output (vm, " %s (%d)", feat_entry->str, feat_entry->bit);
1852 vlib_cli_output (vm, "\n");
1854 vlib_cli_output (vm, " socket filename %s type %s errno \"%s\"\n\n",
1855 vui->sock_filename, vui->sock_is_server ? "server" : "client",
1856 strerror(vui->sock_errno));
1858 vlib_cli_output (vm, " Memory regions (total %d)\n", mem->nregions);
1861 vlib_cli_output(vm, " region fd guest_phys_addr memory_size userspace_addr mmap_offset mmap_addr\n");
1862 vlib_cli_output(vm, " ====== ===== ================== ================== ================== ================== ==================\n");
1864 for (j = 0; j < mem->nregions; j++) {
1865 vlib_cli_output(vm, " %d %-5d 0x%016lx 0x%016lx 0x%016lx 0x%016lx 0x%016lx\n", j,
1867 mem->regions[j].guest_phys_address,
1868 mem->regions[j].memory_size,
1869 mem->regions[j].userspace_address,
1870 mem->regions[j].address_offset,
1871 vui->region_addr[j]);
1873 for (q = 0; q < vui->num_vrings; q++) {
1874 struct vhost_virtqueue *vq = vhost_dev->virtqueue[q];
1875 const char *qtype = (q & 1) ? "TX" : "RX";
1877 vlib_cli_output(vm, "\n Virtqueue %d (%s)\n", q/2, qtype);
1879 vlib_cli_output(vm, " qsz %d last_used_idx %d last_used_idx_res %d\n",
1880 vq->size, vq->last_used_idx, vq->last_used_idx_res);
1882 if (vq->avail && vq->used)
1883 vlib_cli_output(vm, " avail.flags %x avail.idx %d used.flags %x used.idx %d\n",
1884 vq->avail->flags, vq->avail->idx, vq->used->flags, vq->used->idx);
1886 #if RTE_VERSION >= RTE_VERSION_NUM(2, 2, 0, 0)
1887 vlib_cli_output(vm, " kickfd %d callfd %d errfd %d enabled %d\n",
1888 vq->kickfd, vq->callfd, vui->vrings[q].errfd, vq->enabled);
1890 if (show_descr && vq->enabled) {
1892 vlib_cli_output(vm, " kickfd %d callfd %d errfd\n",
1893 vq->kickfd, vq->callfd, vui->vrings[q].errfd);
1897 vlib_cli_output(vm, "\n descriptor table:\n");
1898 vlib_cli_output(vm, " id addr len flags next user_addr\n");
1899 vlib_cli_output(vm, " ===== ================== ===== ====== ===== ==================\n");
1900 for(j = 0; j < vq->size; j++) {
1901 vlib_cli_output(vm, " %-5d 0x%016lx %-5d 0x%04x %-5d 0x%016lx\n",
1907 pointer_to_uword(map_guest_mem(xd, vq->desc[j].addr)));}
1910 vlib_cli_output (vm, "\n");
1913 vec_free (hw_if_indices);
1917 VLIB_CLI_COMMAND (show_vhost_user_command, static) = {
1918 .path = "show vhost-user",
1919 .short_help = "show vhost-user interface",
1920 .function = show_dpdk_vhost_user_command_fn,