xref: /openbmc/qemu/hw/vfio/container.c (revision 4921d0a7)
1 /*
2  * generic functions used by VFIO devices
3  *
4  * Copyright Red Hat, Inc. 2012
5  *
6  * Authors:
7  *  Alex Williamson <alex.williamson@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  * Based on qemu-kvm device-assignment:
13  *  Adapted for KVM by Qumranet.
14  *  Copyright (c) 2007, Neocleus, Alex Novik (alex@neocleus.com)
15  *  Copyright (c) 2007, Neocleus, Guy Zana (guy@neocleus.com)
16  *  Copyright (C) 2008, Qumranet, Amit Shah (amit.shah@qumranet.com)
17  *  Copyright (C) 2008, Red Hat, Amit Shah (amit.shah@redhat.com)
18  *  Copyright (C) 2008, IBM, Muli Ben-Yehuda (muli@il.ibm.com)
19  */
20 
21 #include "qemu/osdep.h"
22 #include <sys/ioctl.h>
23 #include <linux/vfio.h>
24 
25 #include "hw/vfio/vfio-common.h"
26 #include "exec/address-spaces.h"
27 #include "exec/memory.h"
28 #include "exec/ram_addr.h"
29 #include "hw/hw.h"
30 #include "qemu/error-report.h"
31 #include "qemu/range.h"
32 #include "sysemu/reset.h"
33 #include "trace.h"
34 #include "qapi/error.h"
35 #include "pci.h"
36 
37 VFIOGroupList vfio_group_list =
38     QLIST_HEAD_INITIALIZER(vfio_group_list);
39 
40 static int vfio_ram_block_discard_disable(VFIOContainer *container, bool state)
41 {
42     switch (container->iommu_type) {
43     case VFIO_TYPE1v2_IOMMU:
44     case VFIO_TYPE1_IOMMU:
45         /*
46          * We support coordinated discarding of RAM via the RamDiscardManager.
47          */
48         return ram_block_uncoordinated_discard_disable(state);
49     default:
50         /*
51          * VFIO_SPAPR_TCE_IOMMU most probably works just fine with
52          * RamDiscardManager, however, it is completely untested.
53          *
54          * VFIO_SPAPR_TCE_v2_IOMMU with "DMA memory preregistering" does
55          * completely the opposite of managing mapping/pinning dynamically as
56          * required by RamDiscardManager. We would have to special-case sections
57          * with a RamDiscardManager.
58          */
59         return ram_block_discard_disable(state);
60     }
61 }
62 
63 static int vfio_dma_unmap_bitmap(const VFIOContainer *container,
64                                  hwaddr iova, ram_addr_t size,
65                                  IOMMUTLBEntry *iotlb)
66 {
67     const VFIOContainerBase *bcontainer = &container->bcontainer;
68     struct vfio_iommu_type1_dma_unmap *unmap;
69     struct vfio_bitmap *bitmap;
70     VFIOBitmap vbmap;
71     int ret;
72 
73     ret = vfio_bitmap_alloc(&vbmap, size);
74     if (ret) {
75         return ret;
76     }
77 
78     unmap = g_malloc0(sizeof(*unmap) + sizeof(*bitmap));
79 
80     unmap->argsz = sizeof(*unmap) + sizeof(*bitmap);
81     unmap->iova = iova;
82     unmap->size = size;
83     unmap->flags |= VFIO_DMA_UNMAP_FLAG_GET_DIRTY_BITMAP;
84     bitmap = (struct vfio_bitmap *)&unmap->data;
85 
86     /*
87      * cpu_physical_memory_set_dirty_lebitmap() supports pages in bitmap of
88      * qemu_real_host_page_size to mark those dirty. Hence set bitmap_pgsize
89      * to qemu_real_host_page_size.
90      */
91     bitmap->pgsize = qemu_real_host_page_size();
92     bitmap->size = vbmap.size;
93     bitmap->data = (__u64 *)vbmap.bitmap;
94 
95     if (vbmap.size > bcontainer->max_dirty_bitmap_size) {
96         error_report("UNMAP: Size of bitmap too big 0x%"PRIx64, vbmap.size);
97         ret = -E2BIG;
98         goto unmap_exit;
99     }
100 
101     ret = ioctl(container->fd, VFIO_IOMMU_UNMAP_DMA, unmap);
102     if (!ret) {
103         cpu_physical_memory_set_dirty_lebitmap(vbmap.bitmap,
104                 iotlb->translated_addr, vbmap.pages);
105     } else {
106         error_report("VFIO_UNMAP_DMA with DIRTY_BITMAP : %m");
107     }
108 
109 unmap_exit:
110     g_free(unmap);
111     g_free(vbmap.bitmap);
112 
113     return ret;
114 }
115 
116 /*
117  * DMA - Mapping and unmapping for the "type1" IOMMU interface used on x86
118  */
119 static int vfio_legacy_dma_unmap(const VFIOContainerBase *bcontainer,
120                                  hwaddr iova, ram_addr_t size,
121                                  IOMMUTLBEntry *iotlb)
122 {
123     const VFIOContainer *container = container_of(bcontainer, VFIOContainer,
124                                                   bcontainer);
125     struct vfio_iommu_type1_dma_unmap unmap = {
126         .argsz = sizeof(unmap),
127         .flags = 0,
128         .iova = iova,
129         .size = size,
130     };
131     bool need_dirty_sync = false;
132     int ret;
133 
134     if (iotlb && vfio_devices_all_running_and_mig_active(bcontainer)) {
135         if (!vfio_devices_all_device_dirty_tracking(bcontainer) &&
136             bcontainer->dirty_pages_supported) {
137             return vfio_dma_unmap_bitmap(container, iova, size, iotlb);
138         }
139 
140         need_dirty_sync = true;
141     }
142 
143     while (ioctl(container->fd, VFIO_IOMMU_UNMAP_DMA, &unmap)) {
144         /*
145          * The type1 backend has an off-by-one bug in the kernel (71a7d3d78e3c
146          * v4.15) where an overflow in its wrap-around check prevents us from
147          * unmapping the last page of the address space.  Test for the error
148          * condition and re-try the unmap excluding the last page.  The
149          * expectation is that we've never mapped the last page anyway and this
150          * unmap request comes via vIOMMU support which also makes it unlikely
151          * that this page is used.  This bug was introduced well after type1 v2
152          * support was introduced, so we shouldn't need to test for v1.  A fix
153          * is queued for kernel v5.0 so this workaround can be removed once
154          * affected kernels are sufficiently deprecated.
155          */
156         if (errno == EINVAL && unmap.size && !(unmap.iova + unmap.size) &&
157             container->iommu_type == VFIO_TYPE1v2_IOMMU) {
158             trace_vfio_legacy_dma_unmap_overflow_workaround();
159             unmap.size -= 1ULL << ctz64(bcontainer->pgsizes);
160             continue;
161         }
162         error_report("VFIO_UNMAP_DMA failed: %s", strerror(errno));
163         return -errno;
164     }
165 
166     if (need_dirty_sync) {
167         ret = vfio_get_dirty_bitmap(bcontainer, iova, size,
168                                     iotlb->translated_addr);
169         if (ret) {
170             return ret;
171         }
172     }
173 
174     return 0;
175 }
176 
177 static int vfio_legacy_dma_map(const VFIOContainerBase *bcontainer, hwaddr iova,
178                                ram_addr_t size, void *vaddr, bool readonly)
179 {
180     const VFIOContainer *container = container_of(bcontainer, VFIOContainer,
181                                                   bcontainer);
182     struct vfio_iommu_type1_dma_map map = {
183         .argsz = sizeof(map),
184         .flags = VFIO_DMA_MAP_FLAG_READ,
185         .vaddr = (__u64)(uintptr_t)vaddr,
186         .iova = iova,
187         .size = size,
188     };
189 
190     if (!readonly) {
191         map.flags |= VFIO_DMA_MAP_FLAG_WRITE;
192     }
193 
194     /*
195      * Try the mapping, if it fails with EBUSY, unmap the region and try
196      * again.  This shouldn't be necessary, but we sometimes see it in
197      * the VGA ROM space.
198      */
199     if (ioctl(container->fd, VFIO_IOMMU_MAP_DMA, &map) == 0 ||
200         (errno == EBUSY &&
201          vfio_legacy_dma_unmap(bcontainer, iova, size, NULL) == 0 &&
202          ioctl(container->fd, VFIO_IOMMU_MAP_DMA, &map) == 0)) {
203         return 0;
204     }
205 
206     error_report("VFIO_MAP_DMA failed: %s", strerror(errno));
207     return -errno;
208 }
209 
210 static int
211 vfio_legacy_set_dirty_page_tracking(const VFIOContainerBase *bcontainer,
212                                     bool start)
213 {
214     const VFIOContainer *container = container_of(bcontainer, VFIOContainer,
215                                                   bcontainer);
216     int ret;
217     struct vfio_iommu_type1_dirty_bitmap dirty = {
218         .argsz = sizeof(dirty),
219     };
220 
221     if (start) {
222         dirty.flags = VFIO_IOMMU_DIRTY_PAGES_FLAG_START;
223     } else {
224         dirty.flags = VFIO_IOMMU_DIRTY_PAGES_FLAG_STOP;
225     }
226 
227     ret = ioctl(container->fd, VFIO_IOMMU_DIRTY_PAGES, &dirty);
228     if (ret) {
229         ret = -errno;
230         error_report("Failed to set dirty tracking flag 0x%x errno: %d",
231                      dirty.flags, errno);
232     }
233 
234     return ret;
235 }
236 
237 static int vfio_legacy_query_dirty_bitmap(const VFIOContainerBase *bcontainer,
238                                           VFIOBitmap *vbmap,
239                                           hwaddr iova, hwaddr size)
240 {
241     const VFIOContainer *container = container_of(bcontainer, VFIOContainer,
242                                                   bcontainer);
243     struct vfio_iommu_type1_dirty_bitmap *dbitmap;
244     struct vfio_iommu_type1_dirty_bitmap_get *range;
245     int ret;
246 
247     dbitmap = g_malloc0(sizeof(*dbitmap) + sizeof(*range));
248 
249     dbitmap->argsz = sizeof(*dbitmap) + sizeof(*range);
250     dbitmap->flags = VFIO_IOMMU_DIRTY_PAGES_FLAG_GET_BITMAP;
251     range = (struct vfio_iommu_type1_dirty_bitmap_get *)&dbitmap->data;
252     range->iova = iova;
253     range->size = size;
254 
255     /*
256      * cpu_physical_memory_set_dirty_lebitmap() supports pages in bitmap of
257      * qemu_real_host_page_size to mark those dirty. Hence set bitmap's pgsize
258      * to qemu_real_host_page_size.
259      */
260     range->bitmap.pgsize = qemu_real_host_page_size();
261     range->bitmap.size = vbmap->size;
262     range->bitmap.data = (__u64 *)vbmap->bitmap;
263 
264     ret = ioctl(container->fd, VFIO_IOMMU_DIRTY_PAGES, dbitmap);
265     if (ret) {
266         ret = -errno;
267         error_report("Failed to get dirty bitmap for iova: 0x%"PRIx64
268                 " size: 0x%"PRIx64" err: %d", (uint64_t)range->iova,
269                 (uint64_t)range->size, errno);
270     }
271 
272     g_free(dbitmap);
273 
274     return ret;
275 }
276 
277 static struct vfio_info_cap_header *
278 vfio_get_iommu_type1_info_cap(struct vfio_iommu_type1_info *info, uint16_t id)
279 {
280     if (!(info->flags & VFIO_IOMMU_INFO_CAPS)) {
281         return NULL;
282     }
283 
284     return vfio_get_cap((void *)info, info->cap_offset, id);
285 }
286 
287 bool vfio_get_info_dma_avail(struct vfio_iommu_type1_info *info,
288                              unsigned int *avail)
289 {
290     struct vfio_info_cap_header *hdr;
291     struct vfio_iommu_type1_info_dma_avail *cap;
292 
293     /* If the capability cannot be found, assume no DMA limiting */
294     hdr = vfio_get_iommu_type1_info_cap(info,
295                                         VFIO_IOMMU_TYPE1_INFO_DMA_AVAIL);
296     if (!hdr) {
297         return false;
298     }
299 
300     if (avail != NULL) {
301         cap = (void *) hdr;
302         *avail = cap->avail;
303     }
304 
305     return true;
306 }
307 
308 static bool vfio_get_info_iova_range(struct vfio_iommu_type1_info *info,
309                                      VFIOContainerBase *bcontainer)
310 {
311     struct vfio_info_cap_header *hdr;
312     struct vfio_iommu_type1_info_cap_iova_range *cap;
313 
314     hdr = vfio_get_iommu_type1_info_cap(info,
315                                         VFIO_IOMMU_TYPE1_INFO_CAP_IOVA_RANGE);
316     if (!hdr) {
317         return false;
318     }
319 
320     cap = (void *)hdr;
321 
322     for (int i = 0; i < cap->nr_iovas; i++) {
323         Range *range = g_new(Range, 1);
324 
325         range_set_bounds(range, cap->iova_ranges[i].start,
326                          cap->iova_ranges[i].end);
327         bcontainer->iova_ranges =
328             range_list_insert(bcontainer->iova_ranges, range);
329     }
330 
331     return true;
332 }
333 
334 static void vfio_kvm_device_add_group(VFIOGroup *group)
335 {
336     Error *err = NULL;
337 
338     if (vfio_kvm_device_add_fd(group->fd, &err)) {
339         error_reportf_err(err, "group ID %d: ", group->groupid);
340     }
341 }
342 
343 static void vfio_kvm_device_del_group(VFIOGroup *group)
344 {
345     Error *err = NULL;
346 
347     if (vfio_kvm_device_del_fd(group->fd, &err)) {
348         error_reportf_err(err, "group ID %d: ", group->groupid);
349     }
350 }
351 
352 /*
353  * vfio_get_iommu_type - selects the richest iommu_type (v2 first)
354  */
355 static int vfio_get_iommu_type(VFIOContainer *container,
356                                Error **errp)
357 {
358     int iommu_types[] = { VFIO_TYPE1v2_IOMMU, VFIO_TYPE1_IOMMU,
359                           VFIO_SPAPR_TCE_v2_IOMMU, VFIO_SPAPR_TCE_IOMMU };
360     int i;
361 
362     for (i = 0; i < ARRAY_SIZE(iommu_types); i++) {
363         if (ioctl(container->fd, VFIO_CHECK_EXTENSION, iommu_types[i])) {
364             return iommu_types[i];
365         }
366     }
367     error_setg(errp, "No available IOMMU models");
368     return -EINVAL;
369 }
370 
371 /*
372  * vfio_get_iommu_ops - get a VFIOIOMMUClass associated with a type
373  */
374 static const VFIOIOMMUClass *vfio_get_iommu_class(int iommu_type, Error **errp)
375 {
376     ObjectClass *klass = NULL;
377 
378     switch (iommu_type) {
379     case VFIO_TYPE1v2_IOMMU:
380     case VFIO_TYPE1_IOMMU:
381         klass = object_class_by_name(TYPE_VFIO_IOMMU_LEGACY);
382         break;
383     case VFIO_SPAPR_TCE_v2_IOMMU:
384     case VFIO_SPAPR_TCE_IOMMU:
385         klass = object_class_by_name(TYPE_VFIO_IOMMU_SPAPR);
386         break;
387     default:
388         g_assert_not_reached();
389     };
390 
391     return VFIO_IOMMU_CLASS(klass);
392 }
393 
394 static int vfio_set_iommu(VFIOContainer *container, int group_fd,
395                           VFIOAddressSpace *space, Error **errp)
396 {
397     int iommu_type, ret;
398     const VFIOIOMMUClass *vioc;
399 
400     iommu_type = vfio_get_iommu_type(container, errp);
401     if (iommu_type < 0) {
402         return iommu_type;
403     }
404 
405     ret = ioctl(group_fd, VFIO_GROUP_SET_CONTAINER, &container->fd);
406     if (ret) {
407         error_setg_errno(errp, errno, "Failed to set group container");
408         return -errno;
409     }
410 
411     while (ioctl(container->fd, VFIO_SET_IOMMU, iommu_type)) {
412         if (iommu_type == VFIO_SPAPR_TCE_v2_IOMMU) {
413             /*
414              * On sPAPR, despite the IOMMU subdriver always advertises v1 and
415              * v2, the running platform may not support v2 and there is no
416              * way to guess it until an IOMMU group gets added to the container.
417              * So in case it fails with v2, try v1 as a fallback.
418              */
419             iommu_type = VFIO_SPAPR_TCE_IOMMU;
420             continue;
421         }
422         error_setg_errno(errp, errno, "Failed to set iommu for container");
423         return -errno;
424     }
425 
426     container->iommu_type = iommu_type;
427 
428     vioc = vfio_get_iommu_class(iommu_type, errp);
429     if (!vioc) {
430         error_setg(errp, "No available IOMMU models");
431         return -EINVAL;
432     }
433 
434     vfio_container_init(&container->bcontainer, space, vioc);
435     return 0;
436 }
437 
438 static int vfio_get_iommu_info(VFIOContainer *container,
439                                struct vfio_iommu_type1_info **info)
440 {
441 
442     size_t argsz = sizeof(struct vfio_iommu_type1_info);
443 
444     *info = g_new0(struct vfio_iommu_type1_info, 1);
445 again:
446     (*info)->argsz = argsz;
447 
448     if (ioctl(container->fd, VFIO_IOMMU_GET_INFO, *info)) {
449         g_free(*info);
450         *info = NULL;
451         return -errno;
452     }
453 
454     if (((*info)->argsz > argsz)) {
455         argsz = (*info)->argsz;
456         *info = g_realloc(*info, argsz);
457         goto again;
458     }
459 
460     return 0;
461 }
462 
463 static struct vfio_info_cap_header *
464 vfio_get_iommu_info_cap(struct vfio_iommu_type1_info *info, uint16_t id)
465 {
466     struct vfio_info_cap_header *hdr;
467     void *ptr = info;
468 
469     if (!(info->flags & VFIO_IOMMU_INFO_CAPS)) {
470         return NULL;
471     }
472 
473     for (hdr = ptr + info->cap_offset; hdr != ptr; hdr = ptr + hdr->next) {
474         if (hdr->id == id) {
475             return hdr;
476         }
477     }
478 
479     return NULL;
480 }
481 
482 static void vfio_get_iommu_info_migration(VFIOContainer *container,
483                                           struct vfio_iommu_type1_info *info)
484 {
485     struct vfio_info_cap_header *hdr;
486     struct vfio_iommu_type1_info_cap_migration *cap_mig;
487     VFIOContainerBase *bcontainer = &container->bcontainer;
488 
489     hdr = vfio_get_iommu_info_cap(info, VFIO_IOMMU_TYPE1_INFO_CAP_MIGRATION);
490     if (!hdr) {
491         return;
492     }
493 
494     cap_mig = container_of(hdr, struct vfio_iommu_type1_info_cap_migration,
495                             header);
496 
497     /*
498      * cpu_physical_memory_set_dirty_lebitmap() supports pages in bitmap of
499      * qemu_real_host_page_size to mark those dirty.
500      */
501     if (cap_mig->pgsize_bitmap & qemu_real_host_page_size()) {
502         bcontainer->dirty_pages_supported = true;
503         bcontainer->max_dirty_bitmap_size = cap_mig->max_dirty_bitmap_size;
504         bcontainer->dirty_pgsizes = cap_mig->pgsize_bitmap;
505     }
506 }
507 
508 static int vfio_legacy_setup(VFIOContainerBase *bcontainer, Error **errp)
509 {
510     VFIOContainer *container = container_of(bcontainer, VFIOContainer,
511                                             bcontainer);
512     g_autofree struct vfio_iommu_type1_info *info = NULL;
513     int ret;
514 
515     ret = vfio_get_iommu_info(container, &info);
516     if (ret) {
517         error_setg_errno(errp, -ret, "Failed to get VFIO IOMMU info");
518         return ret;
519     }
520 
521     if (info->flags & VFIO_IOMMU_INFO_PGSIZES) {
522         bcontainer->pgsizes = info->iova_pgsizes;
523     } else {
524         bcontainer->pgsizes = qemu_real_host_page_size();
525     }
526 
527     if (!vfio_get_info_dma_avail(info, &bcontainer->dma_max_mappings)) {
528         bcontainer->dma_max_mappings = 65535;
529     }
530 
531     vfio_get_info_iova_range(info, bcontainer);
532 
533     vfio_get_iommu_info_migration(container, info);
534     return 0;
535 }
536 
537 static int vfio_connect_container(VFIOGroup *group, AddressSpace *as,
538                                   Error **errp)
539 {
540     VFIOContainer *container;
541     VFIOContainerBase *bcontainer;
542     int ret, fd;
543     VFIOAddressSpace *space;
544 
545     space = vfio_get_address_space(as);
546 
547     /*
548      * VFIO is currently incompatible with discarding of RAM insofar as the
549      * madvise to purge (zap) the page from QEMU's address space does not
550      * interact with the memory API and therefore leaves stale virtual to
551      * physical mappings in the IOMMU if the page was previously pinned.  We
552      * therefore set discarding broken for each group added to a container,
553      * whether the container is used individually or shared.  This provides
554      * us with options to allow devices within a group to opt-in and allow
555      * discarding, so long as it is done consistently for a group (for instance
556      * if the device is an mdev device where it is known that the host vendor
557      * driver will never pin pages outside of the working set of the guest
558      * driver, which would thus not be discarding candidates).
559      *
560      * The first opportunity to induce pinning occurs here where we attempt to
561      * attach the group to existing containers within the AddressSpace.  If any
562      * pages are already zapped from the virtual address space, such as from
563      * previous discards, new pinning will cause valid mappings to be
564      * re-established.  Likewise, when the overall MemoryListener for a new
565      * container is registered, a replay of mappings within the AddressSpace
566      * will occur, re-establishing any previously zapped pages as well.
567      *
568      * Especially virtio-balloon is currently only prevented from discarding
569      * new memory, it will not yet set ram_block_discard_set_required() and
570      * therefore, neither stops us here or deals with the sudden memory
571      * consumption of inflated memory.
572      *
573      * We do support discarding of memory coordinated via the RamDiscardManager
574      * with some IOMMU types. vfio_ram_block_discard_disable() handles the
575      * details once we know which type of IOMMU we are using.
576      */
577 
578     QLIST_FOREACH(bcontainer, &space->containers, next) {
579         container = container_of(bcontainer, VFIOContainer, bcontainer);
580         if (!ioctl(group->fd, VFIO_GROUP_SET_CONTAINER, &container->fd)) {
581             ret = vfio_ram_block_discard_disable(container, true);
582             if (ret) {
583                 error_setg_errno(errp, -ret,
584                                  "Cannot set discarding of RAM broken");
585                 if (ioctl(group->fd, VFIO_GROUP_UNSET_CONTAINER,
586                           &container->fd)) {
587                     error_report("vfio: error disconnecting group %d from"
588                                  " container", group->groupid);
589                 }
590                 return ret;
591             }
592             group->container = container;
593             QLIST_INSERT_HEAD(&container->group_list, group, container_next);
594             vfio_kvm_device_add_group(group);
595             return 0;
596         }
597     }
598 
599     fd = qemu_open_old("/dev/vfio/vfio", O_RDWR);
600     if (fd < 0) {
601         error_setg_errno(errp, errno, "failed to open /dev/vfio/vfio");
602         ret = -errno;
603         goto put_space_exit;
604     }
605 
606     ret = ioctl(fd, VFIO_GET_API_VERSION);
607     if (ret != VFIO_API_VERSION) {
608         error_setg(errp, "supported vfio version: %d, "
609                    "reported version: %d", VFIO_API_VERSION, ret);
610         ret = -EINVAL;
611         goto close_fd_exit;
612     }
613 
614     container = g_malloc0(sizeof(*container));
615     container->fd = fd;
616     bcontainer = &container->bcontainer;
617 
618     ret = vfio_set_iommu(container, group->fd, space, errp);
619     if (ret) {
620         goto free_container_exit;
621     }
622 
623     ret = vfio_cpr_register_container(bcontainer, errp);
624     if (ret) {
625         goto free_container_exit;
626     }
627 
628     ret = vfio_ram_block_discard_disable(container, true);
629     if (ret) {
630         error_setg_errno(errp, -ret, "Cannot set discarding of RAM broken");
631         goto unregister_container_exit;
632     }
633 
634     assert(bcontainer->ops->setup);
635 
636     ret = bcontainer->ops->setup(bcontainer, errp);
637     if (ret) {
638         goto enable_discards_exit;
639     }
640 
641     vfio_kvm_device_add_group(group);
642 
643     QLIST_INIT(&container->group_list);
644     QLIST_INSERT_HEAD(&space->containers, bcontainer, next);
645 
646     group->container = container;
647     QLIST_INSERT_HEAD(&container->group_list, group, container_next);
648 
649     bcontainer->listener = vfio_memory_listener;
650     memory_listener_register(&bcontainer->listener, bcontainer->space->as);
651 
652     if (bcontainer->error) {
653         ret = -1;
654         error_propagate_prepend(errp, bcontainer->error,
655             "memory listener initialization failed: ");
656         goto listener_release_exit;
657     }
658 
659     bcontainer->initialized = true;
660 
661     return 0;
662 listener_release_exit:
663     QLIST_REMOVE(group, container_next);
664     QLIST_REMOVE(bcontainer, next);
665     vfio_kvm_device_del_group(group);
666     memory_listener_unregister(&bcontainer->listener);
667     if (bcontainer->ops->release) {
668         bcontainer->ops->release(bcontainer);
669     }
670 
671 enable_discards_exit:
672     vfio_ram_block_discard_disable(container, false);
673 
674 unregister_container_exit:
675     vfio_cpr_unregister_container(bcontainer);
676 
677 free_container_exit:
678     g_free(container);
679 
680 close_fd_exit:
681     close(fd);
682 
683 put_space_exit:
684     vfio_put_address_space(space);
685 
686     return ret;
687 }
688 
689 static void vfio_disconnect_container(VFIOGroup *group)
690 {
691     VFIOContainer *container = group->container;
692     VFIOContainerBase *bcontainer = &container->bcontainer;
693 
694     QLIST_REMOVE(group, container_next);
695     group->container = NULL;
696 
697     /*
698      * Explicitly release the listener first before unset container,
699      * since unset may destroy the backend container if it's the last
700      * group.
701      */
702     if (QLIST_EMPTY(&container->group_list)) {
703         memory_listener_unregister(&bcontainer->listener);
704         if (bcontainer->ops->release) {
705             bcontainer->ops->release(bcontainer);
706         }
707     }
708 
709     if (ioctl(group->fd, VFIO_GROUP_UNSET_CONTAINER, &container->fd)) {
710         error_report("vfio: error disconnecting group %d from container",
711                      group->groupid);
712     }
713 
714     if (QLIST_EMPTY(&container->group_list)) {
715         VFIOAddressSpace *space = bcontainer->space;
716 
717         vfio_container_destroy(bcontainer);
718 
719         trace_vfio_disconnect_container(container->fd);
720         vfio_cpr_unregister_container(bcontainer);
721         close(container->fd);
722         g_free(container);
723 
724         vfio_put_address_space(space);
725     }
726 }
727 
728 static VFIOGroup *vfio_get_group(int groupid, AddressSpace *as, Error **errp)
729 {
730     ERRP_GUARD();
731     VFIOGroup *group;
732     char path[32];
733     struct vfio_group_status status = { .argsz = sizeof(status) };
734 
735     QLIST_FOREACH(group, &vfio_group_list, next) {
736         if (group->groupid == groupid) {
737             /* Found it.  Now is it already in the right context? */
738             if (group->container->bcontainer.space->as == as) {
739                 return group;
740             } else {
741                 error_setg(errp, "group %d used in multiple address spaces",
742                            group->groupid);
743                 return NULL;
744             }
745         }
746     }
747 
748     group = g_malloc0(sizeof(*group));
749 
750     snprintf(path, sizeof(path), "/dev/vfio/%d", groupid);
751     group->fd = qemu_open_old(path, O_RDWR);
752     if (group->fd < 0) {
753         error_setg_errno(errp, errno, "failed to open %s", path);
754         goto free_group_exit;
755     }
756 
757     if (ioctl(group->fd, VFIO_GROUP_GET_STATUS, &status)) {
758         error_setg_errno(errp, errno, "failed to get group %d status", groupid);
759         goto close_fd_exit;
760     }
761 
762     if (!(status.flags & VFIO_GROUP_FLAGS_VIABLE)) {
763         error_setg(errp, "group %d is not viable", groupid);
764         error_append_hint(errp,
765                           "Please ensure all devices within the iommu_group "
766                           "are bound to their vfio bus driver.\n");
767         goto close_fd_exit;
768     }
769 
770     group->groupid = groupid;
771     QLIST_INIT(&group->device_list);
772 
773     if (vfio_connect_container(group, as, errp)) {
774         error_prepend(errp, "failed to setup container for group %d: ",
775                       groupid);
776         goto close_fd_exit;
777     }
778 
779     QLIST_INSERT_HEAD(&vfio_group_list, group, next);
780 
781     return group;
782 
783 close_fd_exit:
784     close(group->fd);
785 
786 free_group_exit:
787     g_free(group);
788 
789     return NULL;
790 }
791 
792 static void vfio_put_group(VFIOGroup *group)
793 {
794     if (!group || !QLIST_EMPTY(&group->device_list)) {
795         return;
796     }
797 
798     if (!group->ram_block_discard_allowed) {
799         vfio_ram_block_discard_disable(group->container, false);
800     }
801     vfio_kvm_device_del_group(group);
802     vfio_disconnect_container(group);
803     QLIST_REMOVE(group, next);
804     trace_vfio_put_group(group->fd);
805     close(group->fd);
806     g_free(group);
807 }
808 
809 static int vfio_get_device(VFIOGroup *group, const char *name,
810                            VFIODevice *vbasedev, Error **errp)
811 {
812     g_autofree struct vfio_device_info *info = NULL;
813     int fd;
814 
815     fd = ioctl(group->fd, VFIO_GROUP_GET_DEVICE_FD, name);
816     if (fd < 0) {
817         error_setg_errno(errp, errno, "error getting device from group %d",
818                          group->groupid);
819         error_append_hint(errp,
820                       "Verify all devices in group %d are bound to vfio-<bus> "
821                       "or pci-stub and not already in use\n", group->groupid);
822         return fd;
823     }
824 
825     info = vfio_get_device_info(fd);
826     if (!info) {
827         error_setg_errno(errp, errno, "error getting device info");
828         close(fd);
829         return -1;
830     }
831 
832     /*
833      * Set discarding of RAM as not broken for this group if the driver knows
834      * the device operates compatibly with discarding.  Setting must be
835      * consistent per group, but since compatibility is really only possible
836      * with mdev currently, we expect singleton groups.
837      */
838     if (vbasedev->ram_block_discard_allowed !=
839         group->ram_block_discard_allowed) {
840         if (!QLIST_EMPTY(&group->device_list)) {
841             error_setg(errp, "Inconsistent setting of support for discarding "
842                        "RAM (e.g., balloon) within group");
843             close(fd);
844             return -1;
845         }
846 
847         if (!group->ram_block_discard_allowed) {
848             group->ram_block_discard_allowed = true;
849             vfio_ram_block_discard_disable(group->container, false);
850         }
851     }
852 
853     vbasedev->fd = fd;
854     vbasedev->group = group;
855     QLIST_INSERT_HEAD(&group->device_list, vbasedev, next);
856 
857     vbasedev->num_irqs = info->num_irqs;
858     vbasedev->num_regions = info->num_regions;
859     vbasedev->flags = info->flags;
860 
861     trace_vfio_get_device(name, info->flags, info->num_regions, info->num_irqs);
862 
863     vbasedev->reset_works = !!(info->flags & VFIO_DEVICE_FLAGS_RESET);
864 
865     return 0;
866 }
867 
868 static void vfio_put_base_device(VFIODevice *vbasedev)
869 {
870     if (!vbasedev->group) {
871         return;
872     }
873     QLIST_REMOVE(vbasedev, next);
874     vbasedev->group = NULL;
875     trace_vfio_put_base_device(vbasedev->fd);
876     close(vbasedev->fd);
877 }
878 
879 static int vfio_device_groupid(VFIODevice *vbasedev, Error **errp)
880 {
881     char *tmp, group_path[PATH_MAX];
882     g_autofree char *group_name = NULL;
883     int ret, groupid;
884     ssize_t len;
885 
886     tmp = g_strdup_printf("%s/iommu_group", vbasedev->sysfsdev);
887     len = readlink(tmp, group_path, sizeof(group_path));
888     g_free(tmp);
889 
890     if (len <= 0 || len >= sizeof(group_path)) {
891         ret = len < 0 ? -errno : -ENAMETOOLONG;
892         error_setg_errno(errp, -ret, "no iommu_group found");
893         return ret;
894     }
895 
896     group_path[len] = 0;
897 
898     group_name = g_path_get_basename(group_path);
899     if (sscanf(group_name, "%d", &groupid) != 1) {
900         error_setg_errno(errp, errno, "failed to read %s", group_path);
901         return -errno;
902     }
903     return groupid;
904 }
905 
906 /*
907  * vfio_attach_device: attach a device to a security context
908  * @name and @vbasedev->name are likely to be different depending
909  * on the type of the device, hence the need for passing @name
910  */
911 static int vfio_legacy_attach_device(const char *name, VFIODevice *vbasedev,
912                                      AddressSpace *as, Error **errp)
913 {
914     int groupid = vfio_device_groupid(vbasedev, errp);
915     VFIODevice *vbasedev_iter;
916     VFIOGroup *group;
917     VFIOContainerBase *bcontainer;
918     int ret;
919 
920     if (groupid < 0) {
921         return groupid;
922     }
923 
924     trace_vfio_attach_device(vbasedev->name, groupid);
925 
926     group = vfio_get_group(groupid, as, errp);
927     if (!group) {
928         return -ENOENT;
929     }
930 
931     QLIST_FOREACH(vbasedev_iter, &group->device_list, next) {
932         if (strcmp(vbasedev_iter->name, vbasedev->name) == 0) {
933             error_setg(errp, "device is already attached");
934             vfio_put_group(group);
935             return -EBUSY;
936         }
937     }
938     ret = vfio_get_device(group, name, vbasedev, errp);
939     if (ret) {
940         vfio_put_group(group);
941         return ret;
942     }
943 
944     bcontainer = &group->container->bcontainer;
945     vbasedev->bcontainer = bcontainer;
946     QLIST_INSERT_HEAD(&bcontainer->device_list, vbasedev, container_next);
947     QLIST_INSERT_HEAD(&vfio_device_list, vbasedev, global_next);
948 
949     return ret;
950 }
951 
952 static void vfio_legacy_detach_device(VFIODevice *vbasedev)
953 {
954     VFIOGroup *group = vbasedev->group;
955 
956     QLIST_REMOVE(vbasedev, global_next);
957     QLIST_REMOVE(vbasedev, container_next);
958     vbasedev->bcontainer = NULL;
959     trace_vfio_detach_device(vbasedev->name, group->groupid);
960     vfio_put_base_device(vbasedev);
961     vfio_put_group(group);
962 }
963 
964 static int vfio_legacy_pci_hot_reset(VFIODevice *vbasedev, bool single)
965 {
966     VFIOPCIDevice *vdev = container_of(vbasedev, VFIOPCIDevice, vbasedev);
967     VFIOGroup *group;
968     struct vfio_pci_hot_reset_info *info = NULL;
969     struct vfio_pci_dependent_device *devices;
970     struct vfio_pci_hot_reset *reset;
971     int32_t *fds;
972     int ret, i, count;
973     bool multi = false;
974 
975     trace_vfio_pci_hot_reset(vdev->vbasedev.name, single ? "one" : "multi");
976 
977     if (!single) {
978         vfio_pci_pre_reset(vdev);
979     }
980     vdev->vbasedev.needs_reset = false;
981 
982     ret = vfio_pci_get_pci_hot_reset_info(vdev, &info);
983 
984     if (ret) {
985         goto out_single;
986     }
987     devices = &info->devices[0];
988 
989     trace_vfio_pci_hot_reset_has_dep_devices(vdev->vbasedev.name);
990 
991     /* Verify that we have all the groups required */
992     for (i = 0; i < info->count; i++) {
993         PCIHostDeviceAddress host;
994         VFIOPCIDevice *tmp;
995         VFIODevice *vbasedev_iter;
996 
997         host.domain = devices[i].segment;
998         host.bus = devices[i].bus;
999         host.slot = PCI_SLOT(devices[i].devfn);
1000         host.function = PCI_FUNC(devices[i].devfn);
1001 
1002         trace_vfio_pci_hot_reset_dep_devices(host.domain,
1003                 host.bus, host.slot, host.function, devices[i].group_id);
1004 
1005         if (vfio_pci_host_match(&host, vdev->vbasedev.name)) {
1006             continue;
1007         }
1008 
1009         QLIST_FOREACH(group, &vfio_group_list, next) {
1010             if (group->groupid == devices[i].group_id) {
1011                 break;
1012             }
1013         }
1014 
1015         if (!group) {
1016             if (!vdev->has_pm_reset) {
1017                 error_report("vfio: Cannot reset device %s, "
1018                              "depends on group %d which is not owned.",
1019                              vdev->vbasedev.name, devices[i].group_id);
1020             }
1021             ret = -EPERM;
1022             goto out;
1023         }
1024 
1025         /* Prep dependent devices for reset and clear our marker. */
1026         QLIST_FOREACH(vbasedev_iter, &group->device_list, next) {
1027             if (!vbasedev_iter->dev->realized ||
1028                 vbasedev_iter->type != VFIO_DEVICE_TYPE_PCI) {
1029                 continue;
1030             }
1031             tmp = container_of(vbasedev_iter, VFIOPCIDevice, vbasedev);
1032             if (vfio_pci_host_match(&host, tmp->vbasedev.name)) {
1033                 if (single) {
1034                     ret = -EINVAL;
1035                     goto out_single;
1036                 }
1037                 vfio_pci_pre_reset(tmp);
1038                 tmp->vbasedev.needs_reset = false;
1039                 multi = true;
1040                 break;
1041             }
1042         }
1043     }
1044 
1045     if (!single && !multi) {
1046         ret = -EINVAL;
1047         goto out_single;
1048     }
1049 
1050     /* Determine how many group fds need to be passed */
1051     count = 0;
1052     QLIST_FOREACH(group, &vfio_group_list, next) {
1053         for (i = 0; i < info->count; i++) {
1054             if (group->groupid == devices[i].group_id) {
1055                 count++;
1056                 break;
1057             }
1058         }
1059     }
1060 
1061     reset = g_malloc0(sizeof(*reset) + (count * sizeof(*fds)));
1062     reset->argsz = sizeof(*reset) + (count * sizeof(*fds));
1063     fds = &reset->group_fds[0];
1064 
1065     /* Fill in group fds */
1066     QLIST_FOREACH(group, &vfio_group_list, next) {
1067         for (i = 0; i < info->count; i++) {
1068             if (group->groupid == devices[i].group_id) {
1069                 fds[reset->count++] = group->fd;
1070                 break;
1071             }
1072         }
1073     }
1074 
1075     /* Bus reset! */
1076     ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_PCI_HOT_RESET, reset);
1077     g_free(reset);
1078     if (ret) {
1079         ret = -errno;
1080     }
1081 
1082     trace_vfio_pci_hot_reset_result(vdev->vbasedev.name,
1083                                     ret ? strerror(errno) : "Success");
1084 
1085 out:
1086     /* Re-enable INTx on affected devices */
1087     for (i = 0; i < info->count; i++) {
1088         PCIHostDeviceAddress host;
1089         VFIOPCIDevice *tmp;
1090         VFIODevice *vbasedev_iter;
1091 
1092         host.domain = devices[i].segment;
1093         host.bus = devices[i].bus;
1094         host.slot = PCI_SLOT(devices[i].devfn);
1095         host.function = PCI_FUNC(devices[i].devfn);
1096 
1097         if (vfio_pci_host_match(&host, vdev->vbasedev.name)) {
1098             continue;
1099         }
1100 
1101         QLIST_FOREACH(group, &vfio_group_list, next) {
1102             if (group->groupid == devices[i].group_id) {
1103                 break;
1104             }
1105         }
1106 
1107         if (!group) {
1108             break;
1109         }
1110 
1111         QLIST_FOREACH(vbasedev_iter, &group->device_list, next) {
1112             if (!vbasedev_iter->dev->realized ||
1113                 vbasedev_iter->type != VFIO_DEVICE_TYPE_PCI) {
1114                 continue;
1115             }
1116             tmp = container_of(vbasedev_iter, VFIOPCIDevice, vbasedev);
1117             if (vfio_pci_host_match(&host, tmp->vbasedev.name)) {
1118                 vfio_pci_post_reset(tmp);
1119                 break;
1120             }
1121         }
1122     }
1123 out_single:
1124     if (!single) {
1125         vfio_pci_post_reset(vdev);
1126     }
1127     g_free(info);
1128 
1129     return ret;
1130 }
1131 
1132 static void vfio_iommu_legacy_class_init(ObjectClass *klass, void *data)
1133 {
1134     VFIOIOMMUClass *vioc = VFIO_IOMMU_CLASS(klass);
1135 
1136     vioc->setup = vfio_legacy_setup;
1137     vioc->dma_map = vfio_legacy_dma_map;
1138     vioc->dma_unmap = vfio_legacy_dma_unmap;
1139     vioc->attach_device = vfio_legacy_attach_device;
1140     vioc->detach_device = vfio_legacy_detach_device;
1141     vioc->set_dirty_page_tracking = vfio_legacy_set_dirty_page_tracking;
1142     vioc->query_dirty_bitmap = vfio_legacy_query_dirty_bitmap;
1143     vioc->pci_hot_reset = vfio_legacy_pci_hot_reset;
1144 };
1145 
1146 static const TypeInfo types[] = {
1147     {
1148         .name = TYPE_VFIO_IOMMU_LEGACY,
1149         .parent = TYPE_VFIO_IOMMU,
1150         .class_init = vfio_iommu_legacy_class_init,
1151     },
1152 };
1153 
1154 DEFINE_TYPES(types)
1155