xref: /openbmc/qemu/hw/virtio/vhost.c (revision 7d87775f)
1 /*
2  * vhost support
3  *
4  * Copyright Red Hat, Inc. 2010
5  *
6  * Authors:
7  *  Michael S. Tsirkin <mst@redhat.com>
8  *
9  * This work is licensed under the terms of the GNU GPL, version 2.  See
10  * the COPYING file in the top-level directory.
11  *
12  * Contributions after 2012-01-13 are licensed under the terms of the
13  * GNU GPL, version 2 or (at your option) any later version.
14  */
15 
16 #include "qemu/osdep.h"
17 #include "qapi/error.h"
18 #include "hw/virtio/vhost.h"
19 #include "qemu/atomic.h"
20 #include "qemu/range.h"
21 #include "qemu/error-report.h"
22 #include "qemu/memfd.h"
23 #include "qemu/log.h"
24 #include "standard-headers/linux/vhost_types.h"
25 #include "hw/virtio/virtio-bus.h"
26 #include "hw/mem/memory-device.h"
27 #include "migration/blocker.h"
28 #include "migration/qemu-file-types.h"
29 #include "sysemu/dma.h"
30 #include "trace.h"
31 
32 /* enabled until disconnected backend stabilizes */
33 #define _VHOST_DEBUG 1
34 
35 #ifdef _VHOST_DEBUG
36 #define VHOST_OPS_DEBUG(retval, fmt, ...) \
37     do { \
38         error_report(fmt ": %s (%d)", ## __VA_ARGS__, \
39                      strerror(-retval), -retval); \
40     } while (0)
41 #else
42 #define VHOST_OPS_DEBUG(retval, fmt, ...) \
43     do { } while (0)
44 #endif
45 
46 static struct vhost_log *vhost_log[VHOST_BACKEND_TYPE_MAX];
47 static struct vhost_log *vhost_log_shm[VHOST_BACKEND_TYPE_MAX];
48 static QLIST_HEAD(, vhost_dev) vhost_log_devs[VHOST_BACKEND_TYPE_MAX];
49 
50 /* Memslots used by backends that support private memslots (without an fd). */
51 static unsigned int used_memslots;
52 
53 /* Memslots used by backends that only support shared memslots (with an fd). */
54 static unsigned int used_shared_memslots;
55 
56 static QLIST_HEAD(, vhost_dev) vhost_devices =
57     QLIST_HEAD_INITIALIZER(vhost_devices);
58 
59 unsigned int vhost_get_max_memslots(void)
60 {
61     unsigned int max = UINT_MAX;
62     struct vhost_dev *hdev;
63 
64     QLIST_FOREACH(hdev, &vhost_devices, entry) {
65         max = MIN(max, hdev->vhost_ops->vhost_backend_memslots_limit(hdev));
66     }
67     return max;
68 }
69 
70 unsigned int vhost_get_free_memslots(void)
71 {
72     unsigned int free = UINT_MAX;
73     struct vhost_dev *hdev;
74 
75     QLIST_FOREACH(hdev, &vhost_devices, entry) {
76         unsigned int r = hdev->vhost_ops->vhost_backend_memslots_limit(hdev);
77         unsigned int cur_free;
78 
79         if (hdev->vhost_ops->vhost_backend_no_private_memslots &&
80             hdev->vhost_ops->vhost_backend_no_private_memslots(hdev)) {
81             cur_free = r - used_shared_memslots;
82         } else {
83             cur_free = r - used_memslots;
84         }
85         free = MIN(free, cur_free);
86     }
87     return free;
88 }
89 
90 static void vhost_dev_sync_region(struct vhost_dev *dev,
91                                   MemoryRegionSection *section,
92                                   uint64_t mfirst, uint64_t mlast,
93                                   uint64_t rfirst, uint64_t rlast)
94 {
95     vhost_log_chunk_t *dev_log = dev->log->log;
96 
97     uint64_t start = MAX(mfirst, rfirst);
98     uint64_t end = MIN(mlast, rlast);
99     vhost_log_chunk_t *from = dev_log + start / VHOST_LOG_CHUNK;
100     vhost_log_chunk_t *to = dev_log + end / VHOST_LOG_CHUNK + 1;
101     uint64_t addr = QEMU_ALIGN_DOWN(start, VHOST_LOG_CHUNK);
102 
103     if (end < start) {
104         return;
105     }
106     assert(end / VHOST_LOG_CHUNK < dev->log_size);
107     assert(start / VHOST_LOG_CHUNK < dev->log_size);
108 
109     for (;from < to; ++from) {
110         vhost_log_chunk_t log;
111         /* We first check with non-atomic: much cheaper,
112          * and we expect non-dirty to be the common case. */
113         if (!*from) {
114             addr += VHOST_LOG_CHUNK;
115             continue;
116         }
117         /* Data must be read atomically. We don't really need barrier semantics
118          * but it's easier to use atomic_* than roll our own. */
119         log = qatomic_xchg(from, 0);
120         while (log) {
121             int bit = ctzl(log);
122             hwaddr page_addr;
123             hwaddr section_offset;
124             hwaddr mr_offset;
125             page_addr = addr + bit * VHOST_LOG_PAGE;
126             section_offset = page_addr - section->offset_within_address_space;
127             mr_offset = section_offset + section->offset_within_region;
128             memory_region_set_dirty(section->mr, mr_offset, VHOST_LOG_PAGE);
129             log &= ~(0x1ull << bit);
130         }
131         addr += VHOST_LOG_CHUNK;
132     }
133 }
134 
135 bool vhost_dev_has_iommu(struct vhost_dev *dev)
136 {
137     VirtIODevice *vdev = dev->vdev;
138 
139     /*
140      * For vhost, VIRTIO_F_IOMMU_PLATFORM means the backend support
141      * incremental memory mapping API via IOTLB API. For platform that
142      * does not have IOMMU, there's no need to enable this feature
143      * which may cause unnecessary IOTLB miss/update transactions.
144      */
145     if (vdev) {
146         return virtio_bus_device_iommu_enabled(vdev) &&
147             virtio_host_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM);
148     } else {
149         return false;
150     }
151 }
152 
153 static inline bool vhost_dev_should_log(struct vhost_dev *dev)
154 {
155     assert(dev->vhost_ops);
156     assert(dev->vhost_ops->backend_type > VHOST_BACKEND_TYPE_NONE);
157     assert(dev->vhost_ops->backend_type < VHOST_BACKEND_TYPE_MAX);
158 
159     return dev == QLIST_FIRST(&vhost_log_devs[dev->vhost_ops->backend_type]);
160 }
161 
162 static inline void vhost_dev_elect_mem_logger(struct vhost_dev *hdev, bool add)
163 {
164     VhostBackendType backend_type;
165 
166     assert(hdev->vhost_ops);
167 
168     backend_type = hdev->vhost_ops->backend_type;
169     assert(backend_type > VHOST_BACKEND_TYPE_NONE);
170     assert(backend_type < VHOST_BACKEND_TYPE_MAX);
171 
172     if (add && !QLIST_IS_INSERTED(hdev, logdev_entry)) {
173         if (QLIST_EMPTY(&vhost_log_devs[backend_type])) {
174             QLIST_INSERT_HEAD(&vhost_log_devs[backend_type],
175                               hdev, logdev_entry);
176         } else {
177             /*
178              * The first vhost_device in the list is selected as the shared
179              * logger to scan memory sections. Put new entry next to the head
180              * to avoid inadvertent change to the underlying logger device.
181              * This is done in order to get better cache locality and to avoid
182              * performance churn on the hot path for log scanning. Even when
183              * new devices come and go quickly, it wouldn't end up changing
184              * the active leading logger device at all.
185              */
186             QLIST_INSERT_AFTER(QLIST_FIRST(&vhost_log_devs[backend_type]),
187                                hdev, logdev_entry);
188         }
189     } else if (!add && QLIST_IS_INSERTED(hdev, logdev_entry)) {
190         QLIST_REMOVE(hdev, logdev_entry);
191     }
192 }
193 
194 static int vhost_sync_dirty_bitmap(struct vhost_dev *dev,
195                                    MemoryRegionSection *section,
196                                    hwaddr first,
197                                    hwaddr last)
198 {
199     int i;
200     hwaddr start_addr;
201     hwaddr end_addr;
202 
203     if (!dev->log_enabled || !dev->started) {
204         return 0;
205     }
206     start_addr = section->offset_within_address_space;
207     end_addr = range_get_last(start_addr, int128_get64(section->size));
208     start_addr = MAX(first, start_addr);
209     end_addr = MIN(last, end_addr);
210 
211     if (vhost_dev_should_log(dev)) {
212         for (i = 0; i < dev->mem->nregions; ++i) {
213             struct vhost_memory_region *reg = dev->mem->regions + i;
214             vhost_dev_sync_region(dev, section, start_addr, end_addr,
215                                   reg->guest_phys_addr,
216                                   range_get_last(reg->guest_phys_addr,
217                                                  reg->memory_size));
218         }
219     }
220     for (i = 0; i < dev->nvqs; ++i) {
221         struct vhost_virtqueue *vq = dev->vqs + i;
222 
223         if (!vq->used_phys && !vq->used_size) {
224             continue;
225         }
226 
227         if (vhost_dev_has_iommu(dev)) {
228             IOMMUTLBEntry iotlb;
229             hwaddr used_phys = vq->used_phys, used_size = vq->used_size;
230             hwaddr phys, s, offset;
231 
232             while (used_size) {
233                 rcu_read_lock();
234                 iotlb = address_space_get_iotlb_entry(dev->vdev->dma_as,
235                                                       used_phys,
236                                                       true,
237                                                       MEMTXATTRS_UNSPECIFIED);
238                 rcu_read_unlock();
239 
240                 if (!iotlb.target_as) {
241                     qemu_log_mask(LOG_GUEST_ERROR, "translation "
242                                   "failure for used_iova %"PRIx64"\n",
243                                   used_phys);
244                     return -EINVAL;
245                 }
246 
247                 offset = used_phys & iotlb.addr_mask;
248                 phys = iotlb.translated_addr + offset;
249 
250                 /*
251                  * Distance from start of used ring until last byte of
252                  * IOMMU page.
253                  */
254                 s = iotlb.addr_mask - offset;
255                 /*
256                  * Size of used ring, or of the part of it until end
257                  * of IOMMU page. To avoid zero result, do the adding
258                  * outside of MIN().
259                  */
260                 s = MIN(s, used_size - 1) + 1;
261 
262                 vhost_dev_sync_region(dev, section, start_addr, end_addr, phys,
263                                       range_get_last(phys, s));
264                 used_size -= s;
265                 used_phys += s;
266             }
267         } else {
268             vhost_dev_sync_region(dev, section, start_addr,
269                                   end_addr, vq->used_phys,
270                                   range_get_last(vq->used_phys, vq->used_size));
271         }
272     }
273     return 0;
274 }
275 
276 static void vhost_log_sync(MemoryListener *listener,
277                           MemoryRegionSection *section)
278 {
279     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
280                                          memory_listener);
281     vhost_sync_dirty_bitmap(dev, section, 0x0, ~0x0ULL);
282 }
283 
284 static void vhost_log_sync_range(struct vhost_dev *dev,
285                                  hwaddr first, hwaddr last)
286 {
287     int i;
288     /* FIXME: this is N^2 in number of sections */
289     for (i = 0; i < dev->n_mem_sections; ++i) {
290         MemoryRegionSection *section = &dev->mem_sections[i];
291         vhost_sync_dirty_bitmap(dev, section, first, last);
292     }
293 }
294 
295 static uint64_t vhost_get_log_size(struct vhost_dev *dev)
296 {
297     uint64_t log_size = 0;
298     int i;
299     for (i = 0; i < dev->mem->nregions; ++i) {
300         struct vhost_memory_region *reg = dev->mem->regions + i;
301         uint64_t last = range_get_last(reg->guest_phys_addr,
302                                        reg->memory_size);
303         log_size = MAX(log_size, last / VHOST_LOG_CHUNK + 1);
304     }
305     return log_size;
306 }
307 
308 static int vhost_set_backend_type(struct vhost_dev *dev,
309                                   VhostBackendType backend_type)
310 {
311     int r = 0;
312 
313     switch (backend_type) {
314 #ifdef CONFIG_VHOST_KERNEL
315     case VHOST_BACKEND_TYPE_KERNEL:
316         dev->vhost_ops = &kernel_ops;
317         break;
318 #endif
319 #ifdef CONFIG_VHOST_USER
320     case VHOST_BACKEND_TYPE_USER:
321         dev->vhost_ops = &user_ops;
322         break;
323 #endif
324 #ifdef CONFIG_VHOST_VDPA
325     case VHOST_BACKEND_TYPE_VDPA:
326         dev->vhost_ops = &vdpa_ops;
327         break;
328 #endif
329     default:
330         error_report("Unknown vhost backend type");
331         r = -1;
332     }
333 
334     if (r == 0) {
335         assert(dev->vhost_ops->backend_type == backend_type);
336     }
337 
338     return r;
339 }
340 
341 static struct vhost_log *vhost_log_alloc(uint64_t size, bool share)
342 {
343     Error *err = NULL;
344     struct vhost_log *log;
345     uint64_t logsize = size * sizeof(*(log->log));
346     int fd = -1;
347 
348     log = g_new0(struct vhost_log, 1);
349     if (share) {
350         log->log = qemu_memfd_alloc("vhost-log", logsize,
351                                     F_SEAL_GROW | F_SEAL_SHRINK | F_SEAL_SEAL,
352                                     &fd, &err);
353         if (err) {
354             error_report_err(err);
355             g_free(log);
356             return NULL;
357         }
358         memset(log->log, 0, logsize);
359     } else {
360         log->log = g_malloc0(logsize);
361     }
362 
363     log->size = size;
364     log->refcnt = 1;
365     log->fd = fd;
366 
367     return log;
368 }
369 
370 static struct vhost_log *vhost_log_get(VhostBackendType backend_type,
371                                        uint64_t size, bool share)
372 {
373     struct vhost_log *log;
374 
375     assert(backend_type > VHOST_BACKEND_TYPE_NONE);
376     assert(backend_type < VHOST_BACKEND_TYPE_MAX);
377 
378     log = share ? vhost_log_shm[backend_type] : vhost_log[backend_type];
379 
380     if (!log || log->size != size) {
381         log = vhost_log_alloc(size, share);
382         if (share) {
383             vhost_log_shm[backend_type] = log;
384         } else {
385             vhost_log[backend_type] = log;
386         }
387     } else {
388         ++log->refcnt;
389     }
390 
391     return log;
392 }
393 
394 static void vhost_log_put(struct vhost_dev *dev, bool sync)
395 {
396     struct vhost_log *log = dev->log;
397     VhostBackendType backend_type;
398 
399     if (!log) {
400         return;
401     }
402 
403     assert(dev->vhost_ops);
404     backend_type = dev->vhost_ops->backend_type;
405 
406     if (backend_type == VHOST_BACKEND_TYPE_NONE ||
407         backend_type >= VHOST_BACKEND_TYPE_MAX) {
408         return;
409     }
410 
411     --log->refcnt;
412     if (log->refcnt == 0) {
413         /* Sync only the range covered by the old log */
414         if (dev->log_size && sync) {
415             vhost_log_sync_range(dev, 0, dev->log_size * VHOST_LOG_CHUNK - 1);
416         }
417 
418         if (vhost_log[backend_type] == log) {
419             g_free(log->log);
420             vhost_log[backend_type] = NULL;
421         } else if (vhost_log_shm[backend_type] == log) {
422             qemu_memfd_free(log->log, log->size * sizeof(*(log->log)),
423                             log->fd);
424             vhost_log_shm[backend_type] = NULL;
425         }
426 
427         g_free(log);
428     }
429 
430     vhost_dev_elect_mem_logger(dev, false);
431     dev->log = NULL;
432     dev->log_size = 0;
433 }
434 
435 static bool vhost_dev_log_is_shared(struct vhost_dev *dev)
436 {
437     return dev->vhost_ops->vhost_requires_shm_log &&
438            dev->vhost_ops->vhost_requires_shm_log(dev);
439 }
440 
441 static inline void vhost_dev_log_resize(struct vhost_dev *dev, uint64_t size)
442 {
443     struct vhost_log *log = vhost_log_get(dev->vhost_ops->backend_type,
444                                           size, vhost_dev_log_is_shared(dev));
445     uint64_t log_base = (uintptr_t)log->log;
446     int r;
447 
448     /* inform backend of log switching, this must be done before
449        releasing the current log, to ensure no logging is lost */
450     r = dev->vhost_ops->vhost_set_log_base(dev, log_base, log);
451     if (r < 0) {
452         VHOST_OPS_DEBUG(r, "vhost_set_log_base failed");
453     }
454 
455     vhost_log_put(dev, true);
456     dev->log = log;
457     dev->log_size = size;
458 }
459 
460 static void *vhost_memory_map(struct vhost_dev *dev, hwaddr addr,
461                               hwaddr *plen, bool is_write)
462 {
463     if (!vhost_dev_has_iommu(dev)) {
464         return cpu_physical_memory_map(addr, plen, is_write);
465     } else {
466         return (void *)(uintptr_t)addr;
467     }
468 }
469 
470 static void vhost_memory_unmap(struct vhost_dev *dev, void *buffer,
471                                hwaddr len, int is_write,
472                                hwaddr access_len)
473 {
474     if (!vhost_dev_has_iommu(dev)) {
475         cpu_physical_memory_unmap(buffer, len, is_write, access_len);
476     }
477 }
478 
479 static int vhost_verify_ring_part_mapping(void *ring_hva,
480                                           uint64_t ring_gpa,
481                                           uint64_t ring_size,
482                                           void *reg_hva,
483                                           uint64_t reg_gpa,
484                                           uint64_t reg_size)
485 {
486     uint64_t hva_ring_offset;
487     uint64_t ring_last = range_get_last(ring_gpa, ring_size);
488     uint64_t reg_last = range_get_last(reg_gpa, reg_size);
489 
490     if (ring_last < reg_gpa || ring_gpa > reg_last) {
491         return 0;
492     }
493     /* check that whole ring's is mapped */
494     if (ring_last > reg_last) {
495         return -ENOMEM;
496     }
497     /* check that ring's MemoryRegion wasn't replaced */
498     hva_ring_offset = ring_gpa - reg_gpa;
499     if (ring_hva != reg_hva + hva_ring_offset) {
500         return -EBUSY;
501     }
502 
503     return 0;
504 }
505 
506 static int vhost_verify_ring_mappings(struct vhost_dev *dev,
507                                       void *reg_hva,
508                                       uint64_t reg_gpa,
509                                       uint64_t reg_size)
510 {
511     int i, j;
512     int r = 0;
513     const char *part_name[] = {
514         "descriptor table",
515         "available ring",
516         "used ring"
517     };
518 
519     if (vhost_dev_has_iommu(dev)) {
520         return 0;
521     }
522 
523     for (i = 0; i < dev->nvqs; ++i) {
524         struct vhost_virtqueue *vq = dev->vqs + i;
525 
526         if (vq->desc_phys == 0) {
527             continue;
528         }
529 
530         j = 0;
531         r = vhost_verify_ring_part_mapping(
532                 vq->desc, vq->desc_phys, vq->desc_size,
533                 reg_hva, reg_gpa, reg_size);
534         if (r) {
535             break;
536         }
537 
538         j++;
539         r = vhost_verify_ring_part_mapping(
540                 vq->avail, vq->avail_phys, vq->avail_size,
541                 reg_hva, reg_gpa, reg_size);
542         if (r) {
543             break;
544         }
545 
546         j++;
547         r = vhost_verify_ring_part_mapping(
548                 vq->used, vq->used_phys, vq->used_size,
549                 reg_hva, reg_gpa, reg_size);
550         if (r) {
551             break;
552         }
553     }
554 
555     if (r == -ENOMEM) {
556         error_report("Unable to map %s for ring %d", part_name[j], i);
557     } else if (r == -EBUSY) {
558         error_report("%s relocated for ring %d", part_name[j], i);
559     }
560     return r;
561 }
562 
563 /*
564  * vhost_section: identify sections needed for vhost access
565  *
566  * We only care about RAM sections here (where virtqueue and guest
567  * internals accessed by virtio might live).
568  */
569 static bool vhost_section(struct vhost_dev *dev, MemoryRegionSection *section)
570 {
571     MemoryRegion *mr = section->mr;
572 
573     if (memory_region_is_ram(mr) && !memory_region_is_rom(mr)) {
574         uint8_t dirty_mask = memory_region_get_dirty_log_mask(mr);
575         uint8_t handled_dirty;
576 
577         /*
578          * Kernel based vhost doesn't handle any block which is doing
579          * dirty-tracking other than migration for which it has
580          * specific logging support. However for TCG the kernel never
581          * gets involved anyway so we can also ignore it's
582          * self-modiying code detection flags. However a vhost-user
583          * client could still confuse a TCG guest if it re-writes
584          * executable memory that has already been translated.
585          */
586         handled_dirty = (1 << DIRTY_MEMORY_MIGRATION) |
587             (1 << DIRTY_MEMORY_CODE);
588 
589         if (dirty_mask & ~handled_dirty) {
590             trace_vhost_reject_section(mr->name, 1);
591             return false;
592         }
593 
594         /*
595          * Some backends (like vhost-user) can only handle memory regions
596          * that have an fd (can be mapped into a different process). Filter
597          * the ones without an fd out, if requested.
598          *
599          * TODO: we might have to limit to MAP_SHARED as well.
600          */
601         if (memory_region_get_fd(section->mr) < 0 &&
602             dev->vhost_ops->vhost_backend_no_private_memslots &&
603             dev->vhost_ops->vhost_backend_no_private_memslots(dev)) {
604             trace_vhost_reject_section(mr->name, 2);
605             return false;
606         }
607 
608         trace_vhost_section(mr->name);
609         return true;
610     } else {
611         trace_vhost_reject_section(mr->name, 3);
612         return false;
613     }
614 }
615 
616 static void vhost_begin(MemoryListener *listener)
617 {
618     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
619                                          memory_listener);
620     dev->tmp_sections = NULL;
621     dev->n_tmp_sections = 0;
622 }
623 
624 static void vhost_commit(MemoryListener *listener)
625 {
626     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
627                                          memory_listener);
628     MemoryRegionSection *old_sections;
629     int n_old_sections;
630     uint64_t log_size;
631     size_t regions_size;
632     int r;
633     int i;
634     bool changed = false;
635 
636     /* Note we can be called before the device is started, but then
637      * starting the device calls set_mem_table, so we need to have
638      * built the data structures.
639      */
640     old_sections = dev->mem_sections;
641     n_old_sections = dev->n_mem_sections;
642     dev->mem_sections = dev->tmp_sections;
643     dev->n_mem_sections = dev->n_tmp_sections;
644 
645     if (dev->n_mem_sections != n_old_sections) {
646         changed = true;
647     } else {
648         /* Same size, lets check the contents */
649         for (i = 0; i < n_old_sections; i++) {
650             if (!MemoryRegionSection_eq(&old_sections[i],
651                                         &dev->mem_sections[i])) {
652                 changed = true;
653                 break;
654             }
655         }
656     }
657 
658     trace_vhost_commit(dev->started, changed);
659     if (!changed) {
660         goto out;
661     }
662 
663     /* Rebuild the regions list from the new sections list */
664     regions_size = offsetof(struct vhost_memory, regions) +
665                        dev->n_mem_sections * sizeof dev->mem->regions[0];
666     dev->mem = g_realloc(dev->mem, regions_size);
667     dev->mem->nregions = dev->n_mem_sections;
668 
669     if (dev->vhost_ops->vhost_backend_no_private_memslots &&
670         dev->vhost_ops->vhost_backend_no_private_memslots(dev)) {
671         used_shared_memslots = dev->mem->nregions;
672     } else {
673         used_memslots = dev->mem->nregions;
674     }
675 
676     for (i = 0; i < dev->n_mem_sections; i++) {
677         struct vhost_memory_region *cur_vmr = dev->mem->regions + i;
678         struct MemoryRegionSection *mrs = dev->mem_sections + i;
679 
680         cur_vmr->guest_phys_addr = mrs->offset_within_address_space;
681         cur_vmr->memory_size     = int128_get64(mrs->size);
682         cur_vmr->userspace_addr  =
683             (uintptr_t)memory_region_get_ram_ptr(mrs->mr) +
684             mrs->offset_within_region;
685         cur_vmr->flags_padding   = 0;
686     }
687 
688     if (!dev->started) {
689         goto out;
690     }
691 
692     for (i = 0; i < dev->mem->nregions; i++) {
693         if (vhost_verify_ring_mappings(dev,
694                        (void *)(uintptr_t)dev->mem->regions[i].userspace_addr,
695                        dev->mem->regions[i].guest_phys_addr,
696                        dev->mem->regions[i].memory_size)) {
697             error_report("Verify ring failure on region %d", i);
698             abort();
699         }
700     }
701 
702     if (!dev->log_enabled) {
703         r = dev->vhost_ops->vhost_set_mem_table(dev, dev->mem);
704         if (r < 0) {
705             VHOST_OPS_DEBUG(r, "vhost_set_mem_table failed");
706         }
707         goto out;
708     }
709     log_size = vhost_get_log_size(dev);
710     /* We allocate an extra 4K bytes to log,
711      * to reduce the * number of reallocations. */
712 #define VHOST_LOG_BUFFER (0x1000 / sizeof *dev->log)
713     /* To log more, must increase log size before table update. */
714     if (dev->log_size < log_size) {
715         vhost_dev_log_resize(dev, log_size + VHOST_LOG_BUFFER);
716     }
717     r = dev->vhost_ops->vhost_set_mem_table(dev, dev->mem);
718     if (r < 0) {
719         VHOST_OPS_DEBUG(r, "vhost_set_mem_table failed");
720     }
721     /* To log less, can only decrease log size after table update. */
722     if (dev->log_size > log_size + VHOST_LOG_BUFFER) {
723         vhost_dev_log_resize(dev, log_size);
724     }
725 
726 out:
727     /* Deref the old list of sections, this must happen _after_ the
728      * vhost_set_mem_table to ensure the client isn't still using the
729      * section we're about to unref.
730      */
731     while (n_old_sections--) {
732         memory_region_unref(old_sections[n_old_sections].mr);
733     }
734     g_free(old_sections);
735     return;
736 }
737 
738 /* Adds the section data to the tmp_section structure.
739  * It relies on the listener calling us in memory address order
740  * and for each region (via the _add and _nop methods) to
741  * join neighbours.
742  */
743 static void vhost_region_add_section(struct vhost_dev *dev,
744                                      MemoryRegionSection *section)
745 {
746     bool need_add = true;
747     uint64_t mrs_size = int128_get64(section->size);
748     uint64_t mrs_gpa = section->offset_within_address_space;
749     uintptr_t mrs_host = (uintptr_t)memory_region_get_ram_ptr(section->mr) +
750                          section->offset_within_region;
751     RAMBlock *mrs_rb = section->mr->ram_block;
752 
753     trace_vhost_region_add_section(section->mr->name, mrs_gpa, mrs_size,
754                                    mrs_host);
755 
756     if (dev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_USER) {
757         /* Round the section to it's page size */
758         /* First align the start down to a page boundary */
759         size_t mrs_page = qemu_ram_pagesize(mrs_rb);
760         uint64_t alignage = mrs_host & (mrs_page - 1);
761         if (alignage) {
762             mrs_host -= alignage;
763             mrs_size += alignage;
764             mrs_gpa  -= alignage;
765         }
766         /* Now align the size up to a page boundary */
767         alignage = mrs_size & (mrs_page - 1);
768         if (alignage) {
769             mrs_size += mrs_page - alignage;
770         }
771         trace_vhost_region_add_section_aligned(section->mr->name, mrs_gpa,
772                                                mrs_size, mrs_host);
773     }
774 
775     if (dev->n_tmp_sections && !section->unmergeable) {
776         /* Since we already have at least one section, lets see if
777          * this extends it; since we're scanning in order, we only
778          * have to look at the last one, and the FlatView that calls
779          * us shouldn't have overlaps.
780          */
781         MemoryRegionSection *prev_sec = dev->tmp_sections +
782                                                (dev->n_tmp_sections - 1);
783         uint64_t prev_gpa_start = prev_sec->offset_within_address_space;
784         uint64_t prev_size = int128_get64(prev_sec->size);
785         uint64_t prev_gpa_end   = range_get_last(prev_gpa_start, prev_size);
786         uint64_t prev_host_start =
787                         (uintptr_t)memory_region_get_ram_ptr(prev_sec->mr) +
788                         prev_sec->offset_within_region;
789         uint64_t prev_host_end   = range_get_last(prev_host_start, prev_size);
790 
791         if (mrs_gpa <= (prev_gpa_end + 1)) {
792             /* OK, looks like overlapping/intersecting - it's possible that
793              * the rounding to page sizes has made them overlap, but they should
794              * match up in the same RAMBlock if they do.
795              */
796             if (mrs_gpa < prev_gpa_start) {
797                 error_report("%s:Section '%s' rounded to %"PRIx64
798                              " prior to previous '%s' %"PRIx64,
799                              __func__, section->mr->name, mrs_gpa,
800                              prev_sec->mr->name, prev_gpa_start);
801                 /* A way to cleanly fail here would be better */
802                 return;
803             }
804             /* Offset from the start of the previous GPA to this GPA */
805             size_t offset = mrs_gpa - prev_gpa_start;
806 
807             if (prev_host_start + offset == mrs_host &&
808                 section->mr == prev_sec->mr && !prev_sec->unmergeable) {
809                 uint64_t max_end = MAX(prev_host_end, mrs_host + mrs_size);
810                 need_add = false;
811                 prev_sec->offset_within_address_space =
812                     MIN(prev_gpa_start, mrs_gpa);
813                 prev_sec->offset_within_region =
814                     MIN(prev_host_start, mrs_host) -
815                     (uintptr_t)memory_region_get_ram_ptr(prev_sec->mr);
816                 prev_sec->size = int128_make64(max_end - MIN(prev_host_start,
817                                                mrs_host));
818                 trace_vhost_region_add_section_merge(section->mr->name,
819                                         int128_get64(prev_sec->size),
820                                         prev_sec->offset_within_address_space,
821                                         prev_sec->offset_within_region);
822             } else {
823                 /* adjoining regions are fine, but overlapping ones with
824                  * different blocks/offsets shouldn't happen
825                  */
826                 if (mrs_gpa != prev_gpa_end + 1) {
827                     error_report("%s: Overlapping but not coherent sections "
828                                  "at %"PRIx64,
829                                  __func__, mrs_gpa);
830                     return;
831                 }
832             }
833         }
834     }
835 
836     if (need_add) {
837         ++dev->n_tmp_sections;
838         dev->tmp_sections = g_renew(MemoryRegionSection, dev->tmp_sections,
839                                     dev->n_tmp_sections);
840         dev->tmp_sections[dev->n_tmp_sections - 1] = *section;
841         /* The flatview isn't stable and we don't use it, making it NULL
842          * means we can memcmp the list.
843          */
844         dev->tmp_sections[dev->n_tmp_sections - 1].fv = NULL;
845         memory_region_ref(section->mr);
846     }
847 }
848 
849 /* Used for both add and nop callbacks */
850 static void vhost_region_addnop(MemoryListener *listener,
851                                 MemoryRegionSection *section)
852 {
853     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
854                                          memory_listener);
855 
856     if (!vhost_section(dev, section)) {
857         return;
858     }
859     vhost_region_add_section(dev, section);
860 }
861 
862 static void vhost_iommu_unmap_notify(IOMMUNotifier *n, IOMMUTLBEntry *iotlb)
863 {
864     struct vhost_iommu *iommu = container_of(n, struct vhost_iommu, n);
865     struct vhost_dev *hdev = iommu->hdev;
866     hwaddr iova = iotlb->iova + iommu->iommu_offset;
867 
868     if (vhost_backend_invalidate_device_iotlb(hdev, iova,
869                                               iotlb->addr_mask + 1)) {
870         error_report("Fail to invalidate device iotlb");
871     }
872 }
873 
874 static void vhost_iommu_region_add(MemoryListener *listener,
875                                    MemoryRegionSection *section)
876 {
877     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
878                                          iommu_listener);
879     struct vhost_iommu *iommu;
880     Int128 end;
881     int iommu_idx;
882     IOMMUMemoryRegion *iommu_mr;
883 
884     if (!memory_region_is_iommu(section->mr)) {
885         return;
886     }
887 
888     iommu_mr = IOMMU_MEMORY_REGION(section->mr);
889 
890     iommu = g_malloc0(sizeof(*iommu));
891     end = int128_add(int128_make64(section->offset_within_region),
892                      section->size);
893     end = int128_sub(end, int128_one());
894     iommu_idx = memory_region_iommu_attrs_to_index(iommu_mr,
895                                                    MEMTXATTRS_UNSPECIFIED);
896     iommu_notifier_init(&iommu->n, vhost_iommu_unmap_notify,
897                         dev->vdev->device_iotlb_enabled ?
898                             IOMMU_NOTIFIER_DEVIOTLB_UNMAP :
899                             IOMMU_NOTIFIER_UNMAP,
900                         section->offset_within_region,
901                         int128_get64(end),
902                         iommu_idx);
903     iommu->mr = section->mr;
904     iommu->iommu_offset = section->offset_within_address_space -
905                           section->offset_within_region;
906     iommu->hdev = dev;
907     memory_region_register_iommu_notifier(section->mr, &iommu->n,
908                                           &error_fatal);
909     QLIST_INSERT_HEAD(&dev->iommu_list, iommu, iommu_next);
910     /* TODO: can replay help performance here? */
911 }
912 
913 static void vhost_iommu_region_del(MemoryListener *listener,
914                                    MemoryRegionSection *section)
915 {
916     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
917                                          iommu_listener);
918     struct vhost_iommu *iommu;
919 
920     if (!memory_region_is_iommu(section->mr)) {
921         return;
922     }
923 
924     QLIST_FOREACH(iommu, &dev->iommu_list, iommu_next) {
925         if (iommu->mr == section->mr &&
926             iommu->n.start == section->offset_within_region) {
927             memory_region_unregister_iommu_notifier(iommu->mr,
928                                                     &iommu->n);
929             QLIST_REMOVE(iommu, iommu_next);
930             g_free(iommu);
931             break;
932         }
933     }
934 }
935 
936 void vhost_toggle_device_iotlb(VirtIODevice *vdev)
937 {
938     VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
939     struct vhost_dev *dev;
940     struct vhost_iommu *iommu;
941 
942     if (vdev->vhost_started) {
943         dev = vdc->get_vhost(vdev);
944     } else {
945         return;
946     }
947 
948     QLIST_FOREACH(iommu, &dev->iommu_list, iommu_next) {
949         memory_region_unregister_iommu_notifier(iommu->mr, &iommu->n);
950         iommu->n.notifier_flags = vdev->device_iotlb_enabled ?
951                 IOMMU_NOTIFIER_DEVIOTLB_UNMAP : IOMMU_NOTIFIER_UNMAP;
952         memory_region_register_iommu_notifier(iommu->mr, &iommu->n,
953                                               &error_fatal);
954     }
955 }
956 
957 static int vhost_virtqueue_set_addr(struct vhost_dev *dev,
958                                     struct vhost_virtqueue *vq,
959                                     unsigned idx, bool enable_log)
960 {
961     struct vhost_vring_addr addr;
962     int r;
963     memset(&addr, 0, sizeof(struct vhost_vring_addr));
964 
965     if (dev->vhost_ops->vhost_vq_get_addr) {
966         r = dev->vhost_ops->vhost_vq_get_addr(dev, &addr, vq);
967         if (r < 0) {
968             VHOST_OPS_DEBUG(r, "vhost_vq_get_addr failed");
969             return r;
970         }
971     } else {
972         addr.desc_user_addr = (uint64_t)(unsigned long)vq->desc;
973         addr.avail_user_addr = (uint64_t)(unsigned long)vq->avail;
974         addr.used_user_addr = (uint64_t)(unsigned long)vq->used;
975     }
976     addr.index = idx;
977     addr.log_guest_addr = vq->used_phys;
978     addr.flags = enable_log ? (1 << VHOST_VRING_F_LOG) : 0;
979     r = dev->vhost_ops->vhost_set_vring_addr(dev, &addr);
980     if (r < 0) {
981         VHOST_OPS_DEBUG(r, "vhost_set_vring_addr failed");
982     }
983     return r;
984 }
985 
986 static int vhost_dev_set_features(struct vhost_dev *dev,
987                                   bool enable_log)
988 {
989     uint64_t features = dev->acked_features;
990     int r;
991     if (enable_log) {
992         features |= 0x1ULL << VHOST_F_LOG_ALL;
993     }
994     if (!vhost_dev_has_iommu(dev)) {
995         features &= ~(0x1ULL << VIRTIO_F_IOMMU_PLATFORM);
996     }
997     if (dev->vhost_ops->vhost_force_iommu) {
998         if (dev->vhost_ops->vhost_force_iommu(dev) == true) {
999             features |= 0x1ULL << VIRTIO_F_IOMMU_PLATFORM;
1000        }
1001     }
1002     r = dev->vhost_ops->vhost_set_features(dev, features);
1003     if (r < 0) {
1004         VHOST_OPS_DEBUG(r, "vhost_set_features failed");
1005         goto out;
1006     }
1007     if (dev->vhost_ops->vhost_set_backend_cap) {
1008         r = dev->vhost_ops->vhost_set_backend_cap(dev);
1009         if (r < 0) {
1010             VHOST_OPS_DEBUG(r, "vhost_set_backend_cap failed");
1011             goto out;
1012         }
1013     }
1014 
1015 out:
1016     return r;
1017 }
1018 
1019 static int vhost_dev_set_log(struct vhost_dev *dev, bool enable_log)
1020 {
1021     int r, i, idx;
1022     hwaddr addr;
1023 
1024     r = vhost_dev_set_features(dev, enable_log);
1025     if (r < 0) {
1026         goto err_features;
1027     }
1028     for (i = 0; i < dev->nvqs; ++i) {
1029         idx = dev->vhost_ops->vhost_get_vq_index(dev, dev->vq_index + i);
1030         addr = virtio_queue_get_desc_addr(dev->vdev, idx);
1031         if (!addr) {
1032             /*
1033              * The queue might not be ready for start. If this
1034              * is the case there is no reason to continue the process.
1035              * The similar logic is used by the vhost_virtqueue_start()
1036              * routine.
1037              */
1038             continue;
1039         }
1040         r = vhost_virtqueue_set_addr(dev, dev->vqs + i, idx,
1041                                      enable_log);
1042         if (r < 0) {
1043             goto err_vq;
1044         }
1045     }
1046 
1047     /*
1048      * At log start we select our vhost_device logger that will scan the
1049      * memory sections and skip for the others. This is possible because
1050      * the log is shared amongst all vhost devices for a given type of
1051      * backend.
1052      */
1053     vhost_dev_elect_mem_logger(dev, enable_log);
1054 
1055     return 0;
1056 err_vq:
1057     for (; i >= 0; --i) {
1058         idx = dev->vhost_ops->vhost_get_vq_index(dev, dev->vq_index + i);
1059         addr = virtio_queue_get_desc_addr(dev->vdev, idx);
1060         if (!addr) {
1061             continue;
1062         }
1063         vhost_virtqueue_set_addr(dev, dev->vqs + i, idx,
1064                                  dev->log_enabled);
1065     }
1066     vhost_dev_set_features(dev, dev->log_enabled);
1067 err_features:
1068     return r;
1069 }
1070 
1071 static int vhost_migration_log(MemoryListener *listener, bool enable)
1072 {
1073     struct vhost_dev *dev = container_of(listener, struct vhost_dev,
1074                                          memory_listener);
1075     int r;
1076     if (enable == dev->log_enabled) {
1077         return 0;
1078     }
1079     if (!dev->started) {
1080         dev->log_enabled = enable;
1081         return 0;
1082     }
1083 
1084     r = 0;
1085     if (!enable) {
1086         r = vhost_dev_set_log(dev, false);
1087         if (r < 0) {
1088             goto check_dev_state;
1089         }
1090         vhost_log_put(dev, false);
1091     } else {
1092         vhost_dev_log_resize(dev, vhost_get_log_size(dev));
1093         r = vhost_dev_set_log(dev, true);
1094         if (r < 0) {
1095             goto check_dev_state;
1096         }
1097     }
1098 
1099 check_dev_state:
1100     dev->log_enabled = enable;
1101     /*
1102      * vhost-user-* devices could change their state during log
1103      * initialization due to disconnect. So check dev state after
1104      * vhost communication.
1105      */
1106     if (!dev->started) {
1107         /*
1108          * Since device is in the stopped state, it is okay for
1109          * migration. Return success.
1110          */
1111         r = 0;
1112     }
1113     if (r) {
1114         /* An error occurred. */
1115         dev->log_enabled = false;
1116     }
1117 
1118     return r;
1119 }
1120 
1121 static bool vhost_log_global_start(MemoryListener *listener, Error **errp)
1122 {
1123     int r;
1124 
1125     r = vhost_migration_log(listener, true);
1126     if (r < 0) {
1127         abort();
1128     }
1129     return true;
1130 }
1131 
1132 static void vhost_log_global_stop(MemoryListener *listener)
1133 {
1134     int r;
1135 
1136     r = vhost_migration_log(listener, false);
1137     if (r < 0) {
1138         abort();
1139     }
1140 }
1141 
1142 static void vhost_log_start(MemoryListener *listener,
1143                             MemoryRegionSection *section,
1144                             int old, int new)
1145 {
1146     /* FIXME: implement */
1147 }
1148 
1149 static void vhost_log_stop(MemoryListener *listener,
1150                            MemoryRegionSection *section,
1151                            int old, int new)
1152 {
1153     /* FIXME: implement */
1154 }
1155 
1156 /* The vhost driver natively knows how to handle the vrings of non
1157  * cross-endian legacy devices and modern devices. Only legacy devices
1158  * exposed to a bi-endian guest may require the vhost driver to use a
1159  * specific endianness.
1160  */
1161 static inline bool vhost_needs_vring_endian(VirtIODevice *vdev)
1162 {
1163     if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
1164         return false;
1165     }
1166 #if HOST_BIG_ENDIAN
1167     return vdev->device_endian == VIRTIO_DEVICE_ENDIAN_LITTLE;
1168 #else
1169     return vdev->device_endian == VIRTIO_DEVICE_ENDIAN_BIG;
1170 #endif
1171 }
1172 
1173 static int vhost_virtqueue_set_vring_endian_legacy(struct vhost_dev *dev,
1174                                                    bool is_big_endian,
1175                                                    int vhost_vq_index)
1176 {
1177     int r;
1178     struct vhost_vring_state s = {
1179         .index = vhost_vq_index,
1180         .num = is_big_endian
1181     };
1182 
1183     r = dev->vhost_ops->vhost_set_vring_endian(dev, &s);
1184     if (r < 0) {
1185         VHOST_OPS_DEBUG(r, "vhost_set_vring_endian failed");
1186     }
1187     return r;
1188 }
1189 
1190 static int vhost_memory_region_lookup(struct vhost_dev *hdev,
1191                                       uint64_t gpa, uint64_t *uaddr,
1192                                       uint64_t *len)
1193 {
1194     int i;
1195 
1196     for (i = 0; i < hdev->mem->nregions; i++) {
1197         struct vhost_memory_region *reg = hdev->mem->regions + i;
1198 
1199         if (gpa >= reg->guest_phys_addr &&
1200             reg->guest_phys_addr + reg->memory_size > gpa) {
1201             *uaddr = reg->userspace_addr + gpa - reg->guest_phys_addr;
1202             *len = reg->guest_phys_addr + reg->memory_size - gpa;
1203             return 0;
1204         }
1205     }
1206 
1207     return -EFAULT;
1208 }
1209 
1210 int vhost_device_iotlb_miss(struct vhost_dev *dev, uint64_t iova, int write)
1211 {
1212     IOMMUTLBEntry iotlb;
1213     uint64_t uaddr, len;
1214     int ret = -EFAULT;
1215 
1216     RCU_READ_LOCK_GUARD();
1217 
1218     trace_vhost_iotlb_miss(dev, 1);
1219 
1220     iotlb = address_space_get_iotlb_entry(dev->vdev->dma_as,
1221                                           iova, write,
1222                                           MEMTXATTRS_UNSPECIFIED);
1223     if (iotlb.target_as != NULL) {
1224         ret = vhost_memory_region_lookup(dev, iotlb.translated_addr,
1225                                          &uaddr, &len);
1226         if (ret) {
1227             trace_vhost_iotlb_miss(dev, 3);
1228             error_report("Fail to lookup the translated address "
1229                          "%"PRIx64, iotlb.translated_addr);
1230             goto out;
1231         }
1232 
1233         len = MIN(iotlb.addr_mask + 1, len);
1234         iova = iova & ~iotlb.addr_mask;
1235 
1236         ret = vhost_backend_update_device_iotlb(dev, iova, uaddr,
1237                                                 len, iotlb.perm);
1238         if (ret) {
1239             trace_vhost_iotlb_miss(dev, 4);
1240             error_report("Fail to update device iotlb");
1241             goto out;
1242         }
1243     }
1244 
1245     trace_vhost_iotlb_miss(dev, 2);
1246 
1247 out:
1248     return ret;
1249 }
1250 
1251 int vhost_virtqueue_start(struct vhost_dev *dev,
1252                           struct VirtIODevice *vdev,
1253                           struct vhost_virtqueue *vq,
1254                           unsigned idx)
1255 {
1256     BusState *qbus = BUS(qdev_get_parent_bus(DEVICE(vdev)));
1257     VirtioBusState *vbus = VIRTIO_BUS(qbus);
1258     VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(vbus);
1259     hwaddr s, l, a;
1260     int r;
1261     int vhost_vq_index = dev->vhost_ops->vhost_get_vq_index(dev, idx);
1262     struct vhost_vring_file file = {
1263         .index = vhost_vq_index
1264     };
1265     struct vhost_vring_state state = {
1266         .index = vhost_vq_index
1267     };
1268     struct VirtQueue *vvq = virtio_get_queue(vdev, idx);
1269 
1270     a = virtio_queue_get_desc_addr(vdev, idx);
1271     if (a == 0) {
1272         /* Queue might not be ready for start */
1273         return 0;
1274     }
1275 
1276     vq->num = state.num = virtio_queue_get_num(vdev, idx);
1277     r = dev->vhost_ops->vhost_set_vring_num(dev, &state);
1278     if (r) {
1279         VHOST_OPS_DEBUG(r, "vhost_set_vring_num failed");
1280         return r;
1281     }
1282 
1283     state.num = virtio_queue_get_last_avail_idx(vdev, idx);
1284     r = dev->vhost_ops->vhost_set_vring_base(dev, &state);
1285     if (r) {
1286         VHOST_OPS_DEBUG(r, "vhost_set_vring_base failed");
1287         return r;
1288     }
1289 
1290     if (vhost_needs_vring_endian(vdev)) {
1291         r = vhost_virtqueue_set_vring_endian_legacy(dev,
1292                                                     virtio_is_big_endian(vdev),
1293                                                     vhost_vq_index);
1294         if (r) {
1295             return r;
1296         }
1297     }
1298 
1299     vq->desc_size = s = l = virtio_queue_get_desc_size(vdev, idx);
1300     vq->desc_phys = a;
1301     vq->desc = vhost_memory_map(dev, a, &l, false);
1302     if (!vq->desc || l != s) {
1303         r = -ENOMEM;
1304         goto fail_alloc_desc;
1305     }
1306     vq->avail_size = s = l = virtio_queue_get_avail_size(vdev, idx);
1307     vq->avail_phys = a = virtio_queue_get_avail_addr(vdev, idx);
1308     vq->avail = vhost_memory_map(dev, a, &l, false);
1309     if (!vq->avail || l != s) {
1310         r = -ENOMEM;
1311         goto fail_alloc_avail;
1312     }
1313     vq->used_size = s = l = virtio_queue_get_used_size(vdev, idx);
1314     vq->used_phys = a = virtio_queue_get_used_addr(vdev, idx);
1315     vq->used = vhost_memory_map(dev, a, &l, true);
1316     if (!vq->used || l != s) {
1317         r = -ENOMEM;
1318         goto fail_alloc_used;
1319     }
1320 
1321     r = vhost_virtqueue_set_addr(dev, vq, vhost_vq_index, dev->log_enabled);
1322     if (r < 0) {
1323         goto fail_alloc;
1324     }
1325 
1326     file.fd = event_notifier_get_fd(virtio_queue_get_host_notifier(vvq));
1327     r = dev->vhost_ops->vhost_set_vring_kick(dev, &file);
1328     if (r) {
1329         VHOST_OPS_DEBUG(r, "vhost_set_vring_kick failed");
1330         goto fail_kick;
1331     }
1332 
1333     /* Clear and discard previous events if any. */
1334     event_notifier_test_and_clear(&vq->masked_notifier);
1335 
1336     /* Init vring in unmasked state, unless guest_notifier_mask
1337      * will do it later.
1338      */
1339     if (!vdev->use_guest_notifier_mask) {
1340         /* TODO: check and handle errors. */
1341         vhost_virtqueue_mask(dev, vdev, idx, false);
1342     }
1343 
1344     if (k->query_guest_notifiers &&
1345         k->query_guest_notifiers(qbus->parent) &&
1346         virtio_queue_vector(vdev, idx) == VIRTIO_NO_VECTOR) {
1347         file.fd = -1;
1348         r = dev->vhost_ops->vhost_set_vring_call(dev, &file);
1349         if (r) {
1350             goto fail_vector;
1351         }
1352     }
1353 
1354     return 0;
1355 
1356 fail_vector:
1357 fail_kick:
1358 fail_alloc:
1359     vhost_memory_unmap(dev, vq->used, virtio_queue_get_used_size(vdev, idx),
1360                        0, 0);
1361 fail_alloc_used:
1362     vhost_memory_unmap(dev, vq->avail, virtio_queue_get_avail_size(vdev, idx),
1363                        0, 0);
1364 fail_alloc_avail:
1365     vhost_memory_unmap(dev, vq->desc, virtio_queue_get_desc_size(vdev, idx),
1366                        0, 0);
1367 fail_alloc_desc:
1368     return r;
1369 }
1370 
1371 void vhost_virtqueue_stop(struct vhost_dev *dev,
1372                           struct VirtIODevice *vdev,
1373                           struct vhost_virtqueue *vq,
1374                           unsigned idx)
1375 {
1376     int vhost_vq_index = dev->vhost_ops->vhost_get_vq_index(dev, idx);
1377     struct vhost_vring_state state = {
1378         .index = vhost_vq_index,
1379     };
1380     int r;
1381 
1382     if (virtio_queue_get_desc_addr(vdev, idx) == 0) {
1383         /* Don't stop the virtqueue which might have not been started */
1384         return;
1385     }
1386 
1387     r = dev->vhost_ops->vhost_get_vring_base(dev, &state);
1388     if (r < 0) {
1389         VHOST_OPS_DEBUG(r, "vhost VQ %u ring restore failed: %d", idx, r);
1390         /* Connection to the backend is broken, so let's sync internal
1391          * last avail idx to the device used idx.
1392          */
1393         virtio_queue_restore_last_avail_idx(vdev, idx);
1394     } else {
1395         virtio_queue_set_last_avail_idx(vdev, idx, state.num);
1396     }
1397     virtio_queue_invalidate_signalled_used(vdev, idx);
1398     virtio_queue_update_used_idx(vdev, idx);
1399 
1400     /* In the cross-endian case, we need to reset the vring endianness to
1401      * native as legacy devices expect so by default.
1402      */
1403     if (vhost_needs_vring_endian(vdev)) {
1404         vhost_virtqueue_set_vring_endian_legacy(dev,
1405                                                 !virtio_is_big_endian(vdev),
1406                                                 vhost_vq_index);
1407     }
1408 
1409     vhost_memory_unmap(dev, vq->used, virtio_queue_get_used_size(vdev, idx),
1410                        1, virtio_queue_get_used_size(vdev, idx));
1411     vhost_memory_unmap(dev, vq->avail, virtio_queue_get_avail_size(vdev, idx),
1412                        0, virtio_queue_get_avail_size(vdev, idx));
1413     vhost_memory_unmap(dev, vq->desc, virtio_queue_get_desc_size(vdev, idx),
1414                        0, virtio_queue_get_desc_size(vdev, idx));
1415 }
1416 
1417 static int vhost_virtqueue_set_busyloop_timeout(struct vhost_dev *dev,
1418                                                 int n, uint32_t timeout)
1419 {
1420     int vhost_vq_index = dev->vhost_ops->vhost_get_vq_index(dev, n);
1421     struct vhost_vring_state state = {
1422         .index = vhost_vq_index,
1423         .num = timeout,
1424     };
1425     int r;
1426 
1427     if (!dev->vhost_ops->vhost_set_vring_busyloop_timeout) {
1428         return -EINVAL;
1429     }
1430 
1431     r = dev->vhost_ops->vhost_set_vring_busyloop_timeout(dev, &state);
1432     if (r) {
1433         VHOST_OPS_DEBUG(r, "vhost_set_vring_busyloop_timeout failed");
1434         return r;
1435     }
1436 
1437     return 0;
1438 }
1439 
1440 static void vhost_virtqueue_error_notifier(EventNotifier *n)
1441 {
1442     struct vhost_virtqueue *vq = container_of(n, struct vhost_virtqueue,
1443                                               error_notifier);
1444     struct vhost_dev *dev = vq->dev;
1445     int index = vq - dev->vqs;
1446 
1447     if (event_notifier_test_and_clear(n) && dev->vdev) {
1448         VHOST_OPS_DEBUG(-EINVAL,  "vhost vring error in virtqueue %d",
1449                         dev->vq_index + index);
1450     }
1451 }
1452 
1453 static int vhost_virtqueue_init(struct vhost_dev *dev,
1454                                 struct vhost_virtqueue *vq, int n)
1455 {
1456     int vhost_vq_index = dev->vhost_ops->vhost_get_vq_index(dev, n);
1457     struct vhost_vring_file file = {
1458         .index = vhost_vq_index,
1459     };
1460     int r = event_notifier_init(&vq->masked_notifier, 0);
1461     if (r < 0) {
1462         return r;
1463     }
1464 
1465     file.fd = event_notifier_get_wfd(&vq->masked_notifier);
1466     r = dev->vhost_ops->vhost_set_vring_call(dev, &file);
1467     if (r) {
1468         VHOST_OPS_DEBUG(r, "vhost_set_vring_call failed");
1469         goto fail_call;
1470     }
1471 
1472     vq->dev = dev;
1473 
1474     if (dev->vhost_ops->vhost_set_vring_err) {
1475         r = event_notifier_init(&vq->error_notifier, 0);
1476         if (r < 0) {
1477             goto fail_call;
1478         }
1479 
1480         file.fd = event_notifier_get_fd(&vq->error_notifier);
1481         r = dev->vhost_ops->vhost_set_vring_err(dev, &file);
1482         if (r) {
1483             VHOST_OPS_DEBUG(r, "vhost_set_vring_err failed");
1484             goto fail_err;
1485         }
1486 
1487         event_notifier_set_handler(&vq->error_notifier,
1488                                    vhost_virtqueue_error_notifier);
1489     }
1490 
1491     return 0;
1492 
1493 fail_err:
1494     event_notifier_cleanup(&vq->error_notifier);
1495 fail_call:
1496     event_notifier_cleanup(&vq->masked_notifier);
1497     return r;
1498 }
1499 
1500 static void vhost_virtqueue_cleanup(struct vhost_virtqueue *vq)
1501 {
1502     event_notifier_cleanup(&vq->masked_notifier);
1503     if (vq->dev->vhost_ops->vhost_set_vring_err) {
1504         event_notifier_set_handler(&vq->error_notifier, NULL);
1505         event_notifier_cleanup(&vq->error_notifier);
1506     }
1507 }
1508 
1509 int vhost_dev_init(struct vhost_dev *hdev, void *opaque,
1510                    VhostBackendType backend_type, uint32_t busyloop_timeout,
1511                    Error **errp)
1512 {
1513     unsigned int used, reserved, limit;
1514     uint64_t features;
1515     int i, r, n_initialized_vqs = 0;
1516 
1517     hdev->vdev = NULL;
1518     hdev->migration_blocker = NULL;
1519 
1520     r = vhost_set_backend_type(hdev, backend_type);
1521     assert(r >= 0);
1522 
1523     r = hdev->vhost_ops->vhost_backend_init(hdev, opaque, errp);
1524     if (r < 0) {
1525         goto fail;
1526     }
1527 
1528     r = hdev->vhost_ops->vhost_set_owner(hdev);
1529     if (r < 0) {
1530         error_setg_errno(errp, -r, "vhost_set_owner failed");
1531         goto fail;
1532     }
1533 
1534     r = hdev->vhost_ops->vhost_get_features(hdev, &features);
1535     if (r < 0) {
1536         error_setg_errno(errp, -r, "vhost_get_features failed");
1537         goto fail;
1538     }
1539 
1540     limit = hdev->vhost_ops->vhost_backend_memslots_limit(hdev);
1541     if (limit < MEMORY_DEVICES_SAFE_MAX_MEMSLOTS &&
1542         memory_devices_memslot_auto_decision_active()) {
1543         error_setg(errp, "some memory device (like virtio-mem)"
1544             " decided how many memory slots to use based on the overall"
1545             " number of memory slots; this vhost backend would further"
1546             " restricts the overall number of memory slots");
1547         error_append_hint(errp, "Try plugging this vhost backend before"
1548             " plugging such memory devices.\n");
1549         r = -EINVAL;
1550         goto fail;
1551     }
1552 
1553     for (i = 0; i < hdev->nvqs; ++i, ++n_initialized_vqs) {
1554         r = vhost_virtqueue_init(hdev, hdev->vqs + i, hdev->vq_index + i);
1555         if (r < 0) {
1556             error_setg_errno(errp, -r, "Failed to initialize virtqueue %d", i);
1557             goto fail;
1558         }
1559     }
1560 
1561     if (busyloop_timeout) {
1562         for (i = 0; i < hdev->nvqs; ++i) {
1563             r = vhost_virtqueue_set_busyloop_timeout(hdev, hdev->vq_index + i,
1564                                                      busyloop_timeout);
1565             if (r < 0) {
1566                 error_setg_errno(errp, -r, "Failed to set busyloop timeout");
1567                 goto fail_busyloop;
1568             }
1569         }
1570     }
1571 
1572     hdev->features = features;
1573 
1574     hdev->memory_listener = (MemoryListener) {
1575         .name = "vhost",
1576         .begin = vhost_begin,
1577         .commit = vhost_commit,
1578         .region_add = vhost_region_addnop,
1579         .region_nop = vhost_region_addnop,
1580         .log_start = vhost_log_start,
1581         .log_stop = vhost_log_stop,
1582         .log_sync = vhost_log_sync,
1583         .log_global_start = vhost_log_global_start,
1584         .log_global_stop = vhost_log_global_stop,
1585         .priority = MEMORY_LISTENER_PRIORITY_DEV_BACKEND
1586     };
1587 
1588     hdev->iommu_listener = (MemoryListener) {
1589         .name = "vhost-iommu",
1590         .region_add = vhost_iommu_region_add,
1591         .region_del = vhost_iommu_region_del,
1592     };
1593 
1594     if (hdev->migration_blocker == NULL) {
1595         if (!(hdev->features & (0x1ULL << VHOST_F_LOG_ALL))) {
1596             error_setg(&hdev->migration_blocker,
1597                        "Migration disabled: vhost lacks VHOST_F_LOG_ALL feature.");
1598         } else if (vhost_dev_log_is_shared(hdev) && !qemu_memfd_alloc_check()) {
1599             error_setg(&hdev->migration_blocker,
1600                        "Migration disabled: failed to allocate shared memory");
1601         }
1602     }
1603 
1604     if (hdev->migration_blocker != NULL) {
1605         r = migrate_add_blocker_normal(&hdev->migration_blocker, errp);
1606         if (r < 0) {
1607             goto fail_busyloop;
1608         }
1609     }
1610 
1611     hdev->mem = g_malloc0(offsetof(struct vhost_memory, regions));
1612     hdev->n_mem_sections = 0;
1613     hdev->mem_sections = NULL;
1614     hdev->log = NULL;
1615     hdev->log_size = 0;
1616     hdev->log_enabled = false;
1617     hdev->started = false;
1618     memory_listener_register(&hdev->memory_listener, &address_space_memory);
1619     QLIST_INSERT_HEAD(&vhost_devices, hdev, entry);
1620 
1621     /*
1622      * The listener we registered properly updated the corresponding counter.
1623      * So we can trust that these values are accurate.
1624      */
1625     if (hdev->vhost_ops->vhost_backend_no_private_memslots &&
1626         hdev->vhost_ops->vhost_backend_no_private_memslots(hdev)) {
1627         used = used_shared_memslots;
1628     } else {
1629         used = used_memslots;
1630     }
1631     /*
1632      * We assume that all reserved memslots actually require a real memslot
1633      * in our vhost backend. This might not be true, for example, if the
1634      * memslot would be ROM. If ever relevant, we can optimize for that --
1635      * but we'll need additional information about the reservations.
1636      */
1637     reserved = memory_devices_get_reserved_memslots();
1638     if (used + reserved > limit) {
1639         error_setg(errp, "vhost backend memory slots limit (%d) is less"
1640                    " than current number of used (%d) and reserved (%d)"
1641                    " memory slots for memory devices.", limit, used, reserved);
1642         r = -EINVAL;
1643         goto fail_busyloop;
1644     }
1645 
1646     return 0;
1647 
1648 fail_busyloop:
1649     if (busyloop_timeout) {
1650         while (--i >= 0) {
1651             vhost_virtqueue_set_busyloop_timeout(hdev, hdev->vq_index + i, 0);
1652         }
1653     }
1654 fail:
1655     hdev->nvqs = n_initialized_vqs;
1656     vhost_dev_cleanup(hdev);
1657     return r;
1658 }
1659 
1660 void vhost_dev_cleanup(struct vhost_dev *hdev)
1661 {
1662     int i;
1663 
1664     trace_vhost_dev_cleanup(hdev);
1665 
1666     for (i = 0; i < hdev->nvqs; ++i) {
1667         vhost_virtqueue_cleanup(hdev->vqs + i);
1668     }
1669     if (hdev->mem) {
1670         /* those are only safe after successful init */
1671         memory_listener_unregister(&hdev->memory_listener);
1672         QLIST_REMOVE(hdev, entry);
1673     }
1674     migrate_del_blocker(&hdev->migration_blocker);
1675     g_free(hdev->mem);
1676     g_free(hdev->mem_sections);
1677     if (hdev->vhost_ops) {
1678         hdev->vhost_ops->vhost_backend_cleanup(hdev);
1679     }
1680     assert(!hdev->log);
1681 
1682     memset(hdev, 0, sizeof(struct vhost_dev));
1683 }
1684 
1685 void vhost_dev_disable_notifiers_nvqs(struct vhost_dev *hdev,
1686                                       VirtIODevice *vdev,
1687                                       unsigned int nvqs)
1688 {
1689     BusState *qbus = BUS(qdev_get_parent_bus(DEVICE(vdev)));
1690     int i, r;
1691 
1692     /*
1693      * Batch all the host notifiers in a single transaction to avoid
1694      * quadratic time complexity in address_space_update_ioeventfds().
1695      */
1696     memory_region_transaction_begin();
1697 
1698     for (i = 0; i < nvqs; ++i) {
1699         r = virtio_bus_set_host_notifier(VIRTIO_BUS(qbus), hdev->vq_index + i,
1700                                          false);
1701         if (r < 0) {
1702             error_report("vhost VQ %d notifier cleanup failed: %d", i, -r);
1703         }
1704         assert(r >= 0);
1705     }
1706 
1707     /*
1708      * The transaction expects the ioeventfds to be open when it
1709      * commits. Do it now, before the cleanup loop.
1710      */
1711     memory_region_transaction_commit();
1712 
1713     for (i = 0; i < nvqs; ++i) {
1714         virtio_bus_cleanup_host_notifier(VIRTIO_BUS(qbus), hdev->vq_index + i);
1715     }
1716     virtio_device_release_ioeventfd(vdev);
1717 }
1718 
1719 /* Stop processing guest IO notifications in qemu.
1720  * Start processing them in vhost in kernel.
1721  */
1722 int vhost_dev_enable_notifiers(struct vhost_dev *hdev, VirtIODevice *vdev)
1723 {
1724     BusState *qbus = BUS(qdev_get_parent_bus(DEVICE(vdev)));
1725     int i, r;
1726 
1727     /* We will pass the notifiers to the kernel, make sure that QEMU
1728      * doesn't interfere.
1729      */
1730     r = virtio_device_grab_ioeventfd(vdev);
1731     if (r < 0) {
1732         error_report("binding does not support host notifiers");
1733         return r;
1734     }
1735 
1736     /*
1737      * Batch all the host notifiers in a single transaction to avoid
1738      * quadratic time complexity in address_space_update_ioeventfds().
1739      */
1740     memory_region_transaction_begin();
1741 
1742     for (i = 0; i < hdev->nvqs; ++i) {
1743         r = virtio_bus_set_host_notifier(VIRTIO_BUS(qbus), hdev->vq_index + i,
1744                                          true);
1745         if (r < 0) {
1746             error_report("vhost VQ %d notifier binding failed: %d", i, -r);
1747             memory_region_transaction_commit();
1748             vhost_dev_disable_notifiers_nvqs(hdev, vdev, i);
1749             return r;
1750         }
1751     }
1752 
1753     memory_region_transaction_commit();
1754 
1755     return 0;
1756 }
1757 
1758 /* Stop processing guest IO notifications in vhost.
1759  * Start processing them in qemu.
1760  * This might actually run the qemu handlers right away,
1761  * so virtio in qemu must be completely setup when this is called.
1762  */
1763 void vhost_dev_disable_notifiers(struct vhost_dev *hdev, VirtIODevice *vdev)
1764 {
1765     vhost_dev_disable_notifiers_nvqs(hdev, vdev, hdev->nvqs);
1766 }
1767 
1768 /* Test and clear event pending status.
1769  * Should be called after unmask to avoid losing events.
1770  */
1771 bool vhost_virtqueue_pending(struct vhost_dev *hdev, int n)
1772 {
1773     struct vhost_virtqueue *vq = hdev->vqs + n - hdev->vq_index;
1774     assert(n >= hdev->vq_index && n < hdev->vq_index + hdev->nvqs);
1775     return event_notifier_test_and_clear(&vq->masked_notifier);
1776 }
1777 
1778 /* Mask/unmask events from this vq. */
1779 void vhost_virtqueue_mask(struct vhost_dev *hdev, VirtIODevice *vdev, int n,
1780                          bool mask)
1781 {
1782     struct VirtQueue *vvq = virtio_get_queue(vdev, n);
1783     int r, index = n - hdev->vq_index;
1784     struct vhost_vring_file file;
1785 
1786     /* should only be called after backend is connected */
1787     assert(hdev->vhost_ops);
1788 
1789     if (mask) {
1790         assert(vdev->use_guest_notifier_mask);
1791         file.fd = event_notifier_get_wfd(&hdev->vqs[index].masked_notifier);
1792     } else {
1793         file.fd = event_notifier_get_wfd(virtio_queue_get_guest_notifier(vvq));
1794     }
1795 
1796     file.index = hdev->vhost_ops->vhost_get_vq_index(hdev, n);
1797     r = hdev->vhost_ops->vhost_set_vring_call(hdev, &file);
1798     if (r < 0) {
1799         error_report("vhost_set_vring_call failed %d", -r);
1800     }
1801 }
1802 
1803 bool vhost_config_pending(struct vhost_dev *hdev)
1804 {
1805     assert(hdev->vhost_ops);
1806     if ((hdev->started == false) ||
1807         (hdev->vhost_ops->vhost_set_config_call == NULL)) {
1808         return false;
1809     }
1810 
1811     EventNotifier *notifier =
1812         &hdev->vqs[VHOST_QUEUE_NUM_CONFIG_INR].masked_config_notifier;
1813     return event_notifier_test_and_clear(notifier);
1814 }
1815 
1816 void vhost_config_mask(struct vhost_dev *hdev, VirtIODevice *vdev, bool mask)
1817 {
1818     int fd;
1819     int r;
1820     EventNotifier *notifier =
1821         &hdev->vqs[VHOST_QUEUE_NUM_CONFIG_INR].masked_config_notifier;
1822     EventNotifier *config_notifier = &vdev->config_notifier;
1823     assert(hdev->vhost_ops);
1824 
1825     if ((hdev->started == false) ||
1826         (hdev->vhost_ops->vhost_set_config_call == NULL)) {
1827         return;
1828     }
1829     if (mask) {
1830         assert(vdev->use_guest_notifier_mask);
1831         fd = event_notifier_get_fd(notifier);
1832     } else {
1833         fd = event_notifier_get_fd(config_notifier);
1834     }
1835     r = hdev->vhost_ops->vhost_set_config_call(hdev, fd);
1836     if (r < 0) {
1837         error_report("vhost_set_config_call failed %d", -r);
1838     }
1839 }
1840 
1841 static void vhost_stop_config_intr(struct vhost_dev *dev)
1842 {
1843     int fd = -1;
1844     assert(dev->vhost_ops);
1845     if (dev->vhost_ops->vhost_set_config_call) {
1846         dev->vhost_ops->vhost_set_config_call(dev, fd);
1847     }
1848 }
1849 
1850 static void vhost_start_config_intr(struct vhost_dev *dev)
1851 {
1852     int r;
1853 
1854     assert(dev->vhost_ops);
1855     int fd = event_notifier_get_fd(&dev->vdev->config_notifier);
1856     if (dev->vhost_ops->vhost_set_config_call) {
1857         r = dev->vhost_ops->vhost_set_config_call(dev, fd);
1858         if (!r) {
1859             event_notifier_set(&dev->vdev->config_notifier);
1860         }
1861     }
1862 }
1863 
1864 uint64_t vhost_get_features(struct vhost_dev *hdev, const int *feature_bits,
1865                             uint64_t features)
1866 {
1867     const int *bit = feature_bits;
1868     while (*bit != VHOST_INVALID_FEATURE_BIT) {
1869         uint64_t bit_mask = (1ULL << *bit);
1870         if (!(hdev->features & bit_mask)) {
1871             features &= ~bit_mask;
1872         }
1873         bit++;
1874     }
1875     return features;
1876 }
1877 
1878 void vhost_ack_features(struct vhost_dev *hdev, const int *feature_bits,
1879                         uint64_t features)
1880 {
1881     const int *bit = feature_bits;
1882     while (*bit != VHOST_INVALID_FEATURE_BIT) {
1883         uint64_t bit_mask = (1ULL << *bit);
1884         if (features & bit_mask) {
1885             hdev->acked_features |= bit_mask;
1886         }
1887         bit++;
1888     }
1889 }
1890 
1891 int vhost_dev_get_config(struct vhost_dev *hdev, uint8_t *config,
1892                          uint32_t config_len, Error **errp)
1893 {
1894     assert(hdev->vhost_ops);
1895 
1896     if (hdev->vhost_ops->vhost_get_config) {
1897         return hdev->vhost_ops->vhost_get_config(hdev, config, config_len,
1898                                                  errp);
1899     }
1900 
1901     error_setg(errp, "vhost_get_config not implemented");
1902     return -ENOSYS;
1903 }
1904 
1905 int vhost_dev_set_config(struct vhost_dev *hdev, const uint8_t *data,
1906                          uint32_t offset, uint32_t size, uint32_t flags)
1907 {
1908     assert(hdev->vhost_ops);
1909 
1910     if (hdev->vhost_ops->vhost_set_config) {
1911         return hdev->vhost_ops->vhost_set_config(hdev, data, offset,
1912                                                  size, flags);
1913     }
1914 
1915     return -ENOSYS;
1916 }
1917 
1918 void vhost_dev_set_config_notifier(struct vhost_dev *hdev,
1919                                    const VhostDevConfigOps *ops)
1920 {
1921     hdev->config_ops = ops;
1922 }
1923 
1924 void vhost_dev_free_inflight(struct vhost_inflight *inflight)
1925 {
1926     if (inflight && inflight->addr) {
1927         qemu_memfd_free(inflight->addr, inflight->size, inflight->fd);
1928         inflight->addr = NULL;
1929         inflight->fd = -1;
1930     }
1931 }
1932 
1933 int vhost_dev_prepare_inflight(struct vhost_dev *hdev, VirtIODevice *vdev)
1934 {
1935     int r;
1936 
1937     if (hdev->vhost_ops->vhost_get_inflight_fd == NULL ||
1938         hdev->vhost_ops->vhost_set_inflight_fd == NULL) {
1939         return 0;
1940     }
1941 
1942     hdev->vdev = vdev;
1943 
1944     r = vhost_dev_set_features(hdev, hdev->log_enabled);
1945     if (r < 0) {
1946         VHOST_OPS_DEBUG(r, "vhost_dev_prepare_inflight failed");
1947         return r;
1948     }
1949 
1950     return 0;
1951 }
1952 
1953 int vhost_dev_set_inflight(struct vhost_dev *dev,
1954                            struct vhost_inflight *inflight)
1955 {
1956     int r;
1957 
1958     if (dev->vhost_ops->vhost_set_inflight_fd && inflight->addr) {
1959         r = dev->vhost_ops->vhost_set_inflight_fd(dev, inflight);
1960         if (r) {
1961             VHOST_OPS_DEBUG(r, "vhost_set_inflight_fd failed");
1962             return r;
1963         }
1964     }
1965 
1966     return 0;
1967 }
1968 
1969 int vhost_dev_get_inflight(struct vhost_dev *dev, uint16_t queue_size,
1970                            struct vhost_inflight *inflight)
1971 {
1972     int r;
1973 
1974     if (dev->vhost_ops->vhost_get_inflight_fd) {
1975         r = dev->vhost_ops->vhost_get_inflight_fd(dev, queue_size, inflight);
1976         if (r) {
1977             VHOST_OPS_DEBUG(r, "vhost_get_inflight_fd failed");
1978             return r;
1979         }
1980     }
1981 
1982     return 0;
1983 }
1984 
1985 static int vhost_dev_set_vring_enable(struct vhost_dev *hdev, int enable)
1986 {
1987     if (!hdev->vhost_ops->vhost_set_vring_enable) {
1988         return 0;
1989     }
1990 
1991     /*
1992      * For vhost-user devices, if VHOST_USER_F_PROTOCOL_FEATURES has not
1993      * been negotiated, the rings start directly in the enabled state, and
1994      * .vhost_set_vring_enable callback will fail since
1995      * VHOST_USER_SET_VRING_ENABLE is not supported.
1996      */
1997     if (hdev->vhost_ops->backend_type == VHOST_BACKEND_TYPE_USER &&
1998         !virtio_has_feature(hdev->backend_features,
1999                             VHOST_USER_F_PROTOCOL_FEATURES)) {
2000         return 0;
2001     }
2002 
2003     return hdev->vhost_ops->vhost_set_vring_enable(hdev, enable);
2004 }
2005 
2006 /*
2007  * Host notifiers must be enabled at this point.
2008  *
2009  * If @vrings is true, this function will enable all vrings before starting the
2010  * device. If it is false, the vring initialization is left to be done by the
2011  * caller.
2012  */
2013 int vhost_dev_start(struct vhost_dev *hdev, VirtIODevice *vdev, bool vrings)
2014 {
2015     int i, r;
2016 
2017     /* should only be called after backend is connected */
2018     assert(hdev->vhost_ops);
2019 
2020     trace_vhost_dev_start(hdev, vdev->name, vrings);
2021 
2022     vdev->vhost_started = true;
2023     hdev->started = true;
2024     hdev->vdev = vdev;
2025 
2026     r = vhost_dev_set_features(hdev, hdev->log_enabled);
2027     if (r < 0) {
2028         goto fail_features;
2029     }
2030 
2031     if (vhost_dev_has_iommu(hdev)) {
2032         memory_listener_register(&hdev->iommu_listener, vdev->dma_as);
2033     }
2034 
2035     r = hdev->vhost_ops->vhost_set_mem_table(hdev, hdev->mem);
2036     if (r < 0) {
2037         VHOST_OPS_DEBUG(r, "vhost_set_mem_table failed");
2038         goto fail_mem;
2039     }
2040     for (i = 0; i < hdev->nvqs; ++i) {
2041         r = vhost_virtqueue_start(hdev,
2042                                   vdev,
2043                                   hdev->vqs + i,
2044                                   hdev->vq_index + i);
2045         if (r < 0) {
2046             goto fail_vq;
2047         }
2048     }
2049 
2050     r = event_notifier_init(
2051         &hdev->vqs[VHOST_QUEUE_NUM_CONFIG_INR].masked_config_notifier, 0);
2052     if (r < 0) {
2053         VHOST_OPS_DEBUG(r, "event_notifier_init failed");
2054         goto fail_vq;
2055     }
2056     event_notifier_test_and_clear(
2057         &hdev->vqs[VHOST_QUEUE_NUM_CONFIG_INR].masked_config_notifier);
2058     if (!vdev->use_guest_notifier_mask) {
2059         vhost_config_mask(hdev, vdev, true);
2060     }
2061     if (hdev->log_enabled) {
2062         uint64_t log_base;
2063 
2064         hdev->log_size = vhost_get_log_size(hdev);
2065         hdev->log = vhost_log_get(hdev->vhost_ops->backend_type,
2066                                   hdev->log_size,
2067                                   vhost_dev_log_is_shared(hdev));
2068         log_base = (uintptr_t)hdev->log->log;
2069         r = hdev->vhost_ops->vhost_set_log_base(hdev,
2070                                                 hdev->log_size ? log_base : 0,
2071                                                 hdev->log);
2072         if (r < 0) {
2073             VHOST_OPS_DEBUG(r, "vhost_set_log_base failed");
2074             goto fail_log;
2075         }
2076         vhost_dev_elect_mem_logger(hdev, true);
2077     }
2078     if (vrings) {
2079         r = vhost_dev_set_vring_enable(hdev, true);
2080         if (r) {
2081             goto fail_log;
2082         }
2083     }
2084     if (hdev->vhost_ops->vhost_dev_start) {
2085         r = hdev->vhost_ops->vhost_dev_start(hdev, true);
2086         if (r) {
2087             goto fail_start;
2088         }
2089     }
2090     if (vhost_dev_has_iommu(hdev) &&
2091         hdev->vhost_ops->vhost_set_iotlb_callback) {
2092             hdev->vhost_ops->vhost_set_iotlb_callback(hdev, true);
2093 
2094         /* Update used ring information for IOTLB to work correctly,
2095          * vhost-kernel code requires for this.*/
2096         for (i = 0; i < hdev->nvqs; ++i) {
2097             struct vhost_virtqueue *vq = hdev->vqs + i;
2098             r = vhost_device_iotlb_miss(hdev, vq->used_phys, true);
2099             if (r) {
2100                 goto fail_iotlb;
2101             }
2102         }
2103     }
2104     vhost_start_config_intr(hdev);
2105     return 0;
2106 fail_iotlb:
2107     if (vhost_dev_has_iommu(hdev) &&
2108         hdev->vhost_ops->vhost_set_iotlb_callback) {
2109         hdev->vhost_ops->vhost_set_iotlb_callback(hdev, false);
2110     }
2111     if (hdev->vhost_ops->vhost_dev_start) {
2112         hdev->vhost_ops->vhost_dev_start(hdev, false);
2113     }
2114 fail_start:
2115     if (vrings) {
2116         vhost_dev_set_vring_enable(hdev, false);
2117     }
2118 fail_log:
2119     vhost_log_put(hdev, false);
2120 fail_vq:
2121     while (--i >= 0) {
2122         vhost_virtqueue_stop(hdev,
2123                              vdev,
2124                              hdev->vqs + i,
2125                              hdev->vq_index + i);
2126     }
2127 
2128 fail_mem:
2129     if (vhost_dev_has_iommu(hdev)) {
2130         memory_listener_unregister(&hdev->iommu_listener);
2131     }
2132 fail_features:
2133     vdev->vhost_started = false;
2134     hdev->started = false;
2135     return r;
2136 }
2137 
2138 /* Host notifiers must be enabled at this point. */
2139 void vhost_dev_stop(struct vhost_dev *hdev, VirtIODevice *vdev, bool vrings)
2140 {
2141     int i;
2142 
2143     /* should only be called after backend is connected */
2144     assert(hdev->vhost_ops);
2145     event_notifier_test_and_clear(
2146         &hdev->vqs[VHOST_QUEUE_NUM_CONFIG_INR].masked_config_notifier);
2147     event_notifier_test_and_clear(&vdev->config_notifier);
2148     event_notifier_cleanup(
2149         &hdev->vqs[VHOST_QUEUE_NUM_CONFIG_INR].masked_config_notifier);
2150 
2151     trace_vhost_dev_stop(hdev, vdev->name, vrings);
2152 
2153     if (hdev->vhost_ops->vhost_dev_start) {
2154         hdev->vhost_ops->vhost_dev_start(hdev, false);
2155     }
2156     if (vrings) {
2157         vhost_dev_set_vring_enable(hdev, false);
2158     }
2159     for (i = 0; i < hdev->nvqs; ++i) {
2160         vhost_virtqueue_stop(hdev,
2161                              vdev,
2162                              hdev->vqs + i,
2163                              hdev->vq_index + i);
2164     }
2165     if (hdev->vhost_ops->vhost_reset_status) {
2166         hdev->vhost_ops->vhost_reset_status(hdev);
2167     }
2168 
2169     if (vhost_dev_has_iommu(hdev)) {
2170         if (hdev->vhost_ops->vhost_set_iotlb_callback) {
2171             hdev->vhost_ops->vhost_set_iotlb_callback(hdev, false);
2172         }
2173         memory_listener_unregister(&hdev->iommu_listener);
2174     }
2175     vhost_stop_config_intr(hdev);
2176     vhost_log_put(hdev, true);
2177     hdev->started = false;
2178     vdev->vhost_started = false;
2179     hdev->vdev = NULL;
2180 }
2181 
2182 int vhost_net_set_backend(struct vhost_dev *hdev,
2183                           struct vhost_vring_file *file)
2184 {
2185     if (hdev->vhost_ops->vhost_net_set_backend) {
2186         return hdev->vhost_ops->vhost_net_set_backend(hdev, file);
2187     }
2188 
2189     return -ENOSYS;
2190 }
2191 
2192 int vhost_reset_device(struct vhost_dev *hdev)
2193 {
2194     if (hdev->vhost_ops->vhost_reset_device) {
2195         return hdev->vhost_ops->vhost_reset_device(hdev);
2196     }
2197 
2198     return -ENOSYS;
2199 }
2200 
2201 bool vhost_supports_device_state(struct vhost_dev *dev)
2202 {
2203     if (dev->vhost_ops->vhost_supports_device_state) {
2204         return dev->vhost_ops->vhost_supports_device_state(dev);
2205     }
2206 
2207     return false;
2208 }
2209 
2210 int vhost_set_device_state_fd(struct vhost_dev *dev,
2211                               VhostDeviceStateDirection direction,
2212                               VhostDeviceStatePhase phase,
2213                               int fd,
2214                               int *reply_fd,
2215                               Error **errp)
2216 {
2217     if (dev->vhost_ops->vhost_set_device_state_fd) {
2218         return dev->vhost_ops->vhost_set_device_state_fd(dev, direction, phase,
2219                                                          fd, reply_fd, errp);
2220     }
2221 
2222     error_setg(errp,
2223                "vhost transport does not support migration state transfer");
2224     return -ENOSYS;
2225 }
2226 
2227 int vhost_check_device_state(struct vhost_dev *dev, Error **errp)
2228 {
2229     if (dev->vhost_ops->vhost_check_device_state) {
2230         return dev->vhost_ops->vhost_check_device_state(dev, errp);
2231     }
2232 
2233     error_setg(errp,
2234                "vhost transport does not support migration state transfer");
2235     return -ENOSYS;
2236 }
2237 
2238 int vhost_save_backend_state(struct vhost_dev *dev, QEMUFile *f, Error **errp)
2239 {
2240     ERRP_GUARD();
2241     /* Maximum chunk size in which to transfer the state */
2242     const size_t chunk_size = 1 * 1024 * 1024;
2243     g_autofree void *transfer_buf = NULL;
2244     g_autoptr(GError) g_err = NULL;
2245     int pipe_fds[2], read_fd = -1, write_fd = -1, reply_fd = -1;
2246     int ret;
2247 
2248     /* [0] for reading (our end), [1] for writing (back-end's end) */
2249     if (!g_unix_open_pipe(pipe_fds, FD_CLOEXEC, &g_err)) {
2250         error_setg(errp, "Failed to set up state transfer pipe: %s",
2251                    g_err->message);
2252         ret = -EINVAL;
2253         goto fail;
2254     }
2255 
2256     read_fd = pipe_fds[0];
2257     write_fd = pipe_fds[1];
2258 
2259     /*
2260      * VHOST_TRANSFER_STATE_PHASE_STOPPED means the device must be stopped.
2261      * Ideally, it is suspended, but SUSPEND/RESUME currently do not exist for
2262      * vhost-user, so just check that it is stopped at all.
2263      */
2264     assert(!dev->started);
2265 
2266     /* Transfer ownership of write_fd to the back-end */
2267     ret = vhost_set_device_state_fd(dev,
2268                                     VHOST_TRANSFER_STATE_DIRECTION_SAVE,
2269                                     VHOST_TRANSFER_STATE_PHASE_STOPPED,
2270                                     write_fd,
2271                                     &reply_fd,
2272                                     errp);
2273     if (ret < 0) {
2274         error_prepend(errp, "Failed to initiate state transfer: ");
2275         goto fail;
2276     }
2277 
2278     /* If the back-end wishes to use a different pipe, switch over */
2279     if (reply_fd >= 0) {
2280         close(read_fd);
2281         read_fd = reply_fd;
2282     }
2283 
2284     transfer_buf = g_malloc(chunk_size);
2285 
2286     while (true) {
2287         ssize_t read_ret;
2288 
2289         read_ret = RETRY_ON_EINTR(read(read_fd, transfer_buf, chunk_size));
2290         if (read_ret < 0) {
2291             ret = -errno;
2292             error_setg_errno(errp, -ret, "Failed to receive state");
2293             goto fail;
2294         }
2295 
2296         assert(read_ret <= chunk_size);
2297         qemu_put_be32(f, read_ret);
2298 
2299         if (read_ret == 0) {
2300             /* EOF */
2301             break;
2302         }
2303 
2304         qemu_put_buffer(f, transfer_buf, read_ret);
2305     }
2306 
2307     /*
2308      * Back-end will not really care, but be clean and close our end of the pipe
2309      * before inquiring the back-end about whether transfer was successful
2310      */
2311     close(read_fd);
2312     read_fd = -1;
2313 
2314     /* Also, verify that the device is still stopped */
2315     assert(!dev->started);
2316 
2317     ret = vhost_check_device_state(dev, errp);
2318     if (ret < 0) {
2319         goto fail;
2320     }
2321 
2322     ret = 0;
2323 fail:
2324     if (read_fd >= 0) {
2325         close(read_fd);
2326     }
2327 
2328     return ret;
2329 }
2330 
2331 int vhost_load_backend_state(struct vhost_dev *dev, QEMUFile *f, Error **errp)
2332 {
2333     ERRP_GUARD();
2334     size_t transfer_buf_size = 0;
2335     g_autofree void *transfer_buf = NULL;
2336     g_autoptr(GError) g_err = NULL;
2337     int pipe_fds[2], read_fd = -1, write_fd = -1, reply_fd = -1;
2338     int ret;
2339 
2340     /* [0] for reading (back-end's end), [1] for writing (our end) */
2341     if (!g_unix_open_pipe(pipe_fds, FD_CLOEXEC, &g_err)) {
2342         error_setg(errp, "Failed to set up state transfer pipe: %s",
2343                    g_err->message);
2344         ret = -EINVAL;
2345         goto fail;
2346     }
2347 
2348     read_fd = pipe_fds[0];
2349     write_fd = pipe_fds[1];
2350 
2351     /*
2352      * VHOST_TRANSFER_STATE_PHASE_STOPPED means the device must be stopped.
2353      * Ideally, it is suspended, but SUSPEND/RESUME currently do not exist for
2354      * vhost-user, so just check that it is stopped at all.
2355      */
2356     assert(!dev->started);
2357 
2358     /* Transfer ownership of read_fd to the back-end */
2359     ret = vhost_set_device_state_fd(dev,
2360                                     VHOST_TRANSFER_STATE_DIRECTION_LOAD,
2361                                     VHOST_TRANSFER_STATE_PHASE_STOPPED,
2362                                     read_fd,
2363                                     &reply_fd,
2364                                     errp);
2365     if (ret < 0) {
2366         error_prepend(errp, "Failed to initiate state transfer: ");
2367         goto fail;
2368     }
2369 
2370     /* If the back-end wishes to use a different pipe, switch over */
2371     if (reply_fd >= 0) {
2372         close(write_fd);
2373         write_fd = reply_fd;
2374     }
2375 
2376     while (true) {
2377         size_t this_chunk_size = qemu_get_be32(f);
2378         ssize_t write_ret;
2379         const uint8_t *transfer_pointer;
2380 
2381         if (this_chunk_size == 0) {
2382             /* End of state */
2383             break;
2384         }
2385 
2386         if (transfer_buf_size < this_chunk_size) {
2387             transfer_buf = g_realloc(transfer_buf, this_chunk_size);
2388             transfer_buf_size = this_chunk_size;
2389         }
2390 
2391         if (qemu_get_buffer(f, transfer_buf, this_chunk_size) <
2392                 this_chunk_size)
2393         {
2394             error_setg(errp, "Failed to read state");
2395             ret = -EINVAL;
2396             goto fail;
2397         }
2398 
2399         transfer_pointer = transfer_buf;
2400         while (this_chunk_size > 0) {
2401             write_ret = RETRY_ON_EINTR(
2402                 write(write_fd, transfer_pointer, this_chunk_size)
2403             );
2404             if (write_ret < 0) {
2405                 ret = -errno;
2406                 error_setg_errno(errp, -ret, "Failed to send state");
2407                 goto fail;
2408             } else if (write_ret == 0) {
2409                 error_setg(errp, "Failed to send state: Connection is closed");
2410                 ret = -ECONNRESET;
2411                 goto fail;
2412             }
2413 
2414             assert(write_ret <= this_chunk_size);
2415             this_chunk_size -= write_ret;
2416             transfer_pointer += write_ret;
2417         }
2418     }
2419 
2420     /*
2421      * Close our end, thus ending transfer, before inquiring the back-end about
2422      * whether transfer was successful
2423      */
2424     close(write_fd);
2425     write_fd = -1;
2426 
2427     /* Also, verify that the device is still stopped */
2428     assert(!dev->started);
2429 
2430     ret = vhost_check_device_state(dev, errp);
2431     if (ret < 0) {
2432         goto fail;
2433     }
2434 
2435     ret = 0;
2436 fail:
2437     if (write_fd >= 0) {
2438         close(write_fd);
2439     }
2440 
2441     return ret;
2442 }
2443