xref: /qemu/hw/virtio/vhost-shadow-virtqueue.c (revision 22a6840ff282727df3e3c745d92d764c7081f49b)
110857ec0SEugenio Pérez /*
210857ec0SEugenio Pérez  * vhost shadow virtqueue
310857ec0SEugenio Pérez  *
410857ec0SEugenio Pérez  * SPDX-FileCopyrightText: Red Hat, Inc. 2021
510857ec0SEugenio Pérez  * SPDX-FileContributor: Author: Eugenio Pérez <eperezma@redhat.com>
610857ec0SEugenio Pérez  *
710857ec0SEugenio Pérez  * SPDX-License-Identifier: GPL-2.0-or-later
810857ec0SEugenio Pérez  */
910857ec0SEugenio Pérez 
1010857ec0SEugenio Pérez #include "qemu/osdep.h"
1110857ec0SEugenio Pérez #include "hw/virtio/vhost-shadow-virtqueue.h"
1210857ec0SEugenio Pérez 
1310857ec0SEugenio Pérez #include "qemu/error-report.h"
144725a418SEugenio Pérez #include "qapi/error.h"
15dff4426fSEugenio Pérez #include "qemu/main-loop.h"
16100890f7SEugenio Pérez #include "qemu/log.h"
17100890f7SEugenio Pérez #include "qemu/memalign.h"
18dff4426fSEugenio Pérez #include "linux-headers/linux/vhost.h"
19dff4426fSEugenio Pérez 
20dff4426fSEugenio Pérez /**
214725a418SEugenio Pérez  * Validate the transport device features that both guests can use with the SVQ
224725a418SEugenio Pérez  * and SVQs can use with the device.
234725a418SEugenio Pérez  *
244725a418SEugenio Pérez  * @dev_features: The features
254725a418SEugenio Pérez  * @errp: Error pointer
264725a418SEugenio Pérez  */
274725a418SEugenio Pérez bool vhost_svq_valid_features(uint64_t features, Error **errp)
284725a418SEugenio Pérez {
294725a418SEugenio Pérez     bool ok = true;
304725a418SEugenio Pérez     uint64_t svq_features = features;
314725a418SEugenio Pérez 
324725a418SEugenio Pérez     for (uint64_t b = VIRTIO_TRANSPORT_F_START; b <= VIRTIO_TRANSPORT_F_END;
334725a418SEugenio Pérez          ++b) {
344725a418SEugenio Pérez         switch (b) {
354725a418SEugenio Pérez         case VIRTIO_F_ANY_LAYOUT:
364725a418SEugenio Pérez             continue;
374725a418SEugenio Pérez 
384725a418SEugenio Pérez         case VIRTIO_F_ACCESS_PLATFORM:
394725a418SEugenio Pérez             /* SVQ trust in the host's IOMMU to translate addresses */
404725a418SEugenio Pérez         case VIRTIO_F_VERSION_1:
414725a418SEugenio Pérez             /* SVQ trust that the guest vring is little endian */
424725a418SEugenio Pérez             if (!(svq_features & BIT_ULL(b))) {
434725a418SEugenio Pérez                 svq_features |= BIT_ULL(b);
444725a418SEugenio Pérez                 ok = false;
454725a418SEugenio Pérez             }
464725a418SEugenio Pérez             continue;
474725a418SEugenio Pérez 
484725a418SEugenio Pérez         default:
494725a418SEugenio Pérez             if (svq_features & BIT_ULL(b)) {
504725a418SEugenio Pérez                 svq_features &= ~BIT_ULL(b);
514725a418SEugenio Pérez                 ok = false;
524725a418SEugenio Pérez             }
534725a418SEugenio Pérez         }
544725a418SEugenio Pérez     }
554725a418SEugenio Pérez 
564725a418SEugenio Pérez     if (!ok) {
574725a418SEugenio Pérez         error_setg(errp, "SVQ Invalid device feature flags, offer: 0x%"PRIx64
584725a418SEugenio Pérez                          ", ok: 0x%"PRIx64, features, svq_features);
594725a418SEugenio Pérez     }
604725a418SEugenio Pérez     return ok;
614725a418SEugenio Pérez }
624725a418SEugenio Pérez 
634725a418SEugenio Pérez /**
64100890f7SEugenio Pérez  * Number of descriptors that the SVQ can make available from the guest.
65dff4426fSEugenio Pérez  *
66100890f7SEugenio Pérez  * @svq: The svq
67dff4426fSEugenio Pérez  */
68100890f7SEugenio Pérez static uint16_t vhost_svq_available_slots(const VhostShadowVirtqueue *svq)
69dff4426fSEugenio Pérez {
70100890f7SEugenio Pérez     return svq->vring.num - (svq->shadow_avail_idx - svq->shadow_used_idx);
71100890f7SEugenio Pérez }
72100890f7SEugenio Pérez 
7334e3c94eSEugenio Pérez /**
7434e3c94eSEugenio Pérez  * Translate addresses between the qemu's virtual address and the SVQ IOVA
7534e3c94eSEugenio Pérez  *
7634e3c94eSEugenio Pérez  * @svq: Shadow VirtQueue
7734e3c94eSEugenio Pérez  * @vaddr: Translated IOVA addresses
7834e3c94eSEugenio Pérez  * @iovec: Source qemu's VA addresses
7934e3c94eSEugenio Pérez  * @num: Length of iovec and minimum length of vaddr
8034e3c94eSEugenio Pérez  */
8134e3c94eSEugenio Pérez static bool vhost_svq_translate_addr(const VhostShadowVirtqueue *svq,
8234e3c94eSEugenio Pérez                                      hwaddr *addrs, const struct iovec *iovec,
8334e3c94eSEugenio Pérez                                      size_t num)
8434e3c94eSEugenio Pérez {
8534e3c94eSEugenio Pérez     if (num == 0) {
8634e3c94eSEugenio Pérez         return true;
8734e3c94eSEugenio Pérez     }
8834e3c94eSEugenio Pérez 
8934e3c94eSEugenio Pérez     for (size_t i = 0; i < num; ++i) {
9034e3c94eSEugenio Pérez         DMAMap needle = {
9134e3c94eSEugenio Pérez             .translated_addr = (hwaddr)(uintptr_t)iovec[i].iov_base,
9234e3c94eSEugenio Pérez             .size = iovec[i].iov_len,
9334e3c94eSEugenio Pérez         };
9434e3c94eSEugenio Pérez         Int128 needle_last, map_last;
9534e3c94eSEugenio Pérez         size_t off;
9634e3c94eSEugenio Pérez 
9734e3c94eSEugenio Pérez         const DMAMap *map = vhost_iova_tree_find_iova(svq->iova_tree, &needle);
9834e3c94eSEugenio Pérez         /*
9934e3c94eSEugenio Pérez          * Map cannot be NULL since iova map contains all guest space and
10034e3c94eSEugenio Pérez          * qemu already has a physical address mapped
10134e3c94eSEugenio Pérez          */
10234e3c94eSEugenio Pérez         if (unlikely(!map)) {
10334e3c94eSEugenio Pérez             qemu_log_mask(LOG_GUEST_ERROR,
10434e3c94eSEugenio Pérez                           "Invalid address 0x%"HWADDR_PRIx" given by guest",
10534e3c94eSEugenio Pérez                           needle.translated_addr);
10634e3c94eSEugenio Pérez             return false;
10734e3c94eSEugenio Pérez         }
10834e3c94eSEugenio Pérez 
10934e3c94eSEugenio Pérez         off = needle.translated_addr - map->translated_addr;
11034e3c94eSEugenio Pérez         addrs[i] = map->iova + off;
11134e3c94eSEugenio Pérez 
11234e3c94eSEugenio Pérez         needle_last = int128_add(int128_make64(needle.translated_addr),
11334e3c94eSEugenio Pérez                                  int128_make64(iovec[i].iov_len));
11434e3c94eSEugenio Pérez         map_last = int128_make64(map->translated_addr + map->size);
11534e3c94eSEugenio Pérez         if (unlikely(int128_gt(needle_last, map_last))) {
11634e3c94eSEugenio Pérez             qemu_log_mask(LOG_GUEST_ERROR,
11734e3c94eSEugenio Pérez                           "Guest buffer expands over iova range");
11834e3c94eSEugenio Pérez             return false;
11934e3c94eSEugenio Pérez         }
12034e3c94eSEugenio Pérez     }
12134e3c94eSEugenio Pérez 
12234e3c94eSEugenio Pérez     return true;
12334e3c94eSEugenio Pérez }
12434e3c94eSEugenio Pérez 
125009c2549SEugenio Pérez /**
126009c2549SEugenio Pérez  * Write descriptors to SVQ vring
127009c2549SEugenio Pérez  *
128009c2549SEugenio Pérez  * @svq: The shadow virtqueue
129009c2549SEugenio Pérez  * @sg: Cache for hwaddr
130009c2549SEugenio Pérez  * @iovec: The iovec from the guest
131009c2549SEugenio Pérez  * @num: iovec length
132009c2549SEugenio Pérez  * @more_descs: True if more descriptors come in the chain
133009c2549SEugenio Pérez  * @write: True if they are writeable descriptors
134009c2549SEugenio Pérez  *
135009c2549SEugenio Pérez  * Return true if success, false otherwise and print error.
136009c2549SEugenio Pérez  */
137009c2549SEugenio Pérez static bool vhost_svq_vring_write_descs(VhostShadowVirtqueue *svq, hwaddr *sg,
138100890f7SEugenio Pérez                                         const struct iovec *iovec, size_t num,
139100890f7SEugenio Pérez                                         bool more_descs, bool write)
140100890f7SEugenio Pérez {
141100890f7SEugenio Pérez     uint16_t i = svq->free_head, last = svq->free_head;
142100890f7SEugenio Pérez     unsigned n;
143100890f7SEugenio Pérez     uint16_t flags = write ? cpu_to_le16(VRING_DESC_F_WRITE) : 0;
144100890f7SEugenio Pérez     vring_desc_t *descs = svq->vring.desc;
145009c2549SEugenio Pérez     bool ok;
146100890f7SEugenio Pérez 
147100890f7SEugenio Pérez     if (num == 0) {
148009c2549SEugenio Pérez         return true;
149009c2549SEugenio Pérez     }
150009c2549SEugenio Pérez 
151009c2549SEugenio Pérez     ok = vhost_svq_translate_addr(svq, sg, iovec, num);
152009c2549SEugenio Pérez     if (unlikely(!ok)) {
153009c2549SEugenio Pérez         return false;
154100890f7SEugenio Pérez     }
155100890f7SEugenio Pérez 
156100890f7SEugenio Pérez     for (n = 0; n < num; n++) {
157100890f7SEugenio Pérez         if (more_descs || (n + 1 < num)) {
158100890f7SEugenio Pérez             descs[i].flags = flags | cpu_to_le16(VRING_DESC_F_NEXT);
159495fe3a7SEugenio Pérez             descs[i].next = cpu_to_le16(svq->desc_next[i]);
160100890f7SEugenio Pérez         } else {
161100890f7SEugenio Pérez             descs[i].flags = flags;
162100890f7SEugenio Pérez         }
16334e3c94eSEugenio Pérez         descs[i].addr = cpu_to_le64(sg[n]);
164100890f7SEugenio Pérez         descs[i].len = cpu_to_le32(iovec[n].iov_len);
165100890f7SEugenio Pérez 
166100890f7SEugenio Pérez         last = i;
167495fe3a7SEugenio Pérez         i = cpu_to_le16(svq->desc_next[i]);
168100890f7SEugenio Pérez     }
169100890f7SEugenio Pérez 
170495fe3a7SEugenio Pérez     svq->free_head = le16_to_cpu(svq->desc_next[last]);
171009c2549SEugenio Pérez     return true;
172100890f7SEugenio Pérez }
173100890f7SEugenio Pérez 
174100890f7SEugenio Pérez static bool vhost_svq_add_split(VhostShadowVirtqueue *svq,
1751f46ae65SEugenio Pérez                                 const struct iovec *out_sg, size_t out_num,
1761f46ae65SEugenio Pérez                                 const struct iovec *in_sg, size_t in_num,
1771f46ae65SEugenio Pérez                                 unsigned *head)
178100890f7SEugenio Pérez {
179100890f7SEugenio Pérez     unsigned avail_idx;
180100890f7SEugenio Pérez     vring_avail_t *avail = svq->vring.avail;
18134e3c94eSEugenio Pérez     bool ok;
1821f46ae65SEugenio Pérez     g_autofree hwaddr *sgs = g_new(hwaddr, MAX(out_num, in_num));
183100890f7SEugenio Pérez 
184100890f7SEugenio Pérez     *head = svq->free_head;
185100890f7SEugenio Pérez 
186100890f7SEugenio Pérez     /* We need some descriptors here */
1871f46ae65SEugenio Pérez     if (unlikely(!out_num && !in_num)) {
188100890f7SEugenio Pérez         qemu_log_mask(LOG_GUEST_ERROR,
189100890f7SEugenio Pérez                       "Guest provided element with no descriptors");
190100890f7SEugenio Pérez         return false;
191100890f7SEugenio Pérez     }
192100890f7SEugenio Pérez 
1931f46ae65SEugenio Pérez     ok = vhost_svq_vring_write_descs(svq, sgs, out_sg, out_num, in_num > 0,
1941f46ae65SEugenio Pérez                                      false);
19534e3c94eSEugenio Pérez     if (unlikely(!ok)) {
19634e3c94eSEugenio Pérez         return false;
19734e3c94eSEugenio Pérez     }
19834e3c94eSEugenio Pérez 
1991f46ae65SEugenio Pérez     ok = vhost_svq_vring_write_descs(svq, sgs, in_sg, in_num, false, true);
200009c2549SEugenio Pérez     if (unlikely(!ok)) {
201009c2549SEugenio Pérez         return false;
202009c2549SEugenio Pérez     }
203100890f7SEugenio Pérez 
204100890f7SEugenio Pérez     /*
205100890f7SEugenio Pérez      * Put the entry in the available array (but don't update avail->idx until
206100890f7SEugenio Pérez      * they do sync).
207100890f7SEugenio Pérez      */
208100890f7SEugenio Pérez     avail_idx = svq->shadow_avail_idx & (svq->vring.num - 1);
209100890f7SEugenio Pérez     avail->ring[avail_idx] = cpu_to_le16(*head);
210100890f7SEugenio Pérez     svq->shadow_avail_idx++;
211100890f7SEugenio Pérez 
212100890f7SEugenio Pérez     /* Update the avail index after write the descriptor */
213100890f7SEugenio Pérez     smp_wmb();
214100890f7SEugenio Pérez     avail->idx = cpu_to_le16(svq->shadow_avail_idx);
215100890f7SEugenio Pérez 
216100890f7SEugenio Pérez     return true;
217100890f7SEugenio Pérez }
218100890f7SEugenio Pérez 
219d93a2405SEugenio Pérez static void vhost_svq_kick(VhostShadowVirtqueue *svq)
220d93a2405SEugenio Pérez {
221*22a6840fSEugenio Pérez     bool needs_kick;
222*22a6840fSEugenio Pérez 
223d93a2405SEugenio Pérez     /*
224d93a2405SEugenio Pérez      * We need to expose the available array entries before checking the used
225d93a2405SEugenio Pérez      * flags
226d93a2405SEugenio Pérez      */
227d93a2405SEugenio Pérez     smp_mb();
228*22a6840fSEugenio Pérez 
229*22a6840fSEugenio Pérez     if (virtio_vdev_has_feature(svq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
230*22a6840fSEugenio Pérez         uint16_t avail_event = *(uint16_t *)(&svq->vring.used->ring[svq->vring.num]);
231*22a6840fSEugenio Pérez         needs_kick = vring_need_event(avail_event, svq->shadow_avail_idx, svq->shadow_avail_idx - 1);
232*22a6840fSEugenio Pérez     } else {
233*22a6840fSEugenio Pérez         needs_kick = !(svq->vring.used->flags & VRING_USED_F_NO_NOTIFY);
234*22a6840fSEugenio Pérez     }
235*22a6840fSEugenio Pérez 
236*22a6840fSEugenio Pérez     if (!needs_kick) {
237d93a2405SEugenio Pérez         return;
238d93a2405SEugenio Pérez     }
239d93a2405SEugenio Pérez 
240d93a2405SEugenio Pérez     event_notifier_set(&svq->hdev_kick);
241d93a2405SEugenio Pérez }
242d93a2405SEugenio Pérez 
2435181db13SEugenio Pérez /**
2445181db13SEugenio Pérez  * Add an element to a SVQ.
2455181db13SEugenio Pérez  *
246f20b70ebSEugenio Pérez  * Return -EINVAL if element is invalid, -ENOSPC if dev queue is full
2475181db13SEugenio Pérez  */
248d0291f3fSEugenio Pérez int vhost_svq_add(VhostShadowVirtqueue *svq, const struct iovec *out_sg,
249d0291f3fSEugenio Pérez                   size_t out_num, const struct iovec *in_sg, size_t in_num,
250d0291f3fSEugenio Pérez                   VirtQueueElement *elem)
251100890f7SEugenio Pérez {
252100890f7SEugenio Pérez     unsigned qemu_head;
2531f46ae65SEugenio Pérez     unsigned ndescs = in_num + out_num;
254f20b70ebSEugenio Pérez     bool ok;
255f20b70ebSEugenio Pérez 
256f20b70ebSEugenio Pérez     if (unlikely(ndescs > vhost_svq_available_slots(svq))) {
257f20b70ebSEugenio Pérez         return -ENOSPC;
258f20b70ebSEugenio Pérez     }
259f20b70ebSEugenio Pérez 
2601f46ae65SEugenio Pérez     ok = vhost_svq_add_split(svq, out_sg, out_num, in_sg, in_num, &qemu_head);
261100890f7SEugenio Pérez     if (unlikely(!ok)) {
262f20b70ebSEugenio Pérez         return -EINVAL;
263100890f7SEugenio Pérez     }
264100890f7SEugenio Pérez 
2659e87868fSEugenio Pérez     svq->desc_state[qemu_head].elem = elem;
266ac4cfdc6SEugenio Pérez     svq->desc_state[qemu_head].ndescs = ndescs;
26798b5adefSEugenio Pérez     vhost_svq_kick(svq);
268f20b70ebSEugenio Pérez     return 0;
269100890f7SEugenio Pérez }
270100890f7SEugenio Pérez 
2711f46ae65SEugenio Pérez /* Convenience wrapper to add a guest's element to SVQ */
2721f46ae65SEugenio Pérez static int vhost_svq_add_element(VhostShadowVirtqueue *svq,
2731f46ae65SEugenio Pérez                                  VirtQueueElement *elem)
2741f46ae65SEugenio Pérez {
2751f46ae65SEugenio Pérez     return vhost_svq_add(svq, elem->out_sg, elem->out_num, elem->in_sg,
2761f46ae65SEugenio Pérez                          elem->in_num, elem);
2771f46ae65SEugenio Pérez }
2781f46ae65SEugenio Pérez 
279dff4426fSEugenio Pérez /**
280100890f7SEugenio Pérez  * Forward available buffers.
281100890f7SEugenio Pérez  *
282100890f7SEugenio Pérez  * @svq: Shadow VirtQueue
283100890f7SEugenio Pérez  *
284100890f7SEugenio Pérez  * Note that this function does not guarantee that all guest's available
285100890f7SEugenio Pérez  * buffers are available to the device in SVQ avail ring. The guest may have
286100890f7SEugenio Pérez  * exposed a GPA / GIOVA contiguous buffer, but it may not be contiguous in
287100890f7SEugenio Pérez  * qemu vaddr.
288100890f7SEugenio Pérez  *
289100890f7SEugenio Pérez  * If that happens, guest's kick notifications will be disabled until the
290100890f7SEugenio Pérez  * device uses some buffers.
291100890f7SEugenio Pérez  */
292100890f7SEugenio Pérez static void vhost_handle_guest_kick(VhostShadowVirtqueue *svq)
293100890f7SEugenio Pérez {
294100890f7SEugenio Pérez     /* Clear event notifier */
295100890f7SEugenio Pérez     event_notifier_test_and_clear(&svq->svq_kick);
296100890f7SEugenio Pérez 
297100890f7SEugenio Pérez     /* Forward to the device as many available buffers as possible */
298100890f7SEugenio Pérez     do {
299100890f7SEugenio Pérez         virtio_queue_set_notification(svq->vq, false);
300100890f7SEugenio Pérez 
301100890f7SEugenio Pérez         while (true) {
302ad9f958dSBernhard Beschow             g_autofree VirtQueueElement *elem = NULL;
303f20b70ebSEugenio Pérez             int r;
304100890f7SEugenio Pérez 
305100890f7SEugenio Pérez             if (svq->next_guest_avail_elem) {
306100890f7SEugenio Pérez                 elem = g_steal_pointer(&svq->next_guest_avail_elem);
307100890f7SEugenio Pérez             } else {
308100890f7SEugenio Pérez                 elem = virtqueue_pop(svq->vq, sizeof(*elem));
309100890f7SEugenio Pérez             }
310100890f7SEugenio Pérez 
311100890f7SEugenio Pérez             if (!elem) {
312100890f7SEugenio Pérez                 break;
313100890f7SEugenio Pérez             }
314100890f7SEugenio Pérez 
315e966c0b7SEugenio Pérez             if (svq->ops) {
316e966c0b7SEugenio Pérez                 r = svq->ops->avail_handler(svq, elem, svq->ops_opaque);
317e966c0b7SEugenio Pérez             } else {
3181f46ae65SEugenio Pérez                 r = vhost_svq_add_element(svq, elem);
319e966c0b7SEugenio Pérez             }
320f20b70ebSEugenio Pérez             if (unlikely(r != 0)) {
321f20b70ebSEugenio Pérez                 if (r == -ENOSPC) {
322100890f7SEugenio Pérez                     /*
323f20b70ebSEugenio Pérez                      * This condition is possible since a contiguous buffer in
324f20b70ebSEugenio Pérez                      * GPA does not imply a contiguous buffer in qemu's VA
325f20b70ebSEugenio Pérez                      * scatter-gather segments. If that happens, the buffer
326f20b70ebSEugenio Pérez                      * exposed to the device needs to be a chain of descriptors
327f20b70ebSEugenio Pérez                      * at this moment.
328100890f7SEugenio Pérez                      *
329100890f7SEugenio Pérez                      * SVQ cannot hold more available buffers if we are here:
330f20b70ebSEugenio Pérez                      * queue the current guest descriptor and ignore kicks
331100890f7SEugenio Pérez                      * until some elements are used.
332100890f7SEugenio Pérez                      */
3339c2ab2f1SEugenio Pérez                     svq->next_guest_avail_elem = g_steal_pointer(&elem);
334100890f7SEugenio Pérez                 }
335100890f7SEugenio Pérez 
336f20b70ebSEugenio Pérez                 /* VQ is full or broken, just return and ignore kicks */
337100890f7SEugenio Pérez                 return;
338100890f7SEugenio Pérez             }
3399c2ab2f1SEugenio Pérez             /* elem belongs to SVQ or external caller now */
3409c2ab2f1SEugenio Pérez             elem = NULL;
341100890f7SEugenio Pérez         }
342100890f7SEugenio Pérez 
343100890f7SEugenio Pérez         virtio_queue_set_notification(svq->vq, true);
344100890f7SEugenio Pérez     } while (!virtio_queue_empty(svq->vq));
345100890f7SEugenio Pérez }
346100890f7SEugenio Pérez 
347100890f7SEugenio Pérez /**
348100890f7SEugenio Pérez  * Handle guest's kick.
349100890f7SEugenio Pérez  *
350100890f7SEugenio Pérez  * @n: guest kick event notifier, the one that guest set to notify svq.
351100890f7SEugenio Pérez  */
352100890f7SEugenio Pérez static void vhost_handle_guest_kick_notifier(EventNotifier *n)
353100890f7SEugenio Pérez {
354100890f7SEugenio Pérez     VhostShadowVirtqueue *svq = container_of(n, VhostShadowVirtqueue, svq_kick);
355100890f7SEugenio Pérez     event_notifier_test_and_clear(n);
356100890f7SEugenio Pérez     vhost_handle_guest_kick(svq);
357100890f7SEugenio Pérez }
358100890f7SEugenio Pérez 
359100890f7SEugenio Pérez static bool vhost_svq_more_used(VhostShadowVirtqueue *svq)
360100890f7SEugenio Pérez {
361c381abc3SEugenio Pérez     uint16_t *used_idx = &svq->vring.used->idx;
362100890f7SEugenio Pérez     if (svq->last_used_idx != svq->shadow_used_idx) {
363100890f7SEugenio Pérez         return true;
364100890f7SEugenio Pérez     }
365100890f7SEugenio Pérez 
366c381abc3SEugenio Pérez     svq->shadow_used_idx = cpu_to_le16(*(volatile uint16_t *)used_idx);
367100890f7SEugenio Pérez 
368100890f7SEugenio Pérez     return svq->last_used_idx != svq->shadow_used_idx;
369100890f7SEugenio Pérez }
370100890f7SEugenio Pérez 
371100890f7SEugenio Pérez /**
372100890f7SEugenio Pérez  * Enable vhost device calls after disable them.
373100890f7SEugenio Pérez  *
374100890f7SEugenio Pérez  * @svq: The svq
375100890f7SEugenio Pérez  *
376100890f7SEugenio Pérez  * It returns false if there are pending used buffers from the vhost device,
377100890f7SEugenio Pérez  * avoiding the possible races between SVQ checking for more work and enabling
378100890f7SEugenio Pérez  * callbacks. True if SVQ used vring has no more pending buffers.
379100890f7SEugenio Pérez  */
380100890f7SEugenio Pérez static bool vhost_svq_enable_notification(VhostShadowVirtqueue *svq)
381100890f7SEugenio Pérez {
38201f8beacSEugenio Pérez     if (virtio_vdev_has_feature(svq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
38301f8beacSEugenio Pérez         uint16_t *used_event = (uint16_t *)&svq->vring.avail->ring[svq->vring.num];
38401f8beacSEugenio Pérez         *used_event = svq->shadow_used_idx;
38501f8beacSEugenio Pérez     } else {
386100890f7SEugenio Pérez         svq->vring.avail->flags &= ~cpu_to_le16(VRING_AVAIL_F_NO_INTERRUPT);
38701f8beacSEugenio Pérez     }
38801f8beacSEugenio Pérez 
38901f8beacSEugenio Pérez     /* Make sure the event is enabled before the read of used_idx */
390100890f7SEugenio Pérez     smp_mb();
391100890f7SEugenio Pérez     return !vhost_svq_more_used(svq);
392100890f7SEugenio Pérez }
393100890f7SEugenio Pérez 
394100890f7SEugenio Pérez static void vhost_svq_disable_notification(VhostShadowVirtqueue *svq)
395100890f7SEugenio Pérez {
39601f8beacSEugenio Pérez     /*
39701f8beacSEugenio Pérez      * No need to disable notification in the event idx case, since used event
39801f8beacSEugenio Pérez      * index is already an index too far away.
39901f8beacSEugenio Pérez      */
40001f8beacSEugenio Pérez     if (!virtio_vdev_has_feature(svq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
401100890f7SEugenio Pérez         svq->vring.avail->flags |= cpu_to_le16(VRING_AVAIL_F_NO_INTERRUPT);
402100890f7SEugenio Pérez     }
40301f8beacSEugenio Pérez }
404100890f7SEugenio Pérez 
40581abfa57SEugenio Pérez static uint16_t vhost_svq_last_desc_of_chain(const VhostShadowVirtqueue *svq,
40681abfa57SEugenio Pérez                                              uint16_t num, uint16_t i)
40781abfa57SEugenio Pérez {
40881abfa57SEugenio Pérez     for (uint16_t j = 0; j < (num - 1); ++j) {
40981abfa57SEugenio Pérez         i = le16_to_cpu(svq->desc_next[i]);
41081abfa57SEugenio Pérez     }
41181abfa57SEugenio Pérez 
41281abfa57SEugenio Pérez     return i;
41381abfa57SEugenio Pérez }
41481abfa57SEugenio Pérez 
415100890f7SEugenio Pérez static VirtQueueElement *vhost_svq_get_buf(VhostShadowVirtqueue *svq,
416100890f7SEugenio Pérez                                            uint32_t *len)
417100890f7SEugenio Pérez {
418100890f7SEugenio Pérez     const vring_used_t *used = svq->vring.used;
419100890f7SEugenio Pérez     vring_used_elem_t used_elem;
42081abfa57SEugenio Pérez     uint16_t last_used, last_used_chain, num;
421100890f7SEugenio Pérez 
422100890f7SEugenio Pérez     if (!vhost_svq_more_used(svq)) {
423100890f7SEugenio Pérez         return NULL;
424100890f7SEugenio Pérez     }
425100890f7SEugenio Pérez 
426100890f7SEugenio Pérez     /* Only get used array entries after they have been exposed by dev */
427100890f7SEugenio Pérez     smp_rmb();
428100890f7SEugenio Pérez     last_used = svq->last_used_idx & (svq->vring.num - 1);
429100890f7SEugenio Pérez     used_elem.id = le32_to_cpu(used->ring[last_used].id);
430100890f7SEugenio Pérez     used_elem.len = le32_to_cpu(used->ring[last_used].len);
431100890f7SEugenio Pérez 
432100890f7SEugenio Pérez     svq->last_used_idx++;
433100890f7SEugenio Pérez     if (unlikely(used_elem.id >= svq->vring.num)) {
434100890f7SEugenio Pérez         qemu_log_mask(LOG_GUEST_ERROR, "Device %s says index %u is used",
435100890f7SEugenio Pérez                       svq->vdev->name, used_elem.id);
436100890f7SEugenio Pérez         return NULL;
437100890f7SEugenio Pérez     }
438100890f7SEugenio Pérez 
43986f5f254SEugenio Pérez     if (unlikely(!svq->desc_state[used_elem.id].ndescs)) {
440100890f7SEugenio Pérez         qemu_log_mask(LOG_GUEST_ERROR,
441100890f7SEugenio Pérez             "Device %s says index %u is used, but it was not available",
442100890f7SEugenio Pérez             svq->vdev->name, used_elem.id);
443100890f7SEugenio Pérez         return NULL;
444100890f7SEugenio Pérez     }
445100890f7SEugenio Pérez 
446ac4cfdc6SEugenio Pérez     num = svq->desc_state[used_elem.id].ndescs;
44786f5f254SEugenio Pérez     svq->desc_state[used_elem.id].ndescs = 0;
44881abfa57SEugenio Pérez     last_used_chain = vhost_svq_last_desc_of_chain(svq, num, used_elem.id);
44981abfa57SEugenio Pérez     svq->desc_next[last_used_chain] = svq->free_head;
450100890f7SEugenio Pérez     svq->free_head = used_elem.id;
451100890f7SEugenio Pérez 
452100890f7SEugenio Pérez     *len = used_elem.len;
4539e87868fSEugenio Pérez     return g_steal_pointer(&svq->desc_state[used_elem.id].elem);
454100890f7SEugenio Pérez }
455100890f7SEugenio Pérez 
456432efd14SEugenio Pérez /**
457432efd14SEugenio Pérez  * Push an element to SVQ, returning it to the guest.
458432efd14SEugenio Pérez  */
459432efd14SEugenio Pérez void vhost_svq_push_elem(VhostShadowVirtqueue *svq,
460432efd14SEugenio Pérez                          const VirtQueueElement *elem, uint32_t len)
461432efd14SEugenio Pérez {
462432efd14SEugenio Pérez     virtqueue_push(svq->vq, elem, len);
463432efd14SEugenio Pérez     if (svq->next_guest_avail_elem) {
464432efd14SEugenio Pérez         /*
465432efd14SEugenio Pérez          * Avail ring was full when vhost_svq_flush was called, so it's a
466432efd14SEugenio Pérez          * good moment to make more descriptors available if possible.
467432efd14SEugenio Pérez          */
468432efd14SEugenio Pérez         vhost_handle_guest_kick(svq);
469432efd14SEugenio Pérez     }
470432efd14SEugenio Pérez }
471432efd14SEugenio Pérez 
472100890f7SEugenio Pérez static void vhost_svq_flush(VhostShadowVirtqueue *svq,
473100890f7SEugenio Pérez                             bool check_for_avail_queue)
474100890f7SEugenio Pérez {
475100890f7SEugenio Pérez     VirtQueue *vq = svq->vq;
476100890f7SEugenio Pérez 
477100890f7SEugenio Pérez     /* Forward as many used buffers as possible. */
478100890f7SEugenio Pérez     do {
479100890f7SEugenio Pérez         unsigned i = 0;
480100890f7SEugenio Pérez 
481100890f7SEugenio Pérez         vhost_svq_disable_notification(svq);
482100890f7SEugenio Pérez         while (true) {
483100890f7SEugenio Pérez             uint32_t len;
484100890f7SEugenio Pérez             g_autofree VirtQueueElement *elem = vhost_svq_get_buf(svq, &len);
485100890f7SEugenio Pérez             if (!elem) {
486100890f7SEugenio Pérez                 break;
487100890f7SEugenio Pérez             }
488100890f7SEugenio Pérez 
489100890f7SEugenio Pérez             if (unlikely(i >= svq->vring.num)) {
490100890f7SEugenio Pérez                 qemu_log_mask(LOG_GUEST_ERROR,
491100890f7SEugenio Pérez                          "More than %u used buffers obtained in a %u size SVQ",
492100890f7SEugenio Pérez                          i, svq->vring.num);
493100890f7SEugenio Pérez                 virtqueue_fill(vq, elem, len, i);
494100890f7SEugenio Pérez                 virtqueue_flush(vq, i);
495100890f7SEugenio Pérez                 return;
496100890f7SEugenio Pérez             }
497100890f7SEugenio Pérez             virtqueue_fill(vq, elem, len, i++);
498100890f7SEugenio Pérez         }
499100890f7SEugenio Pérez 
500100890f7SEugenio Pérez         virtqueue_flush(vq, i);
501100890f7SEugenio Pérez         event_notifier_set(&svq->svq_call);
502100890f7SEugenio Pérez 
503100890f7SEugenio Pérez         if (check_for_avail_queue && svq->next_guest_avail_elem) {
504100890f7SEugenio Pérez             /*
505100890f7SEugenio Pérez              * Avail ring was full when vhost_svq_flush was called, so it's a
506100890f7SEugenio Pérez              * good moment to make more descriptors available if possible.
507100890f7SEugenio Pérez              */
508100890f7SEugenio Pérez             vhost_handle_guest_kick(svq);
509100890f7SEugenio Pérez         }
510100890f7SEugenio Pérez     } while (!vhost_svq_enable_notification(svq));
511100890f7SEugenio Pérez }
512100890f7SEugenio Pérez 
513100890f7SEugenio Pérez /**
5143f44d13dSEugenio Pérez  * Poll the SVQ for one device used buffer.
5153f44d13dSEugenio Pérez  *
5163f44d13dSEugenio Pérez  * This function race with main event loop SVQ polling, so extra
5173f44d13dSEugenio Pérez  * synchronization is needed.
5183f44d13dSEugenio Pérez  *
5193f44d13dSEugenio Pérez  * Return the length written by the device.
5203f44d13dSEugenio Pérez  */
5213f44d13dSEugenio Pérez size_t vhost_svq_poll(VhostShadowVirtqueue *svq)
5223f44d13dSEugenio Pérez {
5233f44d13dSEugenio Pérez     int64_t start_us = g_get_monotonic_time();
5243f44d13dSEugenio Pérez     uint32_t len;
525d368c0b0SEugenio Pérez 
526d368c0b0SEugenio Pérez     do {
527d368c0b0SEugenio Pérez         if (vhost_svq_more_used(svq)) {
528d368c0b0SEugenio Pérez             break;
5293f44d13dSEugenio Pérez         }
5303f44d13dSEugenio Pérez 
5313f44d13dSEugenio Pérez         if (unlikely(g_get_monotonic_time() - start_us > 10e6)) {
5323f44d13dSEugenio Pérez             return 0;
5333f44d13dSEugenio Pérez         }
5343f44d13dSEugenio Pérez     } while (true);
535d368c0b0SEugenio Pérez 
536d368c0b0SEugenio Pérez     vhost_svq_get_buf(svq, &len);
537d368c0b0SEugenio Pérez     return len;
5383f44d13dSEugenio Pérez }
5393f44d13dSEugenio Pérez 
5403f44d13dSEugenio Pérez /**
541100890f7SEugenio Pérez  * Forward used buffers.
542a8ac8858SEugenio Pérez  *
543a8ac8858SEugenio Pérez  * @n: hdev call event notifier, the one that device set to notify svq.
544100890f7SEugenio Pérez  *
545100890f7SEugenio Pérez  * Note that we are not making any buffers available in the loop, there is no
546100890f7SEugenio Pérez  * way that it runs more than virtqueue size times.
547a8ac8858SEugenio Pérez  */
548a8ac8858SEugenio Pérez static void vhost_svq_handle_call(EventNotifier *n)
549a8ac8858SEugenio Pérez {
550a8ac8858SEugenio Pérez     VhostShadowVirtqueue *svq = container_of(n, VhostShadowVirtqueue,
551a8ac8858SEugenio Pérez                                              hdev_call);
552a8ac8858SEugenio Pérez     event_notifier_test_and_clear(n);
553100890f7SEugenio Pérez     vhost_svq_flush(svq, true);
554a8ac8858SEugenio Pérez }
555a8ac8858SEugenio Pérez 
556a8ac8858SEugenio Pérez /**
557a8ac8858SEugenio Pérez  * Set the call notifier for the SVQ to call the guest
558a8ac8858SEugenio Pérez  *
559a8ac8858SEugenio Pérez  * @svq: Shadow virtqueue
560a8ac8858SEugenio Pérez  * @call_fd: call notifier
561a8ac8858SEugenio Pérez  *
562a8ac8858SEugenio Pérez  * Called on BQL context.
563a8ac8858SEugenio Pérez  */
564a8ac8858SEugenio Pérez void vhost_svq_set_svq_call_fd(VhostShadowVirtqueue *svq, int call_fd)
565a8ac8858SEugenio Pérez {
566a8ac8858SEugenio Pérez     if (call_fd == VHOST_FILE_UNBIND) {
567a8ac8858SEugenio Pérez         /*
568a8ac8858SEugenio Pérez          * Fail event_notifier_set if called handling device call.
569a8ac8858SEugenio Pérez          *
570a8ac8858SEugenio Pérez          * SVQ still needs device notifications, since it needs to keep
571a8ac8858SEugenio Pérez          * forwarding used buffers even with the unbind.
572a8ac8858SEugenio Pérez          */
573a8ac8858SEugenio Pérez         memset(&svq->svq_call, 0, sizeof(svq->svq_call));
574a8ac8858SEugenio Pérez     } else {
575a8ac8858SEugenio Pérez         event_notifier_init_fd(&svq->svq_call, call_fd);
576a8ac8858SEugenio Pérez     }
577a8ac8858SEugenio Pérez }
578a8ac8858SEugenio Pérez 
579a8ac8858SEugenio Pérez /**
580dafb34c9SEugenio Pérez  * Get the shadow vq vring address.
581dafb34c9SEugenio Pérez  * @svq: Shadow virtqueue
582dafb34c9SEugenio Pérez  * @addr: Destination to store address
583dafb34c9SEugenio Pérez  */
584dafb34c9SEugenio Pérez void vhost_svq_get_vring_addr(const VhostShadowVirtqueue *svq,
585dafb34c9SEugenio Pérez                               struct vhost_vring_addr *addr)
586dafb34c9SEugenio Pérez {
58734e3c94eSEugenio Pérez     addr->desc_user_addr = (uint64_t)(uintptr_t)svq->vring.desc;
58834e3c94eSEugenio Pérez     addr->avail_user_addr = (uint64_t)(uintptr_t)svq->vring.avail;
58934e3c94eSEugenio Pérez     addr->used_user_addr = (uint64_t)(uintptr_t)svq->vring.used;
590dafb34c9SEugenio Pérez }
591dafb34c9SEugenio Pérez 
592dafb34c9SEugenio Pérez size_t vhost_svq_driver_area_size(const VhostShadowVirtqueue *svq)
593dafb34c9SEugenio Pérez {
594dafb34c9SEugenio Pérez     size_t desc_size = sizeof(vring_desc_t) * svq->vring.num;
595f0c48e05SEugenio Pérez     size_t avail_size = offsetof(vring_avail_t, ring[svq->vring.num]) +
596f0c48e05SEugenio Pérez                                                               sizeof(uint16_t);
597dafb34c9SEugenio Pérez 
5988e3b0cbbSMarc-André Lureau     return ROUND_UP(desc_size + avail_size, qemu_real_host_page_size());
599dafb34c9SEugenio Pérez }
600dafb34c9SEugenio Pérez 
601dafb34c9SEugenio Pérez size_t vhost_svq_device_area_size(const VhostShadowVirtqueue *svq)
602dafb34c9SEugenio Pérez {
603f0c48e05SEugenio Pérez     size_t used_size = offsetof(vring_used_t, ring[svq->vring.num]) +
604f0c48e05SEugenio Pérez                                                               sizeof(uint16_t);
6058e3b0cbbSMarc-André Lureau     return ROUND_UP(used_size, qemu_real_host_page_size());
606dafb34c9SEugenio Pérez }
607dafb34c9SEugenio Pérez 
608dafb34c9SEugenio Pérez /**
609dff4426fSEugenio Pérez  * Set a new file descriptor for the guest to kick the SVQ and notify for avail
610dff4426fSEugenio Pérez  *
611dff4426fSEugenio Pérez  * @svq: The svq
612dff4426fSEugenio Pérez  * @svq_kick_fd: The svq kick fd
613dff4426fSEugenio Pérez  *
614dff4426fSEugenio Pérez  * Note that the SVQ will never close the old file descriptor.
615dff4426fSEugenio Pérez  */
616dff4426fSEugenio Pérez void vhost_svq_set_svq_kick_fd(VhostShadowVirtqueue *svq, int svq_kick_fd)
617dff4426fSEugenio Pérez {
618dff4426fSEugenio Pérez     EventNotifier *svq_kick = &svq->svq_kick;
619dff4426fSEugenio Pérez     bool poll_stop = VHOST_FILE_UNBIND != event_notifier_get_fd(svq_kick);
620dff4426fSEugenio Pérez     bool poll_start = svq_kick_fd != VHOST_FILE_UNBIND;
621dff4426fSEugenio Pérez 
622dff4426fSEugenio Pérez     if (poll_stop) {
623dff4426fSEugenio Pérez         event_notifier_set_handler(svq_kick, NULL);
624dff4426fSEugenio Pérez     }
625dff4426fSEugenio Pérez 
6268b64e486SEugenio Pérez     event_notifier_init_fd(svq_kick, svq_kick_fd);
627dff4426fSEugenio Pérez     /*
628dff4426fSEugenio Pérez      * event_notifier_set_handler already checks for guest's notifications if
629dff4426fSEugenio Pérez      * they arrive at the new file descriptor in the switch, so there is no
630dff4426fSEugenio Pérez      * need to explicitly check for them.
631dff4426fSEugenio Pérez      */
632dff4426fSEugenio Pérez     if (poll_start) {
633dff4426fSEugenio Pérez         event_notifier_set(svq_kick);
634100890f7SEugenio Pérez         event_notifier_set_handler(svq_kick, vhost_handle_guest_kick_notifier);
635100890f7SEugenio Pérez     }
636100890f7SEugenio Pérez }
637100890f7SEugenio Pérez 
638100890f7SEugenio Pérez /**
639100890f7SEugenio Pérez  * Start the shadow virtqueue operation.
640100890f7SEugenio Pérez  *
641100890f7SEugenio Pérez  * @svq: Shadow Virtqueue
642100890f7SEugenio Pérez  * @vdev: VirtIO device
643100890f7SEugenio Pérez  * @vq: Virtqueue to shadow
644100890f7SEugenio Pérez  */
645100890f7SEugenio Pérez void vhost_svq_start(VhostShadowVirtqueue *svq, VirtIODevice *vdev,
646100890f7SEugenio Pérez                      VirtQueue *vq)
647100890f7SEugenio Pérez {
648100890f7SEugenio Pérez     size_t desc_size, driver_size, device_size;
649100890f7SEugenio Pérez 
650100890f7SEugenio Pérez     svq->next_guest_avail_elem = NULL;
651100890f7SEugenio Pérez     svq->shadow_avail_idx = 0;
652100890f7SEugenio Pérez     svq->shadow_used_idx = 0;
653100890f7SEugenio Pérez     svq->last_used_idx = 0;
654100890f7SEugenio Pérez     svq->vdev = vdev;
655100890f7SEugenio Pérez     svq->vq = vq;
656100890f7SEugenio Pérez 
657100890f7SEugenio Pérez     svq->vring.num = virtio_queue_get_num(vdev, virtio_get_queue_index(vq));
658100890f7SEugenio Pérez     driver_size = vhost_svq_driver_area_size(svq);
659100890f7SEugenio Pérez     device_size = vhost_svq_device_area_size(svq);
6608e3b0cbbSMarc-André Lureau     svq->vring.desc = qemu_memalign(qemu_real_host_page_size(), driver_size);
661100890f7SEugenio Pérez     desc_size = sizeof(vring_desc_t) * svq->vring.num;
662100890f7SEugenio Pérez     svq->vring.avail = (void *)((char *)svq->vring.desc + desc_size);
663100890f7SEugenio Pérez     memset(svq->vring.desc, 0, driver_size);
6648e3b0cbbSMarc-André Lureau     svq->vring.used = qemu_memalign(qemu_real_host_page_size(), device_size);
665100890f7SEugenio Pérez     memset(svq->vring.used, 0, device_size);
6669e87868fSEugenio Pérez     svq->desc_state = g_new0(SVQDescState, svq->vring.num);
667495fe3a7SEugenio Pérez     svq->desc_next = g_new0(uint16_t, svq->vring.num);
668100890f7SEugenio Pérez     for (unsigned i = 0; i < svq->vring.num - 1; i++) {
669495fe3a7SEugenio Pérez         svq->desc_next[i] = cpu_to_le16(i + 1);
670dff4426fSEugenio Pérez     }
671dff4426fSEugenio Pérez }
672dff4426fSEugenio Pérez 
673dff4426fSEugenio Pérez /**
674dff4426fSEugenio Pérez  * Stop the shadow virtqueue operation.
675dff4426fSEugenio Pérez  * @svq: Shadow Virtqueue
676dff4426fSEugenio Pérez  */
677dff4426fSEugenio Pérez void vhost_svq_stop(VhostShadowVirtqueue *svq)
678dff4426fSEugenio Pérez {
6798b64e486SEugenio Pérez     vhost_svq_set_svq_kick_fd(svq, VHOST_FILE_UNBIND);
680100890f7SEugenio Pérez     g_autofree VirtQueueElement *next_avail_elem = NULL;
681100890f7SEugenio Pérez 
682100890f7SEugenio Pérez     if (!svq->vq) {
683100890f7SEugenio Pérez         return;
684100890f7SEugenio Pérez     }
685100890f7SEugenio Pérez 
686100890f7SEugenio Pérez     /* Send all pending used descriptors to guest */
687100890f7SEugenio Pérez     vhost_svq_flush(svq, false);
688100890f7SEugenio Pérez 
689100890f7SEugenio Pérez     for (unsigned i = 0; i < svq->vring.num; ++i) {
690100890f7SEugenio Pérez         g_autofree VirtQueueElement *elem = NULL;
6919e87868fSEugenio Pérez         elem = g_steal_pointer(&svq->desc_state[i].elem);
692100890f7SEugenio Pérez         if (elem) {
693100890f7SEugenio Pérez             virtqueue_detach_element(svq->vq, elem, 0);
694100890f7SEugenio Pérez         }
695100890f7SEugenio Pérez     }
696100890f7SEugenio Pérez 
697100890f7SEugenio Pérez     next_avail_elem = g_steal_pointer(&svq->next_guest_avail_elem);
698100890f7SEugenio Pérez     if (next_avail_elem) {
699100890f7SEugenio Pérez         virtqueue_detach_element(svq->vq, next_avail_elem, 0);
700100890f7SEugenio Pérez     }
701100890f7SEugenio Pérez     svq->vq = NULL;
702495fe3a7SEugenio Pérez     g_free(svq->desc_next);
7039e87868fSEugenio Pérez     g_free(svq->desc_state);
704100890f7SEugenio Pérez     qemu_vfree(svq->vring.desc);
705100890f7SEugenio Pérez     qemu_vfree(svq->vring.used);
706dff4426fSEugenio Pérez }
70710857ec0SEugenio Pérez 
70810857ec0SEugenio Pérez /**
70910857ec0SEugenio Pérez  * Creates vhost shadow virtqueue, and instructs the vhost device to use the
71010857ec0SEugenio Pérez  * shadow methods and file descriptors.
71110857ec0SEugenio Pérez  *
71234e3c94eSEugenio Pérez  * @iova_tree: Tree to perform descriptors translations
713e966c0b7SEugenio Pérez  * @ops: SVQ owner callbacks
714e966c0b7SEugenio Pérez  * @ops_opaque: ops opaque pointer
71534e3c94eSEugenio Pérez  *
71610857ec0SEugenio Pérez  * Returns the new virtqueue or NULL.
71710857ec0SEugenio Pérez  *
71810857ec0SEugenio Pérez  * In case of error, reason is reported through error_report.
71910857ec0SEugenio Pérez  */
720e966c0b7SEugenio Pérez VhostShadowVirtqueue *vhost_svq_new(VhostIOVATree *iova_tree,
721e966c0b7SEugenio Pérez                                     const VhostShadowVirtqueueOps *ops,
722e966c0b7SEugenio Pérez                                     void *ops_opaque)
72310857ec0SEugenio Pérez {
72410857ec0SEugenio Pérez     g_autofree VhostShadowVirtqueue *svq = g_new0(VhostShadowVirtqueue, 1);
72510857ec0SEugenio Pérez     int r;
72610857ec0SEugenio Pérez 
72710857ec0SEugenio Pérez     r = event_notifier_init(&svq->hdev_kick, 0);
72810857ec0SEugenio Pérez     if (r != 0) {
72910857ec0SEugenio Pérez         error_report("Couldn't create kick event notifier: %s (%d)",
73010857ec0SEugenio Pérez                      g_strerror(errno), errno);
73110857ec0SEugenio Pérez         goto err_init_hdev_kick;
73210857ec0SEugenio Pérez     }
73310857ec0SEugenio Pérez 
73410857ec0SEugenio Pérez     r = event_notifier_init(&svq->hdev_call, 0);
73510857ec0SEugenio Pérez     if (r != 0) {
73610857ec0SEugenio Pérez         error_report("Couldn't create call event notifier: %s (%d)",
73710857ec0SEugenio Pérez                      g_strerror(errno), errno);
73810857ec0SEugenio Pérez         goto err_init_hdev_call;
73910857ec0SEugenio Pérez     }
74010857ec0SEugenio Pérez 
741dff4426fSEugenio Pérez     event_notifier_init_fd(&svq->svq_kick, VHOST_FILE_UNBIND);
742a8ac8858SEugenio Pérez     event_notifier_set_handler(&svq->hdev_call, vhost_svq_handle_call);
74334e3c94eSEugenio Pérez     svq->iova_tree = iova_tree;
744e966c0b7SEugenio Pérez     svq->ops = ops;
745e966c0b7SEugenio Pérez     svq->ops_opaque = ops_opaque;
74610857ec0SEugenio Pérez     return g_steal_pointer(&svq);
74710857ec0SEugenio Pérez 
74810857ec0SEugenio Pérez err_init_hdev_call:
74910857ec0SEugenio Pérez     event_notifier_cleanup(&svq->hdev_kick);
75010857ec0SEugenio Pérez 
75110857ec0SEugenio Pérez err_init_hdev_kick:
75210857ec0SEugenio Pérez     return NULL;
75310857ec0SEugenio Pérez }
75410857ec0SEugenio Pérez 
75510857ec0SEugenio Pérez /**
75610857ec0SEugenio Pérez  * Free the resources of the shadow virtqueue.
75710857ec0SEugenio Pérez  *
75810857ec0SEugenio Pérez  * @pvq: gpointer to SVQ so it can be used by autofree functions.
75910857ec0SEugenio Pérez  */
76010857ec0SEugenio Pérez void vhost_svq_free(gpointer pvq)
76110857ec0SEugenio Pérez {
76210857ec0SEugenio Pérez     VhostShadowVirtqueue *vq = pvq;
763dff4426fSEugenio Pérez     vhost_svq_stop(vq);
76410857ec0SEugenio Pérez     event_notifier_cleanup(&vq->hdev_kick);
765a8ac8858SEugenio Pérez     event_notifier_set_handler(&vq->hdev_call, NULL);
76610857ec0SEugenio Pérez     event_notifier_cleanup(&vq->hdev_call);
76710857ec0SEugenio Pérez     g_free(vq);
76810857ec0SEugenio Pérez }
769