lib/librte_vhost/vhost.h

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2010-2018 Intel Corporation
   3  */
   4
   5 #ifndef _VHOST_NET_CDEV_H_
   6 #define _VHOST_NET_CDEV_H_
   7 #include <stdint.h>
   8 #include <stdio.h>
   9 #include <stdbool.h>
  10 #include <sys/types.h>
  11 #include <sys/queue.h>
  12 #include <unistd.h>
  13 #include <linux/vhost.h>
  14 #include <linux/virtio_net.h>
  15 #include <sys/socket.h>
  16 #include <linux/if.h>
  17
  18 #include <rte_log.h>
  19 #include <rte_ether.h>
  20 #include <rte_rwlock.h>
  21 #include <rte_malloc.h>
  22
  23 #include "rte_vhost.h"
  24 #include "rte_vdpa.h"
  25
  26 /* Used to indicate that the device is running on a data core */
  27 #define VIRTIO_DEV_RUNNING 1
  28 /* Used to indicate that the device is ready to operate */
  29 #define VIRTIO_DEV_READY 2
  30 /* Used to indicate that the built-in vhost net device backend is enabled */
  31 #define VIRTIO_DEV_BUILTIN_VIRTIO_NET 4
  32 /* Used to indicate that the device has its own data path and configured */
  33 #define VIRTIO_DEV_VDPA_CONFIGURED 8
  34
  35 /* Backend value set by guest. */
  36 #define VIRTIO_DEV_STOPPED -1
  37
  38 #define BUF_VECTOR_MAX 256
  39
  40 #define VHOST_LOG_CACHE_NR 32
  41
  42 /**
  43  * Structure contains buffer address, length and descriptor index
  44  * from vring to do scatter RX.
  45  */
  46 struct buf_vector {
  47         uint64_t buf_iova;
  48         uint64_t buf_addr;
  49         uint32_t buf_len;
  50         uint32_t desc_idx;
  51 };
  52
  53 /*
  54  * A structure to hold some fields needed in zero copy code path,
  55  * mainly for associating an mbuf with the right desc_idx.
  56  */
  57 struct zcopy_mbuf {
  58         struct rte_mbuf *mbuf;
  59         uint32_t desc_idx;
  60         uint16_t desc_count;
  61         uint16_t in_use;
  62
  63         TAILQ_ENTRY(zcopy_mbuf) next;
  64 };
  65 TAILQ_HEAD(zcopy_mbuf_list, zcopy_mbuf);
  66
  67 /*
  68  * Structure contains the info for each batched memory copy.
  69  */
  70 struct batch_copy_elem {
  71         void *dst;
  72         void *src;
  73         uint32_t len;
  74         uint64_t log_addr;
  75 };
  76
  77 /*
  78  * Structure that contains the info for batched dirty logging.
  79  */
  80 struct log_cache_entry {
  81         uint32_t offset;
  82         unsigned long val;
  83 };
  84
  85 struct vring_used_elem_packed {
  86         uint16_t id;
  87         uint32_t len;
  88         uint32_t count;
  89 };
  90
  91 /**
  92  * Structure contains variables relevant to RX/TX virtqueues.
  93  */
  94 struct vhost_virtqueue {
  95         union {
  96                 struct vring_desc       *desc;
  97                 struct vring_packed_desc   *desc_packed;
  98         };
  99         union {
 100                 struct vring_avail      *avail;
 101                 struct vring_packed_desc_event *driver_event;
 102         };
 103         union {
 104                 struct vring_used       *used;
 105                 struct vring_packed_desc_event *device_event;
 106         };
 107         uint32_t                size;
 108
 109         uint16_t                last_avail_idx;
 110         uint16_t                last_used_idx;
 111         /* Last used index we notify to front end. */
 112         uint16_t                signalled_used;
 113         bool                    signalled_used_valid;
 114 #define VIRTIO_INVALID_EVENTFD          (-1)
 115 #define VIRTIO_UNINITIALIZED_EVENTFD    (-2)
 116
 117         /* Backend value to determine if device should started/stopped */
 118         int                     backend;
 119         int                     enabled;
 120         int                     access_ok;
 121         rte_spinlock_t          access_lock;
 122
 123         /* Used to notify the guest (trigger interrupt) */
 124         int                     callfd;
 125         /* Currently unused as polling mode is enabled */
 126         int                     kickfd;
 127
 128         /* Physical address of used ring, for logging */
 129         uint64_t                log_guest_addr;
 130
 131         uint16_t                nr_zmbuf;
 132         uint16_t                zmbuf_size;
 133         uint16_t                last_zmbuf_idx;
 134         struct zcopy_mbuf       *zmbufs;
 135         struct zcopy_mbuf_list  zmbuf_list;
 136
 137         union {
 138                 struct vring_used_elem  *shadow_used_split;
 139                 struct vring_used_elem_packed *shadow_used_packed;
 140         };
 141         uint16_t                shadow_used_idx;
 142         struct vhost_vring_addr ring_addrs;
 143
 144         struct batch_copy_elem  *batch_copy_elems;
 145         uint16_t                batch_copy_nb_elems;
 146         bool                    used_wrap_counter;
 147         bool                    avail_wrap_counter;
 148
 149         struct log_cache_entry log_cache[VHOST_LOG_CACHE_NR];
 150         uint16_t log_cache_nb_elem;
 151
 152         rte_rwlock_t    iotlb_lock;
 153         rte_rwlock_t    iotlb_pending_lock;
 154         struct rte_mempool *iotlb_pool;
 155         TAILQ_HEAD(, vhost_iotlb_entry) iotlb_list;
 156         int                             iotlb_cache_nr;
 157         TAILQ_HEAD(, vhost_iotlb_entry) iotlb_pending_list;
 158 } __rte_cache_aligned;
 159
 160 /* Old kernels have no such macros defined */
 161 #ifndef VIRTIO_NET_F_GUEST_ANNOUNCE
 162  #define VIRTIO_NET_F_GUEST_ANNOUNCE 21
 163 #endif
 164
 165 #ifndef VIRTIO_NET_F_MQ
 166  #define VIRTIO_NET_F_MQ                22
 167 #endif
 168
 169 #define VHOST_MAX_VRING                 0x100
 170 #define VHOST_MAX_QUEUE_PAIRS           0x80
 171
 172 #ifndef VIRTIO_NET_F_MTU
 173  #define VIRTIO_NET_F_MTU 3
 174 #endif
 175
 176 #ifndef VIRTIO_F_ANY_LAYOUT
 177  #define VIRTIO_F_ANY_LAYOUT            27
 178 #endif
 179
 180 /* Declare IOMMU related bits for older kernels */
 181 #ifndef VIRTIO_F_IOMMU_PLATFORM
 182
 183 #define VIRTIO_F_IOMMU_PLATFORM 33
 184
 185 struct vhost_iotlb_msg {
 186         __u64 iova;
 187         __u64 size;
 188         __u64 uaddr;
 189 #define VHOST_ACCESS_RO      0x1
 190 #define VHOST_ACCESS_WO      0x2
 191 #define VHOST_ACCESS_RW      0x3
 192         __u8 perm;
 193 #define VHOST_IOTLB_MISS           1
 194 #define VHOST_IOTLB_UPDATE         2
 195 #define VHOST_IOTLB_INVALIDATE     3
 196 #define VHOST_IOTLB_ACCESS_FAIL    4
 197         __u8 type;
 198 };
 199
 200 #define VHOST_IOTLB_MSG 0x1
 201
 202 struct vhost_msg {
 203         int type;
 204         union {
 205                 struct vhost_iotlb_msg iotlb;
 206                 __u8 padding[64];
 207         };
 208 };
 209 #endif
 210
 211 /*
 212  * Define virtio 1.0 for older kernels
 213  */
 214 #ifndef VIRTIO_F_VERSION_1
 215  #define VIRTIO_F_VERSION_1 32
 216 #endif
 217
 218 /* Declare packed ring related bits for older kernels */
 219 #ifndef VIRTIO_F_RING_PACKED
 220
 221 #define VIRTIO_F_RING_PACKED 34
 222
 223 struct vring_packed_desc {
 224         uint64_t addr;
 225         uint32_t len;
 226         uint16_t id;
 227         uint16_t flags;
 228 };
 229
 230 struct vring_packed_desc_event {
 231         uint16_t off_wrap;
 232         uint16_t flags;
 233 };
 234 #endif
 235
 236 /*
 237  * Declare below packed ring defines unconditionally
 238  * as Kernel header might use different names.
 239  */
 240 #define VRING_DESC_F_AVAIL      (1ULL << 7)
 241 #define VRING_DESC_F_USED       (1ULL << 15)
 242
 243 #define VRING_EVENT_F_ENABLE 0x0
 244 #define VRING_EVENT_F_DISABLE 0x1
 245 #define VRING_EVENT_F_DESC 0x2
 246
 247 /*
 248  * Available and used descs are in same order
 249  */
 250 #ifndef VIRTIO_F_IN_ORDER
 251 #define VIRTIO_F_IN_ORDER      35
 252 #endif
 253
 254 /* Features supported by this builtin vhost-user net driver. */
 255 #define VIRTIO_NET_SUPPORTED_FEATURES ((1ULL << VIRTIO_NET_F_MRG_RXBUF) | \
 256                                 (1ULL << VIRTIO_F_ANY_LAYOUT) | \
 257                                 (1ULL << VIRTIO_NET_F_CTRL_VQ) | \
 258                                 (1ULL << VIRTIO_NET_F_CTRL_RX) | \
 259                                 (1ULL << VIRTIO_NET_F_GUEST_ANNOUNCE) | \
 260                                 (1ULL << VIRTIO_NET_F_MQ)      | \
 261                                 (1ULL << VIRTIO_F_VERSION_1)   | \
 262                                 (1ULL << VHOST_F_LOG_ALL)      | \
 263                                 (1ULL << VHOST_USER_F_PROTOCOL_FEATURES) | \
 264                                 (1ULL << VIRTIO_NET_F_GSO) | \
 265                                 (1ULL << VIRTIO_NET_F_HOST_TSO4) | \
 266                                 (1ULL << VIRTIO_NET_F_HOST_TSO6) | \
 267                                 (1ULL << VIRTIO_NET_F_HOST_UFO) | \
 268                                 (1ULL << VIRTIO_NET_F_HOST_ECN) | \
 269                                 (1ULL << VIRTIO_NET_F_CSUM)    | \
 270                                 (1ULL << VIRTIO_NET_F_GUEST_CSUM) | \
 271                                 (1ULL << VIRTIO_NET_F_GUEST_TSO4) | \
 272                                 (1ULL << VIRTIO_NET_F_GUEST_TSO6) | \
 273                                 (1ULL << VIRTIO_NET_F_GUEST_UFO) | \
 274                                 (1ULL << VIRTIO_NET_F_GUEST_ECN) | \
 275                                 (1ULL << VIRTIO_RING_F_INDIRECT_DESC) | \
 276                                 (1ULL << VIRTIO_RING_F_EVENT_IDX) | \
 277                                 (1ULL << VIRTIO_NET_F_MTU)  | \
 278                                 (1ULL << VIRTIO_F_IN_ORDER) | \
 279                                 (1ULL << VIRTIO_F_IOMMU_PLATFORM) | \
 280                                 (1ULL << VIRTIO_F_RING_PACKED))
 281
 282
 283 struct guest_page {
 284         uint64_t guest_phys_addr;
 285         uint64_t host_phys_addr;
 286         uint64_t size;
 287 };
 288
 289 /**
 290  * Device structure contains all configuration information relating
 291  * to the device.
 292  */
 293 struct virtio_net {
 294         /* Frontend (QEMU) memory and memory region information */
 295         struct rte_vhost_memory *mem;
 296         uint64_t                features;
 297         uint64_t                protocol_features;
 298         int                     vid;
 299         uint32_t                flags;
 300         uint16_t                vhost_hlen;
 301         /* to tell if we need broadcast rarp packet */
 302         rte_atomic16_t          broadcast_rarp;
 303         uint32_t                nr_vring;
 304         int                     dequeue_zero_copy;
 305         struct vhost_virtqueue  *virtqueue[VHOST_MAX_QUEUE_PAIRS * 2];
 306 #define IF_NAME_SZ (PATH_MAX > IFNAMSIZ ? PATH_MAX : IFNAMSIZ)
 307         char                    ifname[IF_NAME_SZ];
 308         uint64_t                log_size;
 309         uint64_t                log_base;
 310         uint64_t                log_addr;
 311         struct rte_ether_addr   mac;
 312         uint16_t                mtu;
 313
 314         struct vhost_device_ops const *notify_ops;
 315
 316         uint32_t                nr_guest_pages;
 317         uint32_t                max_guest_pages;
 318         struct guest_page       *guest_pages;
 319
 320         int                     slave_req_fd;
 321         rte_spinlock_t          slave_req_lock;
 322
 323         int                     postcopy_ufd;
 324         int                     postcopy_listening;
 325
 326         /*
 327          * Device id to identify a specific backend device.
 328          * It's set to -1 for the default software implementation.
 329          */
 330         int                     vdpa_dev_id;
 331
 332         /* context data for the external message handlers */
 333         void                    *extern_data;
 334         /* pre and post vhost user message handlers for the device */
 335         struct rte_vhost_user_extern_ops extern_ops;
 336 } __rte_cache_aligned;
 337
 338 static __rte_always_inline bool
 339 vq_is_packed(struct virtio_net *dev)
 340 {
 341         return dev->features & (1ull << VIRTIO_F_RING_PACKED);
 342 }
 343
 344 static inline bool
 345 desc_is_avail(struct vring_packed_desc *desc, bool wrap_counter)
 346 {
 347         uint16_t flags = *((volatile uint16_t *) &desc->flags);
 348
 349         return wrap_counter == !!(flags & VRING_DESC_F_AVAIL) &&
 350                 wrap_counter != !!(flags & VRING_DESC_F_USED);
 351 }
 352
 353 #define VHOST_LOG_PAGE  4096
 354
 355 /*
 356  * Atomically set a bit in memory.
 357  */
 358 static __rte_always_inline void
 359 vhost_set_bit(unsigned int nr, volatile uint8_t *addr)
 360 {
 361 #if defined(RTE_TOOLCHAIN_GCC) && (GCC_VERSION < 70100)
 362         /*
 363          * __sync_ built-ins are deprecated, but __atomic_ ones
 364          * are sub-optimized in older GCC versions.
 365          */
 366         __sync_fetch_and_or_1(addr, (1U << nr));
 367 #else
 368         __atomic_fetch_or(addr, (1U << nr), __ATOMIC_RELAXED);
 369 #endif
 370 }
 371
 372 static __rte_always_inline void
 373 vhost_log_page(uint8_t *log_base, uint64_t page)
 374 {
 375         vhost_set_bit(page % 8, &log_base[page / 8]);
 376 }
 377
 378 static __rte_always_inline void
 379 vhost_log_write(struct virtio_net *dev, uint64_t addr, uint64_t len)
 380 {
 381         uint64_t page;
 382
 383         if (likely(((dev->features & (1ULL << VHOST_F_LOG_ALL)) == 0) ||
 384                    !dev->log_base || !len))
 385                 return;
 386
 387         if (unlikely(dev->log_size <= ((addr + len - 1) / VHOST_LOG_PAGE / 8)))
 388                 return;
 389
 390         /* To make sure guest memory updates are committed before logging */
 391         rte_smp_wmb();
 392
 393         page = addr / VHOST_LOG_PAGE;
 394         while (page * VHOST_LOG_PAGE < addr + len) {
 395                 vhost_log_page((uint8_t *)(uintptr_t)dev->log_base, page);
 396                 page += 1;
 397         }
 398 }
 399
 400 static __rte_always_inline void
 401 vhost_log_cache_sync(struct virtio_net *dev, struct vhost_virtqueue *vq)
 402 {
 403         unsigned long *log_base;
 404         int i;
 405
 406         if (likely(((dev->features & (1ULL << VHOST_F_LOG_ALL)) == 0) ||
 407                    !dev->log_base))
 408                 return;
 409
 410         rte_smp_wmb();
 411
 412         log_base = (unsigned long *)(uintptr_t)dev->log_base;
 413
 414         for (i = 0; i < vq->log_cache_nb_elem; i++) {
 415                 struct log_cache_entry *elem = vq->log_cache + i;
 416
 417 #if defined(RTE_TOOLCHAIN_GCC) && (GCC_VERSION < 70100)
 418                 /*
 419                  * '__sync' builtins are deprecated, but '__atomic' ones
 420                  * are sub-optimized in older GCC versions.
 421                  */
 422                 __sync_fetch_and_or(log_base + elem->offset, elem->val);
 423 #else
 424                 __atomic_fetch_or(log_base + elem->offset, elem->val,
 425                                 __ATOMIC_RELAXED);
 426 #endif
 427         }
 428
 429         rte_smp_wmb();
 430
 431         vq->log_cache_nb_elem = 0;
 432 }
 433
 434 static __rte_always_inline void
 435 vhost_log_cache_page(struct virtio_net *dev, struct vhost_virtqueue *vq,
 436                         uint64_t page)
 437 {
 438         uint32_t bit_nr = page % (sizeof(unsigned long) << 3);
 439         uint32_t offset = page / (sizeof(unsigned long) << 3);
 440         int i;
 441
 442         for (i = 0; i < vq->log_cache_nb_elem; i++) {
 443                 struct log_cache_entry *elem = vq->log_cache + i;
 444
 445                 if (elem->offset == offset) {
 446                         elem->val |= (1UL << bit_nr);
 447                         return;
 448                 }
 449         }
 450
 451         if (unlikely(i >= VHOST_LOG_CACHE_NR)) {
 452                 /*
 453                  * No more room for a new log cache entry,
 454                  * so write the dirty log map directly.
 455                  */
 456                 rte_smp_wmb();
 457                 vhost_log_page((uint8_t *)(uintptr_t)dev->log_base, page);
 458
 459                 return;
 460         }
 461
 462         vq->log_cache[i].offset = offset;
 463         vq->log_cache[i].val = (1UL << bit_nr);
 464         vq->log_cache_nb_elem++;
 465 }
 466
 467 static __rte_always_inline void
 468 vhost_log_cache_write(struct virtio_net *dev, struct vhost_virtqueue *vq,
 469                         uint64_t addr, uint64_t len)
 470 {
 471         uint64_t page;
 472
 473         if (likely(((dev->features & (1ULL << VHOST_F_LOG_ALL)) == 0) ||
 474                    !dev->log_base || !len))
 475                 return;
 476
 477         if (unlikely(dev->log_size <= ((addr + len - 1) / VHOST_LOG_PAGE / 8)))
 478                 return;
 479
 480         page = addr / VHOST_LOG_PAGE;
 481         while (page * VHOST_LOG_PAGE < addr + len) {
 482                 vhost_log_cache_page(dev, vq, page);
 483                 page += 1;
 484         }
 485 }
 486
 487 static __rte_always_inline void
 488 vhost_log_cache_used_vring(struct virtio_net *dev, struct vhost_virtqueue *vq,
 489                         uint64_t offset, uint64_t len)
 490 {
 491         vhost_log_cache_write(dev, vq, vq->log_guest_addr + offset, len);
 492 }
 493
 494 static __rte_always_inline void
 495 vhost_log_used_vring(struct virtio_net *dev, struct vhost_virtqueue *vq,
 496                      uint64_t offset, uint64_t len)
 497 {
 498         vhost_log_write(dev, vq->log_guest_addr + offset, len);
 499 }
 500
 501 /* Macros for printing using RTE_LOG */
 502 #define RTE_LOGTYPE_VHOST_CONFIG RTE_LOGTYPE_USER1
 503 #define RTE_LOGTYPE_VHOST_DATA   RTE_LOGTYPE_USER1
 504
 505 #ifdef RTE_LIBRTE_VHOST_DEBUG
 506 #define VHOST_MAX_PRINT_BUFF 6072
 507 #define VHOST_LOG_DEBUG(log_type, fmt, args...) \
 508         RTE_LOG(DEBUG, log_type, fmt, ##args)
 509 #define PRINT_PACKET(device, addr, size, header) do { \
 510         char *pkt_addr = (char *)(addr); \
 511         unsigned int index; \
 512         char packet[VHOST_MAX_PRINT_BUFF]; \
 513         \
 514         if ((header)) \
 515                 snprintf(packet, VHOST_MAX_PRINT_BUFF, "(%d) Header size %d: ", (device->vid), (size)); \
 516         else \
 517                 snprintf(packet, VHOST_MAX_PRINT_BUFF, "(%d) Packet size %d: ", (device->vid), (size)); \
 518         for (index = 0; index < (size); index++) { \
 519                 snprintf(packet + strnlen(packet, VHOST_MAX_PRINT_BUFF), VHOST_MAX_PRINT_BUFF - strnlen(packet, VHOST_MAX_PRINT_BUFF), \
 520                         "%02hhx ", pkt_addr[index]); \
 521         } \
 522         snprintf(packet + strnlen(packet, VHOST_MAX_PRINT_BUFF), VHOST_MAX_PRINT_BUFF - strnlen(packet, VHOST_MAX_PRINT_BUFF), "\n"); \
 523         \
 524         VHOST_LOG_DEBUG(VHOST_DATA, "%s", packet); \
 525 } while (0)
 526 #else
 527 #define VHOST_LOG_DEBUG(log_type, fmt, args...) do {} while (0)
 528 #define PRINT_PACKET(device, addr, size, header) do {} while (0)
 529 #endif
 530
 531 extern uint64_t VHOST_FEATURES;
 532 #define MAX_VHOST_DEVICE        1024
 533 extern struct virtio_net *vhost_devices[MAX_VHOST_DEVICE];
 534
 535 /* Convert guest physical address to host physical address */
 536 static __rte_always_inline rte_iova_t
 537 gpa_to_hpa(struct virtio_net *dev, uint64_t gpa, uint64_t size)
 538 {
 539         uint32_t i;
 540         struct guest_page *page;
 541
 542         for (i = 0; i < dev->nr_guest_pages; i++) {
 543                 page = &dev->guest_pages[i];
 544
 545                 if (gpa >= page->guest_phys_addr &&
 546                     gpa + size < page->guest_phys_addr + page->size) {
 547                         return gpa - page->guest_phys_addr +
 548                                page->host_phys_addr;
 549                 }
 550         }
 551
 552         return 0;
 553 }
 554
 555 static __rte_always_inline struct virtio_net *
 556 get_device(int vid)
 557 {
 558         struct virtio_net *dev = vhost_devices[vid];
 559
 560         if (unlikely(!dev)) {
 561                 RTE_LOG(ERR, VHOST_CONFIG,
 562                         "(%d) device not found.\n", vid);
 563         }
 564
 565         return dev;
 566 }
 567
 568 int vhost_new_device(void);
 569 void cleanup_device(struct virtio_net *dev, int destroy);
 570 void reset_device(struct virtio_net *dev);
 571 void vhost_destroy_device(int);
 572 void vhost_destroy_device_notify(struct virtio_net *dev);
 573
 574 void cleanup_vq(struct vhost_virtqueue *vq, int destroy);
 575 void free_vq(struct virtio_net *dev, struct vhost_virtqueue *vq);
 576
 577 int alloc_vring_queue(struct virtio_net *dev, uint32_t vring_idx);
 578
 579 void vhost_attach_vdpa_device(int vid, int did);
 580
 581 void vhost_set_ifname(int, const char *if_name, unsigned int if_len);
 582 void vhost_enable_dequeue_zero_copy(int vid);
 583 void vhost_set_builtin_virtio_net(int vid, bool enable);
 584
 585 struct vhost_device_ops const *vhost_driver_callback_get(const char *path);
 586
 587 /*
 588  * Backend-specific cleanup.
 589  *
 590  * TODO: fix it; we have one backend now
 591  */
 592 void vhost_backend_cleanup(struct virtio_net *dev);
 593
 594 uint64_t __vhost_iova_to_vva(struct virtio_net *dev, struct vhost_virtqueue *vq,
 595                         uint64_t iova, uint64_t *len, uint8_t perm);
 596 int vring_translate(struct virtio_net *dev, struct vhost_virtqueue *vq);
 597 void vring_invalidate(struct virtio_net *dev, struct vhost_virtqueue *vq);
 598
 599 static __rte_always_inline uint64_t
 600 vhost_iova_to_vva(struct virtio_net *dev, struct vhost_virtqueue *vq,
 601                         uint64_t iova, uint64_t *len, uint8_t perm)
 602 {
 603         if (!(dev->features & (1ULL << VIRTIO_F_IOMMU_PLATFORM)))
 604                 return rte_vhost_va_from_guest_pa(dev->mem, iova, len);
 605
 606         return __vhost_iova_to_vva(dev, vq, iova, len, perm);
 607 }
 608
 609 #define vhost_avail_event(vr) \
 610         (*(volatile uint16_t*)&(vr)->used->ring[(vr)->size])
 611 #define vhost_used_event(vr) \
 612         (*(volatile uint16_t*)&(vr)->avail->ring[(vr)->size])
 613
 614 /*
 615  * The following is used with VIRTIO_RING_F_EVENT_IDX.
 616  * Assuming a given event_idx value from the other size, if we have
 617  * just incremented index from old to new_idx, should we trigger an
 618  * event?
 619  */
 620 static __rte_always_inline int
 621 vhost_need_event(uint16_t event_idx, uint16_t new_idx, uint16_t old)
 622 {
 623         return (uint16_t)(new_idx - event_idx - 1) < (uint16_t)(new_idx - old);
 624 }
 625
 626 static __rte_always_inline void
 627 vhost_vring_call_split(struct virtio_net *dev, struct vhost_virtqueue *vq)
 628 {
 629         /* Flush used->idx update before we read avail->flags. */
 630         rte_smp_mb();
 631
 632         /* Don't kick guest if we don't reach index specified by guest. */
 633         if (dev->features & (1ULL << VIRTIO_RING_F_EVENT_IDX)) {
 634                 uint16_t old = vq->signalled_used;
 635                 uint16_t new = vq->last_used_idx;
 636                 bool signalled_used_valid = vq->signalled_used_valid;
 637
 638                 vq->signalled_used = new;
 639                 vq->signalled_used_valid = true;
 640
 641                 VHOST_LOG_DEBUG(VHOST_DATA, "%s: used_event_idx=%d, old=%d, new=%d\n",
 642                         __func__,
 643                         vhost_used_event(vq),
 644                         old, new);
 645
 646                 if ((vhost_need_event(vhost_used_event(vq), new, old) &&
 647                                         (vq->callfd >= 0)) ||
 648                                 unlikely(!signalled_used_valid))
 649                         eventfd_write(vq->callfd, (eventfd_t) 1);
 650         } else {
 651                 /* Kick the guest if necessary. */
 652                 if (!(vq->avail->flags & VRING_AVAIL_F_NO_INTERRUPT)
 653                                 && (vq->callfd >= 0))
 654                         eventfd_write(vq->callfd, (eventfd_t)1);
 655         }
 656 }
 657
 658 static __rte_always_inline void
 659 vhost_vring_call_packed(struct virtio_net *dev, struct vhost_virtqueue *vq)
 660 {
 661         uint16_t old, new, off, off_wrap;
 662         bool signalled_used_valid, kick = false;
 663
 664         /* Flush used desc update. */
 665         rte_smp_mb();
 666
 667         if (!(dev->features & (1ULL << VIRTIO_RING_F_EVENT_IDX))) {
 668                 if (vq->driver_event->flags !=
 669                                 VRING_EVENT_F_DISABLE)
 670                         kick = true;
 671                 goto kick;
 672         }
 673
 674         old = vq->signalled_used;
 675         new = vq->last_used_idx;
 676         vq->signalled_used = new;
 677         signalled_used_valid = vq->signalled_used_valid;
 678         vq->signalled_used_valid = true;
 679
 680         if (vq->driver_event->flags != VRING_EVENT_F_DESC) {
 681                 if (vq->driver_event->flags != VRING_EVENT_F_DISABLE)
 682                         kick = true;
 683                 goto kick;
 684         }
 685
 686         if (unlikely(!signalled_used_valid)) {
 687                 kick = true;
 688                 goto kick;
 689         }
 690
 691         rte_smp_rmb();
 692
 693         off_wrap = vq->driver_event->off_wrap;
 694         off = off_wrap & ~(1 << 15);
 695
 696         if (new <= old)
 697                 old -= vq->size;
 698
 699         if (vq->used_wrap_counter != off_wrap >> 15)
 700                 off -= vq->size;
 701
 702         if (vhost_need_event(off, new, old))
 703                 kick = true;
 704 kick:
 705         if (kick)
 706                 eventfd_write(vq->callfd, (eventfd_t)1);
 707 }
 708
 709 static __rte_always_inline void *
 710 alloc_copy_ind_table(struct virtio_net *dev, struct vhost_virtqueue *vq,
 711                 uint64_t desc_addr, uint64_t desc_len)
 712 {
 713         void *idesc;
 714         uint64_t src, dst;
 715         uint64_t len, remain = desc_len;
 716
 717         idesc = rte_malloc(__func__, desc_len, 0);
 718         if (unlikely(!idesc))
 719                 return 0;
 720
 721         dst = (uint64_t)(uintptr_t)idesc;
 722
 723         while (remain) {
 724                 len = remain;
 725                 src = vhost_iova_to_vva(dev, vq, desc_addr, &len,
 726                                 VHOST_ACCESS_RO);
 727                 if (unlikely(!src || !len)) {
 728                         rte_free(idesc);
 729                         return 0;
 730                 }
 731
 732                 rte_memcpy((void *)(uintptr_t)dst, (void *)(uintptr_t)src, len);
 733
 734                 remain -= len;
 735                 dst += len;
 736                 desc_addr += len;
 737         }
 738
 739         return idesc;
 740 }
 741
 742 static __rte_always_inline void
 743 free_ind_table(void *idesc)
 744 {
 745         rte_free(idesc);
 746 }
 747
 748 static __rte_always_inline void
 749 restore_mbuf(struct rte_mbuf *m)
 750 {
 751         uint32_t mbuf_size, priv_size;
 752
 753         while (m) {
 754                 priv_size = rte_pktmbuf_priv_size(m->pool);
 755                 mbuf_size = sizeof(struct rte_mbuf) + priv_size;
 756                 /* start of buffer is after mbuf structure and priv data */
 757
 758                 m->buf_addr = (char *)m + mbuf_size;
 759                 m->buf_iova = rte_mempool_virt2iova(m) + mbuf_size;
 760                 m = m->next;
 761         }
 762 }
 763
 764 static __rte_always_inline bool
 765 mbuf_is_consumed(struct rte_mbuf *m)
 766 {
 767         while (m) {
 768                 if (rte_mbuf_refcnt_read(m) > 1)
 769                         return false;
 770                 m = m->next;
 771         }
 772
 773         return true;
 774 }
 775
 776 static __rte_always_inline void
 777 put_zmbuf(struct zcopy_mbuf *zmbuf)
 778 {
 779         zmbuf->in_use = 0;
 780 }
 781
 782 #endif /* _VHOST_NET_CDEV_H_ */