123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781 |
- /*
- * vhost shadow virtqueue
- *
- * SPDX-FileCopyrightText: Red Hat, Inc. 2021
- * SPDX-FileContributor: Author: Eugenio Pérez <eperezma@redhat.com>
- *
- * SPDX-License-Identifier: GPL-2.0-or-later
- */
- #include "qemu/osdep.h"
- #include "hw/virtio/vhost-shadow-virtqueue.h"
- #include "qemu/error-report.h"
- #include "qapi/error.h"
- #include "qemu/main-loop.h"
- #include "qemu/log.h"
- #include "qemu/memalign.h"
- #include "linux-headers/linux/vhost.h"
- /**
- * Validate the transport device features that both guests can use with the SVQ
- * and SVQs can use with the device.
- *
- * @dev_features: The features
- * @errp: Error pointer
- */
- bool vhost_svq_valid_features(uint64_t features, Error **errp)
- {
- bool ok = true;
- uint64_t svq_features = features;
- for (uint64_t b = VIRTIO_TRANSPORT_F_START; b <= VIRTIO_TRANSPORT_F_END;
- ++b) {
- switch (b) {
- case VIRTIO_F_ANY_LAYOUT:
- case VIRTIO_RING_F_EVENT_IDX:
- continue;
- case VIRTIO_F_ACCESS_PLATFORM:
- /* SVQ trust in the host's IOMMU to translate addresses */
- case VIRTIO_F_VERSION_1:
- /* SVQ trust that the guest vring is little endian */
- if (!(svq_features & BIT_ULL(b))) {
- svq_features |= BIT_ULL(b);
- ok = false;
- }
- continue;
- default:
- if (svq_features & BIT_ULL(b)) {
- svq_features &= ~BIT_ULL(b);
- ok = false;
- }
- }
- }
- if (!ok) {
- error_setg(errp, "SVQ Invalid device feature flags, offer: 0x%"PRIx64
- ", ok: 0x%"PRIx64, features, svq_features);
- }
- return ok;
- }
- /**
- * Number of descriptors that the SVQ can make available from the guest.
- *
- * @svq: The svq
- */
- uint16_t vhost_svq_available_slots(const VhostShadowVirtqueue *svq)
- {
- return svq->num_free;
- }
- /**
- * Translate addresses between the qemu's virtual address and the SVQ IOVA
- *
- * @svq: Shadow VirtQueue
- * @vaddr: Translated IOVA addresses
- * @iovec: Source qemu's VA addresses
- * @num: Length of iovec and minimum length of vaddr
- * @gpas: Descriptors' GPAs, if backed by guest memory
- */
- static bool vhost_svq_translate_addr(const VhostShadowVirtqueue *svq,
- hwaddr *addrs, const struct iovec *iovec,
- size_t num, const hwaddr *gpas)
- {
- if (num == 0) {
- return true;
- }
- for (size_t i = 0; i < num; ++i) {
- Int128 needle_last, map_last;
- size_t off;
- const DMAMap *map;
- DMAMap needle;
- /* Check if the descriptor is backed by guest memory */
- if (gpas) {
- /* Search the GPA->IOVA tree */
- needle = (DMAMap) {
- .translated_addr = gpas[i],
- .size = iovec[i].iov_len,
- };
- map = vhost_iova_tree_find_gpa(svq->iova_tree, &needle);
- } else {
- /* Search the IOVA->HVA tree */
- needle = (DMAMap) {
- .translated_addr = (hwaddr)(uintptr_t)iovec[i].iov_base,
- .size = iovec[i].iov_len,
- };
- map = vhost_iova_tree_find_iova(svq->iova_tree, &needle);
- }
- /*
- * Map cannot be NULL since iova map contains all guest space and
- * qemu already has a physical address mapped
- */
- if (unlikely(!map)) {
- qemu_log_mask(LOG_GUEST_ERROR,
- "Invalid address 0x%"HWADDR_PRIx" given by guest",
- needle.translated_addr);
- return false;
- }
- off = needle.translated_addr - map->translated_addr;
- addrs[i] = map->iova + off;
- needle_last = int128_add(int128_make64(needle.translated_addr),
- int128_makes64(iovec[i].iov_len - 1));
- map_last = int128_make64(map->translated_addr + map->size);
- if (unlikely(int128_gt(needle_last, map_last))) {
- qemu_log_mask(LOG_GUEST_ERROR,
- "Guest buffer expands over iova range");
- return false;
- }
- }
- return true;
- }
- /**
- * Write descriptors to SVQ vring
- *
- * @svq: The shadow virtqueue
- * @sg: Cache for hwaddr
- * @iovec: The iovec from the guest
- * @num: iovec length
- * @addr: Descriptors' GPAs, if backed by guest memory
- * @more_descs: True if more descriptors come in the chain
- * @write: True if they are writeable descriptors
- *
- * Return true if success, false otherwise and print error.
- */
- static bool vhost_svq_vring_write_descs(VhostShadowVirtqueue *svq, hwaddr *sg,
- const struct iovec *iovec, size_t num,
- const hwaddr *addr, bool more_descs,
- bool write)
- {
- uint16_t i = svq->free_head, last = svq->free_head;
- unsigned n;
- uint16_t flags = write ? cpu_to_le16(VRING_DESC_F_WRITE) : 0;
- vring_desc_t *descs = svq->vring.desc;
- bool ok;
- if (num == 0) {
- return true;
- }
- ok = vhost_svq_translate_addr(svq, sg, iovec, num, addr);
- if (unlikely(!ok)) {
- return false;
- }
- for (n = 0; n < num; n++) {
- if (more_descs || (n + 1 < num)) {
- descs[i].flags = flags | cpu_to_le16(VRING_DESC_F_NEXT);
- descs[i].next = cpu_to_le16(svq->desc_next[i]);
- } else {
- descs[i].flags = flags;
- }
- descs[i].addr = cpu_to_le64(sg[n]);
- descs[i].len = cpu_to_le32(iovec[n].iov_len);
- last = i;
- i = svq->desc_next[i];
- }
- svq->free_head = svq->desc_next[last];
- return true;
- }
- static bool vhost_svq_add_split(VhostShadowVirtqueue *svq,
- const struct iovec *out_sg, size_t out_num,
- const hwaddr *out_addr,
- const struct iovec *in_sg, size_t in_num,
- const hwaddr *in_addr, unsigned *head)
- {
- unsigned avail_idx;
- vring_avail_t *avail = svq->vring.avail;
- bool ok;
- g_autofree hwaddr *sgs = g_new(hwaddr, MAX(out_num, in_num));
- *head = svq->free_head;
- /* We need some descriptors here */
- if (unlikely(!out_num && !in_num)) {
- qemu_log_mask(LOG_GUEST_ERROR,
- "Guest provided element with no descriptors");
- return false;
- }
- ok = vhost_svq_vring_write_descs(svq, sgs, out_sg, out_num, out_addr,
- in_num > 0, false);
- if (unlikely(!ok)) {
- return false;
- }
- ok = vhost_svq_vring_write_descs(svq, sgs, in_sg, in_num, in_addr, false,
- true);
- if (unlikely(!ok)) {
- return false;
- }
- /*
- * Put the entry in the available array (but don't update avail->idx until
- * they do sync).
- */
- avail_idx = svq->shadow_avail_idx & (svq->vring.num - 1);
- avail->ring[avail_idx] = cpu_to_le16(*head);
- svq->shadow_avail_idx++;
- /* Update the avail index after write the descriptor */
- smp_wmb();
- avail->idx = cpu_to_le16(svq->shadow_avail_idx);
- return true;
- }
- static void vhost_svq_kick(VhostShadowVirtqueue *svq)
- {
- bool needs_kick;
- /*
- * We need to expose the available array entries before checking the used
- * flags
- */
- smp_mb();
- if (virtio_vdev_has_feature(svq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
- uint16_t avail_event = le16_to_cpu(
- *(uint16_t *)(&svq->vring.used->ring[svq->vring.num]));
- needs_kick = vring_need_event(avail_event, svq->shadow_avail_idx, svq->shadow_avail_idx - 1);
- } else {
- needs_kick =
- !(svq->vring.used->flags & cpu_to_le16(VRING_USED_F_NO_NOTIFY));
- }
- if (!needs_kick) {
- return;
- }
- event_notifier_set(&svq->hdev_kick);
- }
- /**
- * Add an element to a SVQ.
- *
- * Return -EINVAL if element is invalid, -ENOSPC if dev queue is full
- */
- int vhost_svq_add(VhostShadowVirtqueue *svq, const struct iovec *out_sg,
- size_t out_num, const hwaddr *out_addr,
- const struct iovec *in_sg, size_t in_num,
- const hwaddr *in_addr, VirtQueueElement *elem)
- {
- unsigned qemu_head;
- unsigned ndescs = in_num + out_num;
- bool ok;
- if (unlikely(ndescs > vhost_svq_available_slots(svq))) {
- return -ENOSPC;
- }
- ok = vhost_svq_add_split(svq, out_sg, out_num, out_addr, in_sg, in_num,
- in_addr, &qemu_head);
- if (unlikely(!ok)) {
- return -EINVAL;
- }
- svq->num_free -= ndescs;
- svq->desc_state[qemu_head].elem = elem;
- svq->desc_state[qemu_head].ndescs = ndescs;
- vhost_svq_kick(svq);
- return 0;
- }
- /* Convenience wrapper to add a guest's element to SVQ */
- static int vhost_svq_add_element(VhostShadowVirtqueue *svq,
- VirtQueueElement *elem)
- {
- return vhost_svq_add(svq, elem->out_sg, elem->out_num, elem->out_addr,
- elem->in_sg, elem->in_num, elem->in_addr, elem);
- }
- /**
- * Forward available buffers.
- *
- * @svq: Shadow VirtQueue
- *
- * Note that this function does not guarantee that all guest's available
- * buffers are available to the device in SVQ avail ring. The guest may have
- * exposed a GPA / GIOVA contiguous buffer, but it may not be contiguous in
- * qemu vaddr.
- *
- * If that happens, guest's kick notifications will be disabled until the
- * device uses some buffers.
- */
- static void vhost_handle_guest_kick(VhostShadowVirtqueue *svq)
- {
- /* Clear event notifier */
- event_notifier_test_and_clear(&svq->svq_kick);
- /* Forward to the device as many available buffers as possible */
- do {
- virtio_queue_set_notification(svq->vq, false);
- while (true) {
- g_autofree VirtQueueElement *elem = NULL;
- int r;
- if (svq->next_guest_avail_elem) {
- elem = g_steal_pointer(&svq->next_guest_avail_elem);
- } else {
- elem = virtqueue_pop(svq->vq, sizeof(*elem));
- }
- if (!elem) {
- break;
- }
- if (svq->ops) {
- r = svq->ops->avail_handler(svq, elem, svq->ops_opaque);
- } else {
- r = vhost_svq_add_element(svq, elem);
- }
- if (unlikely(r != 0)) {
- if (r == -ENOSPC) {
- /*
- * This condition is possible since a contiguous buffer in
- * GPA does not imply a contiguous buffer in qemu's VA
- * scatter-gather segments. If that happens, the buffer
- * exposed to the device needs to be a chain of descriptors
- * at this moment.
- *
- * SVQ cannot hold more available buffers if we are here:
- * queue the current guest descriptor and ignore kicks
- * until some elements are used.
- */
- svq->next_guest_avail_elem = g_steal_pointer(&elem);
- }
- /* VQ is full or broken, just return and ignore kicks */
- return;
- }
- /* elem belongs to SVQ or external caller now */
- elem = NULL;
- }
- virtio_queue_set_notification(svq->vq, true);
- } while (!virtio_queue_empty(svq->vq));
- }
- /**
- * Handle guest's kick.
- *
- * @n: guest kick event notifier, the one that guest set to notify svq.
- */
- static void vhost_handle_guest_kick_notifier(EventNotifier *n)
- {
- VhostShadowVirtqueue *svq = container_of(n, VhostShadowVirtqueue, svq_kick);
- event_notifier_test_and_clear(n);
- vhost_handle_guest_kick(svq);
- }
- static bool vhost_svq_more_used(VhostShadowVirtqueue *svq)
- {
- uint16_t *used_idx = &svq->vring.used->idx;
- if (svq->last_used_idx != svq->shadow_used_idx) {
- return true;
- }
- svq->shadow_used_idx = le16_to_cpu(*(volatile uint16_t *)used_idx);
- return svq->last_used_idx != svq->shadow_used_idx;
- }
- /**
- * Enable vhost device calls after disable them.
- *
- * @svq: The svq
- *
- * It returns false if there are pending used buffers from the vhost device,
- * avoiding the possible races between SVQ checking for more work and enabling
- * callbacks. True if SVQ used vring has no more pending buffers.
- */
- static bool vhost_svq_enable_notification(VhostShadowVirtqueue *svq)
- {
- if (virtio_vdev_has_feature(svq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
- uint16_t *used_event = (uint16_t *)&svq->vring.avail->ring[svq->vring.num];
- *used_event = cpu_to_le16(svq->shadow_used_idx);
- } else {
- svq->vring.avail->flags &= ~cpu_to_le16(VRING_AVAIL_F_NO_INTERRUPT);
- }
- /* Make sure the event is enabled before the read of used_idx */
- smp_mb();
- return !vhost_svq_more_used(svq);
- }
- static void vhost_svq_disable_notification(VhostShadowVirtqueue *svq)
- {
- /*
- * No need to disable notification in the event idx case, since used event
- * index is already an index too far away.
- */
- if (!virtio_vdev_has_feature(svq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
- svq->vring.avail->flags |= cpu_to_le16(VRING_AVAIL_F_NO_INTERRUPT);
- }
- }
- static uint16_t vhost_svq_last_desc_of_chain(const VhostShadowVirtqueue *svq,
- uint16_t num, uint16_t i)
- {
- for (uint16_t j = 0; j < (num - 1); ++j) {
- i = svq->desc_next[i];
- }
- return i;
- }
- G_GNUC_WARN_UNUSED_RESULT
- static VirtQueueElement *vhost_svq_get_buf(VhostShadowVirtqueue *svq,
- uint32_t *len)
- {
- const vring_used_t *used = svq->vring.used;
- vring_used_elem_t used_elem;
- uint16_t last_used, last_used_chain, num;
- if (!vhost_svq_more_used(svq)) {
- return NULL;
- }
- /* Only get used array entries after they have been exposed by dev */
- smp_rmb();
- last_used = svq->last_used_idx & (svq->vring.num - 1);
- used_elem.id = le32_to_cpu(used->ring[last_used].id);
- used_elem.len = le32_to_cpu(used->ring[last_used].len);
- svq->last_used_idx++;
- if (unlikely(used_elem.id >= svq->vring.num)) {
- qemu_log_mask(LOG_GUEST_ERROR, "Device %s says index %u is used",
- svq->vdev->name, used_elem.id);
- return NULL;
- }
- if (unlikely(!svq->desc_state[used_elem.id].ndescs)) {
- qemu_log_mask(LOG_GUEST_ERROR,
- "Device %s says index %u is used, but it was not available",
- svq->vdev->name, used_elem.id);
- return NULL;
- }
- num = svq->desc_state[used_elem.id].ndescs;
- svq->desc_state[used_elem.id].ndescs = 0;
- last_used_chain = vhost_svq_last_desc_of_chain(svq, num, used_elem.id);
- svq->desc_next[last_used_chain] = svq->free_head;
- svq->free_head = used_elem.id;
- svq->num_free += num;
- *len = used_elem.len;
- return g_steal_pointer(&svq->desc_state[used_elem.id].elem);
- }
- /**
- * Push an element to SVQ, returning it to the guest.
- */
- void vhost_svq_push_elem(VhostShadowVirtqueue *svq,
- const VirtQueueElement *elem, uint32_t len)
- {
- virtqueue_push(svq->vq, elem, len);
- if (svq->next_guest_avail_elem) {
- /*
- * Avail ring was full when vhost_svq_flush was called, so it's a
- * good moment to make more descriptors available if possible.
- */
- vhost_handle_guest_kick(svq);
- }
- }
- static void vhost_svq_flush(VhostShadowVirtqueue *svq,
- bool check_for_avail_queue)
- {
- VirtQueue *vq = svq->vq;
- /* Forward as many used buffers as possible. */
- do {
- unsigned i = 0;
- vhost_svq_disable_notification(svq);
- while (true) {
- uint32_t len;
- g_autofree VirtQueueElement *elem = vhost_svq_get_buf(svq, &len);
- if (!elem) {
- break;
- }
- if (unlikely(i >= svq->vring.num)) {
- qemu_log_mask(LOG_GUEST_ERROR,
- "More than %u used buffers obtained in a %u size SVQ",
- i, svq->vring.num);
- virtqueue_fill(vq, elem, len, i);
- virtqueue_flush(vq, i);
- return;
- }
- virtqueue_fill(vq, elem, len, i++);
- }
- virtqueue_flush(vq, i);
- event_notifier_set(&svq->svq_call);
- if (check_for_avail_queue && svq->next_guest_avail_elem) {
- /*
- * Avail ring was full when vhost_svq_flush was called, so it's a
- * good moment to make more descriptors available if possible.
- */
- vhost_handle_guest_kick(svq);
- }
- } while (!vhost_svq_enable_notification(svq));
- }
- /**
- * Poll the SVQ to wait for the device to use the specified number
- * of elements and return the total length written by the device.
- *
- * This function race with main event loop SVQ polling, so extra
- * synchronization is needed.
- *
- * @svq: The svq
- * @num: The number of elements that need to be used
- */
- size_t vhost_svq_poll(VhostShadowVirtqueue *svq, size_t num)
- {
- size_t len = 0;
- while (num--) {
- g_autofree VirtQueueElement *elem = NULL;
- int64_t start_us = g_get_monotonic_time();
- uint32_t r = 0;
- do {
- if (vhost_svq_more_used(svq)) {
- break;
- }
- if (unlikely(g_get_monotonic_time() - start_us > 10e6)) {
- return len;
- }
- } while (true);
- elem = vhost_svq_get_buf(svq, &r);
- len += r;
- }
- return len;
- }
- /**
- * Forward used buffers.
- *
- * @n: hdev call event notifier, the one that device set to notify svq.
- *
- * Note that we are not making any buffers available in the loop, there is no
- * way that it runs more than virtqueue size times.
- */
- static void vhost_svq_handle_call(EventNotifier *n)
- {
- VhostShadowVirtqueue *svq = container_of(n, VhostShadowVirtqueue,
- hdev_call);
- event_notifier_test_and_clear(n);
- vhost_svq_flush(svq, true);
- }
- /**
- * Set the call notifier for the SVQ to call the guest
- *
- * @svq: Shadow virtqueue
- * @call_fd: call notifier
- *
- * Called on BQL context.
- */
- void vhost_svq_set_svq_call_fd(VhostShadowVirtqueue *svq, int call_fd)
- {
- if (call_fd == VHOST_FILE_UNBIND) {
- /*
- * Fail event_notifier_set if called handling device call.
- *
- * SVQ still needs device notifications, since it needs to keep
- * forwarding used buffers even with the unbind.
- */
- memset(&svq->svq_call, 0, sizeof(svq->svq_call));
- } else {
- event_notifier_init_fd(&svq->svq_call, call_fd);
- }
- }
- /**
- * Get the shadow vq vring address.
- * @svq: Shadow virtqueue
- * @addr: Destination to store address
- */
- void vhost_svq_get_vring_addr(const VhostShadowVirtqueue *svq,
- struct vhost_vring_addr *addr)
- {
- addr->desc_user_addr = (uint64_t)(uintptr_t)svq->vring.desc;
- addr->avail_user_addr = (uint64_t)(uintptr_t)svq->vring.avail;
- addr->used_user_addr = (uint64_t)(uintptr_t)svq->vring.used;
- }
- size_t vhost_svq_driver_area_size(const VhostShadowVirtqueue *svq)
- {
- size_t desc_size = sizeof(vring_desc_t) * svq->vring.num;
- size_t avail_size = offsetof(vring_avail_t, ring[svq->vring.num]) +
- sizeof(uint16_t);
- return ROUND_UP(desc_size + avail_size, qemu_real_host_page_size());
- }
- size_t vhost_svq_device_area_size(const VhostShadowVirtqueue *svq)
- {
- size_t used_size = offsetof(vring_used_t, ring[svq->vring.num]) +
- sizeof(uint16_t);
- return ROUND_UP(used_size, qemu_real_host_page_size());
- }
- /**
- * Set a new file descriptor for the guest to kick the SVQ and notify for avail
- *
- * @svq: The svq
- * @svq_kick_fd: The svq kick fd
- *
- * Note that the SVQ will never close the old file descriptor.
- */
- void vhost_svq_set_svq_kick_fd(VhostShadowVirtqueue *svq, int svq_kick_fd)
- {
- EventNotifier *svq_kick = &svq->svq_kick;
- bool poll_stop = VHOST_FILE_UNBIND != event_notifier_get_fd(svq_kick);
- bool poll_start = svq_kick_fd != VHOST_FILE_UNBIND;
- if (poll_stop) {
- event_notifier_set_handler(svq_kick, NULL);
- }
- event_notifier_init_fd(svq_kick, svq_kick_fd);
- /*
- * event_notifier_set_handler already checks for guest's notifications if
- * they arrive at the new file descriptor in the switch, so there is no
- * need to explicitly check for them.
- */
- if (poll_start) {
- event_notifier_set(svq_kick);
- event_notifier_set_handler(svq_kick, vhost_handle_guest_kick_notifier);
- }
- }
- /**
- * Start the shadow virtqueue operation.
- *
- * @svq: Shadow Virtqueue
- * @vdev: VirtIO device
- * @vq: Virtqueue to shadow
- * @iova_tree: Tree to perform descriptors translations
- */
- void vhost_svq_start(VhostShadowVirtqueue *svq, VirtIODevice *vdev,
- VirtQueue *vq, VhostIOVATree *iova_tree)
- {
- size_t desc_size;
- event_notifier_set_handler(&svq->hdev_call, vhost_svq_handle_call);
- svq->next_guest_avail_elem = NULL;
- svq->shadow_avail_idx = 0;
- svq->shadow_used_idx = 0;
- svq->last_used_idx = 0;
- svq->vdev = vdev;
- svq->vq = vq;
- svq->iova_tree = iova_tree;
- svq->vring.num = virtio_queue_get_num(vdev, virtio_get_queue_index(vq));
- svq->num_free = svq->vring.num;
- svq->vring.desc = mmap(NULL, vhost_svq_driver_area_size(svq),
- PROT_READ | PROT_WRITE, MAP_SHARED | MAP_ANONYMOUS,
- -1, 0);
- desc_size = sizeof(vring_desc_t) * svq->vring.num;
- svq->vring.avail = (void *)((char *)svq->vring.desc + desc_size);
- svq->vring.used = mmap(NULL, vhost_svq_device_area_size(svq),
- PROT_READ | PROT_WRITE, MAP_SHARED | MAP_ANONYMOUS,
- -1, 0);
- svq->desc_state = g_new0(SVQDescState, svq->vring.num);
- svq->desc_next = g_new0(uint16_t, svq->vring.num);
- for (unsigned i = 0; i < svq->vring.num - 1; i++) {
- svq->desc_next[i] = i + 1;
- }
- }
- /**
- * Stop the shadow virtqueue operation.
- * @svq: Shadow Virtqueue
- */
- void vhost_svq_stop(VhostShadowVirtqueue *svq)
- {
- vhost_svq_set_svq_kick_fd(svq, VHOST_FILE_UNBIND);
- g_autofree VirtQueueElement *next_avail_elem = NULL;
- if (!svq->vq) {
- return;
- }
- /* Send all pending used descriptors to guest */
- vhost_svq_flush(svq, false);
- for (unsigned i = 0; i < svq->vring.num; ++i) {
- g_autofree VirtQueueElement *elem = NULL;
- elem = g_steal_pointer(&svq->desc_state[i].elem);
- if (elem) {
- /*
- * TODO: This is ok for networking, but other kinds of devices
- * might have problems with just unpop these.
- */
- virtqueue_unpop(svq->vq, elem, 0);
- }
- }
- next_avail_elem = g_steal_pointer(&svq->next_guest_avail_elem);
- if (next_avail_elem) {
- virtqueue_unpop(svq->vq, next_avail_elem, 0);
- }
- svq->vq = NULL;
- g_free(svq->desc_next);
- g_free(svq->desc_state);
- munmap(svq->vring.desc, vhost_svq_driver_area_size(svq));
- munmap(svq->vring.used, vhost_svq_device_area_size(svq));
- event_notifier_set_handler(&svq->hdev_call, NULL);
- }
- /**
- * Creates vhost shadow virtqueue, and instructs the vhost device to use the
- * shadow methods and file descriptors.
- *
- * @ops: SVQ owner callbacks
- * @ops_opaque: ops opaque pointer
- */
- VhostShadowVirtqueue *vhost_svq_new(const VhostShadowVirtqueueOps *ops,
- void *ops_opaque)
- {
- VhostShadowVirtqueue *svq = g_new0(VhostShadowVirtqueue, 1);
- event_notifier_init_fd(&svq->svq_kick, VHOST_FILE_UNBIND);
- svq->ops = ops;
- svq->ops_opaque = ops_opaque;
- return svq;
- }
- /**
- * Free the resources of the shadow virtqueue.
- *
- * @pvq: gpointer to SVQ so it can be used by autofree functions.
- */
- void vhost_svq_free(gpointer pvq)
- {
- VhostShadowVirtqueue *vq = pvq;
- vhost_svq_stop(vq);
- g_free(vq);
- }
|