xref: /qemu/hw/vfio/pci-quirks.c (revision 475fbf0a3c006b4aa96f423666e285d295e51e38)
1c00d61d8SAlex Williamson /*
2c00d61d8SAlex Williamson  * device quirks for PCI devices
3c00d61d8SAlex Williamson  *
4c00d61d8SAlex Williamson  * Copyright Red Hat, Inc. 2012-2015
5c00d61d8SAlex Williamson  *
6c00d61d8SAlex Williamson  * Authors:
7c00d61d8SAlex Williamson  *  Alex Williamson <alex.williamson@redhat.com>
8c00d61d8SAlex Williamson  *
9c00d61d8SAlex Williamson  * This work is licensed under the terms of the GNU GPL, version 2.  See
10c00d61d8SAlex Williamson  * the COPYING file in the top-level directory.
11c00d61d8SAlex Williamson  */
12c00d61d8SAlex Williamson 
13c6eacb1aSPeter Maydell #include "qemu/osdep.h"
14*475fbf0aSTony Nguyen #include "exec/memop.h"
15e0255bb1SPhilippe Mathieu-Daudé #include "qemu/units.h"
16c4c45e94SAlex Williamson #include "qemu/error-report.h"
17c958c51dSAlex Williamson #include "qemu/main-loop.h"
180b8fa32fSMarkus Armbruster #include "qemu/module.h"
19c4c45e94SAlex Williamson #include "qemu/range.h"
20c4c45e94SAlex Williamson #include "qapi/error.h"
21dfbee78dSAlex Williamson #include "qapi/visitor.h"
222b1dbd0dSAlex Williamson #include <sys/ioctl.h>
23650d103dSMarkus Armbruster #include "hw/hw.h"
24c4c45e94SAlex Williamson #include "hw/nvram/fw_cfg.h"
25a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h"
26c00d61d8SAlex Williamson #include "pci.h"
27c00d61d8SAlex Williamson #include "trace.h"
28c00d61d8SAlex Williamson 
29056dfcb6SAlex Williamson /* Use uin32_t for vendor & device so PCI_ANY_ID expands and cannot match hw */
30056dfcb6SAlex Williamson static bool vfio_pci_is(VFIOPCIDevice *vdev, uint32_t vendor, uint32_t device)
31056dfcb6SAlex Williamson {
32ff635e37SAlex Williamson     return (vendor == PCI_ANY_ID || vendor == vdev->vendor_id) &&
33ff635e37SAlex Williamson            (device == PCI_ANY_ID || device == vdev->device_id);
34056dfcb6SAlex Williamson }
35056dfcb6SAlex Williamson 
360d38fb1cSAlex Williamson static bool vfio_is_vga(VFIOPCIDevice *vdev)
370d38fb1cSAlex Williamson {
380d38fb1cSAlex Williamson     PCIDevice *pdev = &vdev->pdev;
390d38fb1cSAlex Williamson     uint16_t class = pci_get_word(pdev->config + PCI_CLASS_DEVICE);
400d38fb1cSAlex Williamson 
410d38fb1cSAlex Williamson     return class == PCI_CLASS_DISPLAY_VGA;
420d38fb1cSAlex Williamson }
430d38fb1cSAlex Williamson 
44c00d61d8SAlex Williamson /*
45c00d61d8SAlex Williamson  * List of device ids/vendor ids for which to disable
46c00d61d8SAlex Williamson  * option rom loading. This avoids the guest hangs during rom
47c00d61d8SAlex Williamson  * execution as noticed with the BCM 57810 card for lack of a
48c00d61d8SAlex Williamson  * more better way to handle such issues.
49c00d61d8SAlex Williamson  * The  user can still override by specifying a romfile or
50c00d61d8SAlex Williamson  * rombar=1.
51c00d61d8SAlex Williamson  * Please see https://bugs.launchpad.net/qemu/+bug/1284874
52c00d61d8SAlex Williamson  * for an analysis of the 57810 card hang. When adding
53c00d61d8SAlex Williamson  * a new vendor id/device id combination below, please also add
54c00d61d8SAlex Williamson  * your card/environment details and information that could
55c00d61d8SAlex Williamson  * help in debugging to the bug tracking this issue
56c00d61d8SAlex Williamson  */
57056dfcb6SAlex Williamson static const struct {
58056dfcb6SAlex Williamson     uint32_t vendor;
59056dfcb6SAlex Williamson     uint32_t device;
60056dfcb6SAlex Williamson } romblacklist[] = {
61056dfcb6SAlex Williamson     { 0x14e4, 0x168e }, /* Broadcom BCM 57810 */
62c00d61d8SAlex Williamson };
63c00d61d8SAlex Williamson 
64c00d61d8SAlex Williamson bool vfio_blacklist_opt_rom(VFIOPCIDevice *vdev)
65c00d61d8SAlex Williamson {
66056dfcb6SAlex Williamson     int i;
67c00d61d8SAlex Williamson 
68056dfcb6SAlex Williamson     for (i = 0 ; i < ARRAY_SIZE(romblacklist); i++) {
69056dfcb6SAlex Williamson         if (vfio_pci_is(vdev, romblacklist[i].vendor, romblacklist[i].device)) {
70056dfcb6SAlex Williamson             trace_vfio_quirk_rom_blacklisted(vdev->vbasedev.name,
71056dfcb6SAlex Williamson                                              romblacklist[i].vendor,
72056dfcb6SAlex Williamson                                              romblacklist[i].device);
73c00d61d8SAlex Williamson             return true;
74c00d61d8SAlex Williamson         }
75c00d61d8SAlex Williamson     }
76c00d61d8SAlex Williamson     return false;
77c00d61d8SAlex Williamson }
78c00d61d8SAlex Williamson 
79c00d61d8SAlex Williamson /*
800e54f24aSAlex Williamson  * Device specific region quirks (mostly backdoors to PCI config space)
81c00d61d8SAlex Williamson  */
82c00d61d8SAlex Williamson 
830e54f24aSAlex Williamson /*
840e54f24aSAlex Williamson  * The generic window quirks operate on an address and data register,
850e54f24aSAlex Williamson  * vfio_generic_window_address_quirk handles the address register and
860e54f24aSAlex Williamson  * vfio_generic_window_data_quirk handles the data register.  These ops
870e54f24aSAlex Williamson  * pass reads and writes through to hardware until a value matching the
880e54f24aSAlex Williamson  * stored address match/mask is written.  When this occurs, the data
890e54f24aSAlex Williamson  * register access emulated PCI config space for the device rather than
900e54f24aSAlex Williamson  * passing through accesses.  This enables devices where PCI config space
910e54f24aSAlex Williamson  * is accessible behind a window register to maintain the virtualization
920e54f24aSAlex Williamson  * provided through vfio.
930e54f24aSAlex Williamson  */
940e54f24aSAlex Williamson typedef struct VFIOConfigWindowMatch {
950e54f24aSAlex Williamson     uint32_t match;
960e54f24aSAlex Williamson     uint32_t mask;
970e54f24aSAlex Williamson } VFIOConfigWindowMatch;
980e54f24aSAlex Williamson 
990e54f24aSAlex Williamson typedef struct VFIOConfigWindowQuirk {
1000e54f24aSAlex Williamson     struct VFIOPCIDevice *vdev;
1010e54f24aSAlex Williamson 
1020e54f24aSAlex Williamson     uint32_t address_val;
1030e54f24aSAlex Williamson 
1040e54f24aSAlex Williamson     uint32_t address_offset;
1050e54f24aSAlex Williamson     uint32_t data_offset;
1060e54f24aSAlex Williamson 
1070e54f24aSAlex Williamson     bool window_enabled;
1080e54f24aSAlex Williamson     uint8_t bar;
1090e54f24aSAlex Williamson 
1100e54f24aSAlex Williamson     MemoryRegion *addr_mem;
1110e54f24aSAlex Williamson     MemoryRegion *data_mem;
1120e54f24aSAlex Williamson 
1130e54f24aSAlex Williamson     uint32_t nr_matches;
1140e54f24aSAlex Williamson     VFIOConfigWindowMatch matches[];
1150e54f24aSAlex Williamson } VFIOConfigWindowQuirk;
1160e54f24aSAlex Williamson 
1170e54f24aSAlex Williamson static uint64_t vfio_generic_window_quirk_address_read(void *opaque,
1180e54f24aSAlex Williamson                                                        hwaddr addr,
1190e54f24aSAlex Williamson                                                        unsigned size)
1200e54f24aSAlex Williamson {
1210e54f24aSAlex Williamson     VFIOConfigWindowQuirk *window = opaque;
1220e54f24aSAlex Williamson     VFIOPCIDevice *vdev = window->vdev;
1230e54f24aSAlex Williamson 
1240e54f24aSAlex Williamson     return vfio_region_read(&vdev->bars[window->bar].region,
1250e54f24aSAlex Williamson                             addr + window->address_offset, size);
1260e54f24aSAlex Williamson }
1270e54f24aSAlex Williamson 
1280e54f24aSAlex Williamson static void vfio_generic_window_quirk_address_write(void *opaque, hwaddr addr,
1290e54f24aSAlex Williamson                                                     uint64_t data,
1300e54f24aSAlex Williamson                                                     unsigned size)
1310e54f24aSAlex Williamson {
1320e54f24aSAlex Williamson     VFIOConfigWindowQuirk *window = opaque;
1330e54f24aSAlex Williamson     VFIOPCIDevice *vdev = window->vdev;
1340e54f24aSAlex Williamson     int i;
1350e54f24aSAlex Williamson 
1360e54f24aSAlex Williamson     window->window_enabled = false;
1370e54f24aSAlex Williamson 
1380e54f24aSAlex Williamson     vfio_region_write(&vdev->bars[window->bar].region,
1390e54f24aSAlex Williamson                       addr + window->address_offset, data, size);
1400e54f24aSAlex Williamson 
1410e54f24aSAlex Williamson     for (i = 0; i < window->nr_matches; i++) {
1420e54f24aSAlex Williamson         if ((data & ~window->matches[i].mask) == window->matches[i].match) {
1430e54f24aSAlex Williamson             window->window_enabled = true;
1440e54f24aSAlex Williamson             window->address_val = data & window->matches[i].mask;
1450e54f24aSAlex Williamson             trace_vfio_quirk_generic_window_address_write(vdev->vbasedev.name,
1460e54f24aSAlex Williamson                                     memory_region_name(window->addr_mem), data);
1470e54f24aSAlex Williamson             break;
1480e54f24aSAlex Williamson         }
1490e54f24aSAlex Williamson     }
1500e54f24aSAlex Williamson }
1510e54f24aSAlex Williamson 
1520e54f24aSAlex Williamson static const MemoryRegionOps vfio_generic_window_address_quirk = {
1530e54f24aSAlex Williamson     .read = vfio_generic_window_quirk_address_read,
1540e54f24aSAlex Williamson     .write = vfio_generic_window_quirk_address_write,
1550e54f24aSAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
1560e54f24aSAlex Williamson };
1570e54f24aSAlex Williamson 
1580e54f24aSAlex Williamson static uint64_t vfio_generic_window_quirk_data_read(void *opaque,
1590e54f24aSAlex Williamson                                                     hwaddr addr, unsigned size)
1600e54f24aSAlex Williamson {
1610e54f24aSAlex Williamson     VFIOConfigWindowQuirk *window = opaque;
1620e54f24aSAlex Williamson     VFIOPCIDevice *vdev = window->vdev;
1630e54f24aSAlex Williamson     uint64_t data;
1640e54f24aSAlex Williamson 
1650e54f24aSAlex Williamson     /* Always read data reg, discard if window enabled */
1660e54f24aSAlex Williamson     data = vfio_region_read(&vdev->bars[window->bar].region,
1670e54f24aSAlex Williamson                             addr + window->data_offset, size);
1680e54f24aSAlex Williamson 
1690e54f24aSAlex Williamson     if (window->window_enabled) {
1700e54f24aSAlex Williamson         data = vfio_pci_read_config(&vdev->pdev, window->address_val, size);
1710e54f24aSAlex Williamson         trace_vfio_quirk_generic_window_data_read(vdev->vbasedev.name,
1720e54f24aSAlex Williamson                                     memory_region_name(window->data_mem), data);
1730e54f24aSAlex Williamson     }
1740e54f24aSAlex Williamson 
1750e54f24aSAlex Williamson     return data;
1760e54f24aSAlex Williamson }
1770e54f24aSAlex Williamson 
1780e54f24aSAlex Williamson static void vfio_generic_window_quirk_data_write(void *opaque, hwaddr addr,
1790e54f24aSAlex Williamson                                                  uint64_t data, unsigned size)
1800e54f24aSAlex Williamson {
1810e54f24aSAlex Williamson     VFIOConfigWindowQuirk *window = opaque;
1820e54f24aSAlex Williamson     VFIOPCIDevice *vdev = window->vdev;
1830e54f24aSAlex Williamson 
1840e54f24aSAlex Williamson     if (window->window_enabled) {
1850e54f24aSAlex Williamson         vfio_pci_write_config(&vdev->pdev, window->address_val, data, size);
1860e54f24aSAlex Williamson         trace_vfio_quirk_generic_window_data_write(vdev->vbasedev.name,
1870e54f24aSAlex Williamson                                     memory_region_name(window->data_mem), data);
1880e54f24aSAlex Williamson         return;
1890e54f24aSAlex Williamson     }
1900e54f24aSAlex Williamson 
1910e54f24aSAlex Williamson     vfio_region_write(&vdev->bars[window->bar].region,
1920e54f24aSAlex Williamson                       addr + window->data_offset, data, size);
1930e54f24aSAlex Williamson }
1940e54f24aSAlex Williamson 
1950e54f24aSAlex Williamson static const MemoryRegionOps vfio_generic_window_data_quirk = {
1960e54f24aSAlex Williamson     .read = vfio_generic_window_quirk_data_read,
1970e54f24aSAlex Williamson     .write = vfio_generic_window_quirk_data_write,
1980e54f24aSAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
1990e54f24aSAlex Williamson };
2000e54f24aSAlex Williamson 
2010d38fb1cSAlex Williamson /*
2020d38fb1cSAlex Williamson  * The generic mirror quirk handles devices which expose PCI config space
2030d38fb1cSAlex Williamson  * through a region within a BAR.  When enabled, reads and writes are
2040d38fb1cSAlex Williamson  * redirected through to emulated PCI config space.  XXX if PCI config space
2050d38fb1cSAlex Williamson  * used memory regions, this could just be an alias.
2060d38fb1cSAlex Williamson  */
2070d38fb1cSAlex Williamson typedef struct VFIOConfigMirrorQuirk {
2080d38fb1cSAlex Williamson     struct VFIOPCIDevice *vdev;
2090d38fb1cSAlex Williamson     uint32_t offset;
2100d38fb1cSAlex Williamson     uint8_t bar;
2110d38fb1cSAlex Williamson     MemoryRegion *mem;
212c958c51dSAlex Williamson     uint8_t data[];
2130d38fb1cSAlex Williamson } VFIOConfigMirrorQuirk;
2140d38fb1cSAlex Williamson 
2150d38fb1cSAlex Williamson static uint64_t vfio_generic_quirk_mirror_read(void *opaque,
2160d38fb1cSAlex Williamson                                                hwaddr addr, unsigned size)
2170d38fb1cSAlex Williamson {
2180d38fb1cSAlex Williamson     VFIOConfigMirrorQuirk *mirror = opaque;
2190d38fb1cSAlex Williamson     VFIOPCIDevice *vdev = mirror->vdev;
2200d38fb1cSAlex Williamson     uint64_t data;
2210d38fb1cSAlex Williamson 
2220d38fb1cSAlex Williamson     /* Read and discard in case the hardware cares */
2230d38fb1cSAlex Williamson     (void)vfio_region_read(&vdev->bars[mirror->bar].region,
2240d38fb1cSAlex Williamson                            addr + mirror->offset, size);
2250d38fb1cSAlex Williamson 
2260d38fb1cSAlex Williamson     data = vfio_pci_read_config(&vdev->pdev, addr, size);
2270d38fb1cSAlex Williamson     trace_vfio_quirk_generic_mirror_read(vdev->vbasedev.name,
2280d38fb1cSAlex Williamson                                          memory_region_name(mirror->mem),
2290d38fb1cSAlex Williamson                                          addr, data);
2300d38fb1cSAlex Williamson     return data;
2310d38fb1cSAlex Williamson }
2320d38fb1cSAlex Williamson 
2330d38fb1cSAlex Williamson static void vfio_generic_quirk_mirror_write(void *opaque, hwaddr addr,
2340d38fb1cSAlex Williamson                                             uint64_t data, unsigned size)
2350d38fb1cSAlex Williamson {
2360d38fb1cSAlex Williamson     VFIOConfigMirrorQuirk *mirror = opaque;
2370d38fb1cSAlex Williamson     VFIOPCIDevice *vdev = mirror->vdev;
2380d38fb1cSAlex Williamson 
2390d38fb1cSAlex Williamson     vfio_pci_write_config(&vdev->pdev, addr, data, size);
2400d38fb1cSAlex Williamson     trace_vfio_quirk_generic_mirror_write(vdev->vbasedev.name,
2410d38fb1cSAlex Williamson                                           memory_region_name(mirror->mem),
2420d38fb1cSAlex Williamson                                           addr, data);
2430d38fb1cSAlex Williamson }
2440d38fb1cSAlex Williamson 
2450d38fb1cSAlex Williamson static const MemoryRegionOps vfio_generic_mirror_quirk = {
2460d38fb1cSAlex Williamson     .read = vfio_generic_quirk_mirror_read,
2470d38fb1cSAlex Williamson     .write = vfio_generic_quirk_mirror_write,
2480d38fb1cSAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
2490d38fb1cSAlex Williamson };
2500d38fb1cSAlex Williamson 
251c00d61d8SAlex Williamson /* Is range1 fully contained within range2?  */
252c00d61d8SAlex Williamson static bool vfio_range_contained(uint64_t first1, uint64_t len1,
253c00d61d8SAlex Williamson                                  uint64_t first2, uint64_t len2) {
254c00d61d8SAlex Williamson     return (first1 >= first2 && first1 + len1 <= first2 + len2);
255c00d61d8SAlex Williamson }
256c00d61d8SAlex Williamson 
257c00d61d8SAlex Williamson #define PCI_VENDOR_ID_ATI               0x1002
258c00d61d8SAlex Williamson 
259c00d61d8SAlex Williamson /*
260c00d61d8SAlex Williamson  * Radeon HD cards (HD5450 & HD7850) report the upper byte of the I/O port BAR
261c00d61d8SAlex Williamson  * through VGA register 0x3c3.  On newer cards, the I/O port BAR is always
262c00d61d8SAlex Williamson  * BAR4 (older cards like the X550 used BAR1, but we don't care to support
263c00d61d8SAlex Williamson  * those).  Note that on bare metal, a read of 0x3c3 doesn't always return the
264c00d61d8SAlex Williamson  * I/O port BAR address.  Originally this was coded to return the virtual BAR
265c00d61d8SAlex Williamson  * address only if the physical register read returns the actual BAR address,
266c00d61d8SAlex Williamson  * but users have reported greater success if we return the virtual address
267c00d61d8SAlex Williamson  * unconditionally.
268c00d61d8SAlex Williamson  */
269c00d61d8SAlex Williamson static uint64_t vfio_ati_3c3_quirk_read(void *opaque,
270c00d61d8SAlex Williamson                                         hwaddr addr, unsigned size)
271c00d61d8SAlex Williamson {
272b946d286SAlex Williamson     VFIOPCIDevice *vdev = opaque;
273c00d61d8SAlex Williamson     uint64_t data = vfio_pci_read_config(&vdev->pdev,
274b946d286SAlex Williamson                                          PCI_BASE_ADDRESS_4 + 1, size);
275b946d286SAlex Williamson 
276b946d286SAlex Williamson     trace_vfio_quirk_ati_3c3_read(vdev->vbasedev.name, data);
277c00d61d8SAlex Williamson 
278c00d61d8SAlex Williamson     return data;
279c00d61d8SAlex Williamson }
280c00d61d8SAlex Williamson 
281c00d61d8SAlex Williamson static const MemoryRegionOps vfio_ati_3c3_quirk = {
282c00d61d8SAlex Williamson     .read = vfio_ati_3c3_quirk_read,
283c00d61d8SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
284c00d61d8SAlex Williamson };
285c00d61d8SAlex Williamson 
286bcf3c3d0SAlex Williamson static VFIOQuirk *vfio_quirk_alloc(int nr_mem)
287bcf3c3d0SAlex Williamson {
288bcf3c3d0SAlex Williamson     VFIOQuirk *quirk = g_new0(VFIOQuirk, 1);
289c958c51dSAlex Williamson     QLIST_INIT(&quirk->ioeventfds);
290bcf3c3d0SAlex Williamson     quirk->mem = g_new0(MemoryRegion, nr_mem);
291bcf3c3d0SAlex Williamson     quirk->nr_mem = nr_mem;
292bcf3c3d0SAlex Williamson 
293bcf3c3d0SAlex Williamson     return quirk;
294bcf3c3d0SAlex Williamson }
295bcf3c3d0SAlex Williamson 
2962b1dbd0dSAlex Williamson static void vfio_ioeventfd_exit(VFIOPCIDevice *vdev, VFIOIOEventFD *ioeventfd)
297c958c51dSAlex Williamson {
298c958c51dSAlex Williamson     QLIST_REMOVE(ioeventfd, next);
299c958c51dSAlex Williamson     memory_region_del_eventfd(ioeventfd->mr, ioeventfd->addr, ioeventfd->size,
300c958c51dSAlex Williamson                               true, ioeventfd->data, &ioeventfd->e);
3012b1dbd0dSAlex Williamson 
3022b1dbd0dSAlex Williamson     if (ioeventfd->vfio) {
3032b1dbd0dSAlex Williamson         struct vfio_device_ioeventfd vfio_ioeventfd;
3042b1dbd0dSAlex Williamson 
3052b1dbd0dSAlex Williamson         vfio_ioeventfd.argsz = sizeof(vfio_ioeventfd);
3062b1dbd0dSAlex Williamson         vfio_ioeventfd.flags = ioeventfd->size;
3072b1dbd0dSAlex Williamson         vfio_ioeventfd.data = ioeventfd->data;
3082b1dbd0dSAlex Williamson         vfio_ioeventfd.offset = ioeventfd->region->fd_offset +
3092b1dbd0dSAlex Williamson                                 ioeventfd->region_addr;
3102b1dbd0dSAlex Williamson         vfio_ioeventfd.fd = -1;
3112b1dbd0dSAlex Williamson 
3122b1dbd0dSAlex Williamson         if (ioctl(vdev->vbasedev.fd, VFIO_DEVICE_IOEVENTFD, &vfio_ioeventfd)) {
3132b1dbd0dSAlex Williamson             error_report("Failed to remove vfio ioeventfd for %s+0x%"
3142b1dbd0dSAlex Williamson                          HWADDR_PRIx"[%d]:0x%"PRIx64" (%m)",
3152b1dbd0dSAlex Williamson                          memory_region_name(ioeventfd->mr), ioeventfd->addr,
3162b1dbd0dSAlex Williamson                          ioeventfd->size, ioeventfd->data);
3172b1dbd0dSAlex Williamson         }
3182b1dbd0dSAlex Williamson     } else {
3192b1dbd0dSAlex Williamson         qemu_set_fd_handler(event_notifier_get_fd(&ioeventfd->e),
3202b1dbd0dSAlex Williamson                             NULL, NULL, NULL);
3212b1dbd0dSAlex Williamson     }
3222b1dbd0dSAlex Williamson 
323c958c51dSAlex Williamson     event_notifier_cleanup(&ioeventfd->e);
324c958c51dSAlex Williamson     trace_vfio_ioeventfd_exit(memory_region_name(ioeventfd->mr),
325c958c51dSAlex Williamson                               (uint64_t)ioeventfd->addr, ioeventfd->size,
326c958c51dSAlex Williamson                               ioeventfd->data);
327c958c51dSAlex Williamson     g_free(ioeventfd);
328c958c51dSAlex Williamson }
329c958c51dSAlex Williamson 
330c958c51dSAlex Williamson static void vfio_drop_dynamic_eventfds(VFIOPCIDevice *vdev, VFIOQuirk *quirk)
331c958c51dSAlex Williamson {
332c958c51dSAlex Williamson     VFIOIOEventFD *ioeventfd, *tmp;
333c958c51dSAlex Williamson 
334c958c51dSAlex Williamson     QLIST_FOREACH_SAFE(ioeventfd, &quirk->ioeventfds, next, tmp) {
335c958c51dSAlex Williamson         if (ioeventfd->dynamic) {
3362b1dbd0dSAlex Williamson             vfio_ioeventfd_exit(vdev, ioeventfd);
337c958c51dSAlex Williamson         }
338c958c51dSAlex Williamson     }
339c958c51dSAlex Williamson }
340c958c51dSAlex Williamson 
341c958c51dSAlex Williamson static void vfio_ioeventfd_handler(void *opaque)
342c958c51dSAlex Williamson {
343c958c51dSAlex Williamson     VFIOIOEventFD *ioeventfd = opaque;
344c958c51dSAlex Williamson 
345c958c51dSAlex Williamson     if (event_notifier_test_and_clear(&ioeventfd->e)) {
346c958c51dSAlex Williamson         vfio_region_write(ioeventfd->region, ioeventfd->region_addr,
347c958c51dSAlex Williamson                           ioeventfd->data, ioeventfd->size);
348c958c51dSAlex Williamson         trace_vfio_ioeventfd_handler(memory_region_name(ioeventfd->mr),
349c958c51dSAlex Williamson                                      (uint64_t)ioeventfd->addr, ioeventfd->size,
350c958c51dSAlex Williamson                                      ioeventfd->data);
351c958c51dSAlex Williamson     }
352c958c51dSAlex Williamson }
353c958c51dSAlex Williamson 
354c958c51dSAlex Williamson static VFIOIOEventFD *vfio_ioeventfd_init(VFIOPCIDevice *vdev,
355c958c51dSAlex Williamson                                           MemoryRegion *mr, hwaddr addr,
356c958c51dSAlex Williamson                                           unsigned size, uint64_t data,
357c958c51dSAlex Williamson                                           VFIORegion *region,
358c958c51dSAlex Williamson                                           hwaddr region_addr, bool dynamic)
359c958c51dSAlex Williamson {
360c958c51dSAlex Williamson     VFIOIOEventFD *ioeventfd;
361c958c51dSAlex Williamson 
362c958c51dSAlex Williamson     if (vdev->no_kvm_ioeventfd) {
363c958c51dSAlex Williamson         return NULL;
364c958c51dSAlex Williamson     }
365c958c51dSAlex Williamson 
366c958c51dSAlex Williamson     ioeventfd = g_malloc0(sizeof(*ioeventfd));
367c958c51dSAlex Williamson 
368c958c51dSAlex Williamson     if (event_notifier_init(&ioeventfd->e, 0)) {
369c958c51dSAlex Williamson         g_free(ioeventfd);
370c958c51dSAlex Williamson         return NULL;
371c958c51dSAlex Williamson     }
372c958c51dSAlex Williamson 
373c958c51dSAlex Williamson     /*
374c958c51dSAlex Williamson      * MemoryRegion and relative offset, plus additional ioeventfd setup
375c958c51dSAlex Williamson      * parameters for configuring and later tearing down KVM ioeventfd.
376c958c51dSAlex Williamson      */
377c958c51dSAlex Williamson     ioeventfd->mr = mr;
378c958c51dSAlex Williamson     ioeventfd->addr = addr;
379c958c51dSAlex Williamson     ioeventfd->size = size;
380c958c51dSAlex Williamson     ioeventfd->data = data;
381c958c51dSAlex Williamson     ioeventfd->dynamic = dynamic;
382c958c51dSAlex Williamson     /*
383c958c51dSAlex Williamson      * VFIORegion and relative offset for implementing the userspace
384c958c51dSAlex Williamson      * handler.  data & size fields shared for both uses.
385c958c51dSAlex Williamson      */
386c958c51dSAlex Williamson     ioeventfd->region = region;
387c958c51dSAlex Williamson     ioeventfd->region_addr = region_addr;
388c958c51dSAlex Williamson 
3892b1dbd0dSAlex Williamson     if (!vdev->no_vfio_ioeventfd) {
3902b1dbd0dSAlex Williamson         struct vfio_device_ioeventfd vfio_ioeventfd;
3912b1dbd0dSAlex Williamson 
3922b1dbd0dSAlex Williamson         vfio_ioeventfd.argsz = sizeof(vfio_ioeventfd);
3932b1dbd0dSAlex Williamson         vfio_ioeventfd.flags = ioeventfd->size;
3942b1dbd0dSAlex Williamson         vfio_ioeventfd.data = ioeventfd->data;
3952b1dbd0dSAlex Williamson         vfio_ioeventfd.offset = ioeventfd->region->fd_offset +
3962b1dbd0dSAlex Williamson                                 ioeventfd->region_addr;
3972b1dbd0dSAlex Williamson         vfio_ioeventfd.fd = event_notifier_get_fd(&ioeventfd->e);
3982b1dbd0dSAlex Williamson 
3992b1dbd0dSAlex Williamson         ioeventfd->vfio = !ioctl(vdev->vbasedev.fd,
4002b1dbd0dSAlex Williamson                                  VFIO_DEVICE_IOEVENTFD, &vfio_ioeventfd);
4012b1dbd0dSAlex Williamson     }
4022b1dbd0dSAlex Williamson 
4032b1dbd0dSAlex Williamson     if (!ioeventfd->vfio) {
404c958c51dSAlex Williamson         qemu_set_fd_handler(event_notifier_get_fd(&ioeventfd->e),
405c958c51dSAlex Williamson                             vfio_ioeventfd_handler, NULL, ioeventfd);
4062b1dbd0dSAlex Williamson     }
4072b1dbd0dSAlex Williamson 
408c958c51dSAlex Williamson     memory_region_add_eventfd(ioeventfd->mr, ioeventfd->addr, ioeventfd->size,
409c958c51dSAlex Williamson                               true, ioeventfd->data, &ioeventfd->e);
410c958c51dSAlex Williamson     trace_vfio_ioeventfd_init(memory_region_name(mr), (uint64_t)addr,
4112b1dbd0dSAlex Williamson                               size, data, ioeventfd->vfio);
412c958c51dSAlex Williamson 
413c958c51dSAlex Williamson     return ioeventfd;
414c958c51dSAlex Williamson }
415c958c51dSAlex Williamson 
416c00d61d8SAlex Williamson static void vfio_vga_probe_ati_3c3_quirk(VFIOPCIDevice *vdev)
417c00d61d8SAlex Williamson {
418c00d61d8SAlex Williamson     VFIOQuirk *quirk;
419c00d61d8SAlex Williamson 
420c00d61d8SAlex Williamson     /*
421c00d61d8SAlex Williamson      * As long as the BAR is >= 256 bytes it will be aligned such that the
422c00d61d8SAlex Williamson      * lower byte is always zero.  Filter out anything else, if it exists.
423c00d61d8SAlex Williamson      */
424b946d286SAlex Williamson     if (!vfio_pci_is(vdev, PCI_VENDOR_ID_ATI, PCI_ANY_ID) ||
425b946d286SAlex Williamson         !vdev->bars[4].ioport || vdev->bars[4].region.size < 256) {
426c00d61d8SAlex Williamson         return;
427c00d61d8SAlex Williamson     }
428c00d61d8SAlex Williamson 
429bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(1);
430c00d61d8SAlex Williamson 
431b946d286SAlex Williamson     memory_region_init_io(quirk->mem, OBJECT(vdev), &vfio_ati_3c3_quirk, vdev,
432c00d61d8SAlex Williamson                           "vfio-ati-3c3-quirk", 1);
4332d82f8a3SAlex Williamson     memory_region_add_subregion(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].mem,
4348c4f2348SAlex Williamson                                 3 /* offset 3 bytes from 0x3c0 */, quirk->mem);
435c00d61d8SAlex Williamson 
4362d82f8a3SAlex Williamson     QLIST_INSERT_HEAD(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].quirks,
437c00d61d8SAlex Williamson                       quirk, next);
438c00d61d8SAlex Williamson 
439b946d286SAlex Williamson     trace_vfio_quirk_ati_3c3_probe(vdev->vbasedev.name);
440c00d61d8SAlex Williamson }
441c00d61d8SAlex Williamson 
442c00d61d8SAlex Williamson /*
4430e54f24aSAlex Williamson  * Newer ATI/AMD devices, including HD5450 and HD7850, have a mirror to PCI
444c00d61d8SAlex Williamson  * config space through MMIO BAR2 at offset 0x4000.  Nothing seems to access
445c00d61d8SAlex Williamson  * the MMIO space directly, but a window to this space is provided through
446c00d61d8SAlex Williamson  * I/O port BAR4.  Offset 0x0 is the address register and offset 0x4 is the
447c00d61d8SAlex Williamson  * data register.  When the address is programmed to a range of 0x4000-0x4fff
448c00d61d8SAlex Williamson  * PCI configuration space is available.  Experimentation seems to indicate
4490e54f24aSAlex Williamson  * that read-only may be provided by hardware.
450c00d61d8SAlex Williamson  */
4510e54f24aSAlex Williamson static void vfio_probe_ati_bar4_quirk(VFIOPCIDevice *vdev, int nr)
452c00d61d8SAlex Williamson {
453c00d61d8SAlex Williamson     VFIOQuirk *quirk;
4540e54f24aSAlex Williamson     VFIOConfigWindowQuirk *window;
455c00d61d8SAlex Williamson 
4560e54f24aSAlex Williamson     /* This windows doesn't seem to be used except by legacy VGA code */
4570e54f24aSAlex Williamson     if (!vfio_pci_is(vdev, PCI_VENDOR_ID_ATI, PCI_ANY_ID) ||
4584d3fc4fdSAlex Williamson         !vdev->vga || nr != 4) {
459c00d61d8SAlex Williamson         return;
460c00d61d8SAlex Williamson     }
461c00d61d8SAlex Williamson 
462bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(2);
4630e54f24aSAlex Williamson     window = quirk->data = g_malloc0(sizeof(*window) +
4640e54f24aSAlex Williamson                                      sizeof(VFIOConfigWindowMatch));
4650e54f24aSAlex Williamson     window->vdev = vdev;
4660e54f24aSAlex Williamson     window->address_offset = 0;
4670e54f24aSAlex Williamson     window->data_offset = 4;
4680e54f24aSAlex Williamson     window->nr_matches = 1;
4690e54f24aSAlex Williamson     window->matches[0].match = 0x4000;
470f5793fd9SAlex Williamson     window->matches[0].mask = vdev->config_size - 1;
4710e54f24aSAlex Williamson     window->bar = nr;
4720e54f24aSAlex Williamson     window->addr_mem = &quirk->mem[0];
4730e54f24aSAlex Williamson     window->data_mem = &quirk->mem[1];
474c00d61d8SAlex Williamson 
4750e54f24aSAlex Williamson     memory_region_init_io(window->addr_mem, OBJECT(vdev),
4760e54f24aSAlex Williamson                           &vfio_generic_window_address_quirk, window,
4770e54f24aSAlex Williamson                           "vfio-ati-bar4-window-address-quirk", 4);
478db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
4790e54f24aSAlex Williamson                                         window->address_offset,
4800e54f24aSAlex Williamson                                         window->addr_mem, 1);
4810e54f24aSAlex Williamson 
4820e54f24aSAlex Williamson     memory_region_init_io(window->data_mem, OBJECT(vdev),
4830e54f24aSAlex Williamson                           &vfio_generic_window_data_quirk, window,
4840e54f24aSAlex Williamson                           "vfio-ati-bar4-window-data-quirk", 4);
485db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
4860e54f24aSAlex Williamson                                         window->data_offset,
4870e54f24aSAlex Williamson                                         window->data_mem, 1);
488c00d61d8SAlex Williamson 
489c00d61d8SAlex Williamson     QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
490c00d61d8SAlex Williamson 
4910e54f24aSAlex Williamson     trace_vfio_quirk_ati_bar4_probe(vdev->vbasedev.name);
492c00d61d8SAlex Williamson }
493c00d61d8SAlex Williamson 
494c00d61d8SAlex Williamson /*
4950d38fb1cSAlex Williamson  * Trap the BAR2 MMIO mirror to config space as well.
496c00d61d8SAlex Williamson  */
4970d38fb1cSAlex Williamson static void vfio_probe_ati_bar2_quirk(VFIOPCIDevice *vdev, int nr)
498c00d61d8SAlex Williamson {
499c00d61d8SAlex Williamson     VFIOQuirk *quirk;
5000d38fb1cSAlex Williamson     VFIOConfigMirrorQuirk *mirror;
501c00d61d8SAlex Williamson 
502c00d61d8SAlex Williamson     /* Only enable on newer devices where BAR2 is 64bit */
5030d38fb1cSAlex Williamson     if (!vfio_pci_is(vdev, PCI_VENDOR_ID_ATI, PCI_ANY_ID) ||
5044d3fc4fdSAlex Williamson         !vdev->vga || nr != 2 || !vdev->bars[2].mem64) {
505c00d61d8SAlex Williamson         return;
506c00d61d8SAlex Williamson     }
507c00d61d8SAlex Williamson 
508bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(1);
5090d38fb1cSAlex Williamson     mirror = quirk->data = g_malloc0(sizeof(*mirror));
510bcf3c3d0SAlex Williamson     mirror->mem = quirk->mem;
5110d38fb1cSAlex Williamson     mirror->vdev = vdev;
5120d38fb1cSAlex Williamson     mirror->offset = 0x4000;
5130d38fb1cSAlex Williamson     mirror->bar = nr;
514c00d61d8SAlex Williamson 
5150d38fb1cSAlex Williamson     memory_region_init_io(mirror->mem, OBJECT(vdev),
5160d38fb1cSAlex Williamson                           &vfio_generic_mirror_quirk, mirror,
5170d38fb1cSAlex Williamson                           "vfio-ati-bar2-4000-quirk", PCI_CONFIG_SPACE_SIZE);
518db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
5190d38fb1cSAlex Williamson                                         mirror->offset, mirror->mem, 1);
520c00d61d8SAlex Williamson 
521c00d61d8SAlex Williamson     QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
522c00d61d8SAlex Williamson 
5230d38fb1cSAlex Williamson     trace_vfio_quirk_ati_bar2_probe(vdev->vbasedev.name);
524c00d61d8SAlex Williamson }
525c00d61d8SAlex Williamson 
526c00d61d8SAlex Williamson /*
527c00d61d8SAlex Williamson  * Older ATI/AMD cards like the X550 have a similar window to that above.
528c00d61d8SAlex Williamson  * I/O port BAR1 provides a window to a mirror of PCI config space located
529c00d61d8SAlex Williamson  * in BAR2 at offset 0xf00.  We don't care to support such older cards, but
530c00d61d8SAlex Williamson  * note it for future reference.
531c00d61d8SAlex Williamson  */
532c00d61d8SAlex Williamson 
533c00d61d8SAlex Williamson /*
534c00d61d8SAlex Williamson  * Nvidia has several different methods to get to config space, the
535c00d61d8SAlex Williamson  * nouveu project has several of these documented here:
536c00d61d8SAlex Williamson  * https://github.com/pathscale/envytools/tree/master/hwdocs
537c00d61d8SAlex Williamson  *
538c00d61d8SAlex Williamson  * The first quirk is actually not documented in envytools and is found
539c00d61d8SAlex Williamson  * on 10de:01d1 (NVIDIA Corporation G72 [GeForce 7300 LE]).  This is an
540c00d61d8SAlex Williamson  * NV46 chipset.  The backdoor uses the legacy VGA I/O ports to access
541c00d61d8SAlex Williamson  * the mirror of PCI config space found at BAR0 offset 0x1800.  The access
542c00d61d8SAlex Williamson  * sequence first writes 0x338 to I/O port 0x3d4.  The target offset is
543c00d61d8SAlex Williamson  * then written to 0x3d0.  Finally 0x538 is written for a read and 0x738
544c00d61d8SAlex Williamson  * is written for a write to 0x3d4.  The BAR0 offset is then accessible
545c00d61d8SAlex Williamson  * through 0x3d0.  This quirk doesn't seem to be necessary on newer cards
546c00d61d8SAlex Williamson  * that use the I/O port BAR5 window but it doesn't hurt to leave it.
547c00d61d8SAlex Williamson  */
5486029a424SAlex Williamson typedef enum {NONE = 0, SELECT, WINDOW, READ, WRITE} VFIONvidia3d0State;
5496029a424SAlex Williamson static const char *nv3d0_states[] = { "NONE", "SELECT",
5506029a424SAlex Williamson                                       "WINDOW", "READ", "WRITE" };
5516029a424SAlex Williamson 
5526029a424SAlex Williamson typedef struct VFIONvidia3d0Quirk {
5536029a424SAlex Williamson     VFIOPCIDevice *vdev;
5546029a424SAlex Williamson     VFIONvidia3d0State state;
5556029a424SAlex Williamson     uint32_t offset;
5566029a424SAlex Williamson } VFIONvidia3d0Quirk;
5576029a424SAlex Williamson 
5586029a424SAlex Williamson static uint64_t vfio_nvidia_3d4_quirk_read(void *opaque,
5596029a424SAlex Williamson                                            hwaddr addr, unsigned size)
5606029a424SAlex Williamson {
5616029a424SAlex Williamson     VFIONvidia3d0Quirk *quirk = opaque;
5626029a424SAlex Williamson     VFIOPCIDevice *vdev = quirk->vdev;
5636029a424SAlex Williamson 
5646029a424SAlex Williamson     quirk->state = NONE;
5656029a424SAlex Williamson 
5662d82f8a3SAlex Williamson     return vfio_vga_read(&vdev->vga->region[QEMU_PCI_VGA_IO_HI],
5676029a424SAlex Williamson                          addr + 0x14, size);
5686029a424SAlex Williamson }
5696029a424SAlex Williamson 
5706029a424SAlex Williamson static void vfio_nvidia_3d4_quirk_write(void *opaque, hwaddr addr,
5716029a424SAlex Williamson                                         uint64_t data, unsigned size)
5726029a424SAlex Williamson {
5736029a424SAlex Williamson     VFIONvidia3d0Quirk *quirk = opaque;
5746029a424SAlex Williamson     VFIOPCIDevice *vdev = quirk->vdev;
5756029a424SAlex Williamson     VFIONvidia3d0State old_state = quirk->state;
5766029a424SAlex Williamson 
5776029a424SAlex Williamson     quirk->state = NONE;
5786029a424SAlex Williamson 
5796029a424SAlex Williamson     switch (data) {
5806029a424SAlex Williamson     case 0x338:
5816029a424SAlex Williamson         if (old_state == NONE) {
5826029a424SAlex Williamson             quirk->state = SELECT;
5836029a424SAlex Williamson             trace_vfio_quirk_nvidia_3d0_state(vdev->vbasedev.name,
5846029a424SAlex Williamson                                               nv3d0_states[quirk->state]);
5856029a424SAlex Williamson         }
5866029a424SAlex Williamson         break;
5876029a424SAlex Williamson     case 0x538:
5886029a424SAlex Williamson         if (old_state == WINDOW) {
5896029a424SAlex Williamson             quirk->state = READ;
5906029a424SAlex Williamson             trace_vfio_quirk_nvidia_3d0_state(vdev->vbasedev.name,
5916029a424SAlex Williamson                                               nv3d0_states[quirk->state]);
5926029a424SAlex Williamson         }
5936029a424SAlex Williamson         break;
5946029a424SAlex Williamson     case 0x738:
5956029a424SAlex Williamson         if (old_state == WINDOW) {
5966029a424SAlex Williamson             quirk->state = WRITE;
5976029a424SAlex Williamson             trace_vfio_quirk_nvidia_3d0_state(vdev->vbasedev.name,
5986029a424SAlex Williamson                                               nv3d0_states[quirk->state]);
5996029a424SAlex Williamson         }
6006029a424SAlex Williamson         break;
6016029a424SAlex Williamson     }
6026029a424SAlex Williamson 
6032d82f8a3SAlex Williamson     vfio_vga_write(&vdev->vga->region[QEMU_PCI_VGA_IO_HI],
6046029a424SAlex Williamson                    addr + 0x14, data, size);
6056029a424SAlex Williamson }
6066029a424SAlex Williamson 
6076029a424SAlex Williamson static const MemoryRegionOps vfio_nvidia_3d4_quirk = {
6086029a424SAlex Williamson     .read = vfio_nvidia_3d4_quirk_read,
6096029a424SAlex Williamson     .write = vfio_nvidia_3d4_quirk_write,
6106029a424SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
611c00d61d8SAlex Williamson };
612c00d61d8SAlex Williamson 
613c00d61d8SAlex Williamson static uint64_t vfio_nvidia_3d0_quirk_read(void *opaque,
614c00d61d8SAlex Williamson                                            hwaddr addr, unsigned size)
615c00d61d8SAlex Williamson {
6166029a424SAlex Williamson     VFIONvidia3d0Quirk *quirk = opaque;
617c00d61d8SAlex Williamson     VFIOPCIDevice *vdev = quirk->vdev;
6186029a424SAlex Williamson     VFIONvidia3d0State old_state = quirk->state;
6192d82f8a3SAlex Williamson     uint64_t data = vfio_vga_read(&vdev->vga->region[QEMU_PCI_VGA_IO_HI],
6206029a424SAlex Williamson                                   addr + 0x10, size);
621c00d61d8SAlex Williamson 
6226029a424SAlex Williamson     quirk->state = NONE;
6236029a424SAlex Williamson 
6246029a424SAlex Williamson     if (old_state == READ &&
6256029a424SAlex Williamson         (quirk->offset & ~(PCI_CONFIG_SPACE_SIZE - 1)) == 0x1800) {
6266029a424SAlex Williamson         uint8_t offset = quirk->offset & (PCI_CONFIG_SPACE_SIZE - 1);
6276029a424SAlex Williamson 
6286029a424SAlex Williamson         data = vfio_pci_read_config(&vdev->pdev, offset, size);
6296029a424SAlex Williamson         trace_vfio_quirk_nvidia_3d0_read(vdev->vbasedev.name,
6306029a424SAlex Williamson                                          offset, size, data);
631c00d61d8SAlex Williamson     }
632c00d61d8SAlex Williamson 
633c00d61d8SAlex Williamson     return data;
634c00d61d8SAlex Williamson }
635c00d61d8SAlex Williamson 
636c00d61d8SAlex Williamson static void vfio_nvidia_3d0_quirk_write(void *opaque, hwaddr addr,
637c00d61d8SAlex Williamson                                         uint64_t data, unsigned size)
638c00d61d8SAlex Williamson {
6396029a424SAlex Williamson     VFIONvidia3d0Quirk *quirk = opaque;
640c00d61d8SAlex Williamson     VFIOPCIDevice *vdev = quirk->vdev;
6416029a424SAlex Williamson     VFIONvidia3d0State old_state = quirk->state;
642c00d61d8SAlex Williamson 
6436029a424SAlex Williamson     quirk->state = NONE;
6446029a424SAlex Williamson 
6456029a424SAlex Williamson     if (old_state == SELECT) {
6466029a424SAlex Williamson         quirk->offset = (uint32_t)data;
6476029a424SAlex Williamson         quirk->state = WINDOW;
6486029a424SAlex Williamson         trace_vfio_quirk_nvidia_3d0_state(vdev->vbasedev.name,
6496029a424SAlex Williamson                                           nv3d0_states[quirk->state]);
6506029a424SAlex Williamson     } else if (old_state == WRITE) {
6516029a424SAlex Williamson         if ((quirk->offset & ~(PCI_CONFIG_SPACE_SIZE - 1)) == 0x1800) {
6526029a424SAlex Williamson             uint8_t offset = quirk->offset & (PCI_CONFIG_SPACE_SIZE - 1);
6536029a424SAlex Williamson 
6546029a424SAlex Williamson             vfio_pci_write_config(&vdev->pdev, offset, data, size);
6556029a424SAlex Williamson             trace_vfio_quirk_nvidia_3d0_write(vdev->vbasedev.name,
6566029a424SAlex Williamson                                               offset, data, size);
657c00d61d8SAlex Williamson             return;
658c00d61d8SAlex Williamson         }
659c00d61d8SAlex Williamson     }
660c00d61d8SAlex Williamson 
6612d82f8a3SAlex Williamson     vfio_vga_write(&vdev->vga->region[QEMU_PCI_VGA_IO_HI],
6626029a424SAlex Williamson                    addr + 0x10, data, size);
663c00d61d8SAlex Williamson }
664c00d61d8SAlex Williamson 
665c00d61d8SAlex Williamson static const MemoryRegionOps vfio_nvidia_3d0_quirk = {
666c00d61d8SAlex Williamson     .read = vfio_nvidia_3d0_quirk_read,
667c00d61d8SAlex Williamson     .write = vfio_nvidia_3d0_quirk_write,
668c00d61d8SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
669c00d61d8SAlex Williamson };
670c00d61d8SAlex Williamson 
671c00d61d8SAlex Williamson static void vfio_vga_probe_nvidia_3d0_quirk(VFIOPCIDevice *vdev)
672c00d61d8SAlex Williamson {
673c00d61d8SAlex Williamson     VFIOQuirk *quirk;
6746029a424SAlex Williamson     VFIONvidia3d0Quirk *data;
675c00d61d8SAlex Williamson 
676db32d0f4SAlex Williamson     if (vdev->no_geforce_quirks ||
677db32d0f4SAlex Williamson         !vfio_pci_is(vdev, PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID) ||
678c00d61d8SAlex Williamson         !vdev->bars[1].region.size) {
679c00d61d8SAlex Williamson         return;
680c00d61d8SAlex Williamson     }
681c00d61d8SAlex Williamson 
682bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(2);
6836029a424SAlex Williamson     quirk->data = data = g_malloc0(sizeof(*data));
6846029a424SAlex Williamson     data->vdev = vdev;
685c00d61d8SAlex Williamson 
6866029a424SAlex Williamson     memory_region_init_io(&quirk->mem[0], OBJECT(vdev), &vfio_nvidia_3d4_quirk,
6876029a424SAlex Williamson                           data, "vfio-nvidia-3d4-quirk", 2);
6882d82f8a3SAlex Williamson     memory_region_add_subregion(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].mem,
6896029a424SAlex Williamson                                 0x14 /* 0x3c0 + 0x14 */, &quirk->mem[0]);
6906029a424SAlex Williamson 
6916029a424SAlex Williamson     memory_region_init_io(&quirk->mem[1], OBJECT(vdev), &vfio_nvidia_3d0_quirk,
6926029a424SAlex Williamson                           data, "vfio-nvidia-3d0-quirk", 2);
6932d82f8a3SAlex Williamson     memory_region_add_subregion(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].mem,
6946029a424SAlex Williamson                                 0x10 /* 0x3c0 + 0x10 */, &quirk->mem[1]);
695c00d61d8SAlex Williamson 
6962d82f8a3SAlex Williamson     QLIST_INSERT_HEAD(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].quirks,
697c00d61d8SAlex Williamson                       quirk, next);
698c00d61d8SAlex Williamson 
6996029a424SAlex Williamson     trace_vfio_quirk_nvidia_3d0_probe(vdev->vbasedev.name);
700c00d61d8SAlex Williamson }
701c00d61d8SAlex Williamson 
702c00d61d8SAlex Williamson /*
703c00d61d8SAlex Williamson  * The second quirk is documented in envytools.  The I/O port BAR5 is just
704c00d61d8SAlex Williamson  * a set of address/data ports to the MMIO BARs.  The BAR we care about is
705c00d61d8SAlex Williamson  * again BAR0.  This backdoor is apparently a bit newer than the one above
706c00d61d8SAlex Williamson  * so we need to not only trap 256 bytes @0x1800, but all of PCI config
707c00d61d8SAlex Williamson  * space, including extended space is available at the 4k @0x88000.
708c00d61d8SAlex Williamson  */
7090e54f24aSAlex Williamson typedef struct VFIONvidiaBAR5Quirk {
7100e54f24aSAlex Williamson     uint32_t master;
7110e54f24aSAlex Williamson     uint32_t enable;
7120e54f24aSAlex Williamson     MemoryRegion *addr_mem;
7130e54f24aSAlex Williamson     MemoryRegion *data_mem;
7140e54f24aSAlex Williamson     bool enabled;
7150e54f24aSAlex Williamson     VFIOConfigWindowQuirk window; /* last for match data */
7160e54f24aSAlex Williamson } VFIONvidiaBAR5Quirk;
717c00d61d8SAlex Williamson 
7180e54f24aSAlex Williamson static void vfio_nvidia_bar5_enable(VFIONvidiaBAR5Quirk *bar5)
7190e54f24aSAlex Williamson {
7200e54f24aSAlex Williamson     VFIOPCIDevice *vdev = bar5->window.vdev;
7210e54f24aSAlex Williamson 
7220e54f24aSAlex Williamson     if (((bar5->master & bar5->enable) & 0x1) == bar5->enabled) {
7230e54f24aSAlex Williamson         return;
7240e54f24aSAlex Williamson     }
7250e54f24aSAlex Williamson 
7260e54f24aSAlex Williamson     bar5->enabled = !bar5->enabled;
7270e54f24aSAlex Williamson     trace_vfio_quirk_nvidia_bar5_state(vdev->vbasedev.name,
7280e54f24aSAlex Williamson                                        bar5->enabled ?  "Enable" : "Disable");
7290e54f24aSAlex Williamson     memory_region_set_enabled(bar5->addr_mem, bar5->enabled);
7300e54f24aSAlex Williamson     memory_region_set_enabled(bar5->data_mem, bar5->enabled);
7310e54f24aSAlex Williamson }
7320e54f24aSAlex Williamson 
7330e54f24aSAlex Williamson static uint64_t vfio_nvidia_bar5_quirk_master_read(void *opaque,
7340e54f24aSAlex Williamson                                                    hwaddr addr, unsigned size)
7350e54f24aSAlex Williamson {
7360e54f24aSAlex Williamson     VFIONvidiaBAR5Quirk *bar5 = opaque;
7370e54f24aSAlex Williamson     VFIOPCIDevice *vdev = bar5->window.vdev;
7380e54f24aSAlex Williamson 
7390e54f24aSAlex Williamson     return vfio_region_read(&vdev->bars[5].region, addr, size);
7400e54f24aSAlex Williamson }
7410e54f24aSAlex Williamson 
7420e54f24aSAlex Williamson static void vfio_nvidia_bar5_quirk_master_write(void *opaque, hwaddr addr,
743c00d61d8SAlex Williamson                                                 uint64_t data, unsigned size)
744c00d61d8SAlex Williamson {
7450e54f24aSAlex Williamson     VFIONvidiaBAR5Quirk *bar5 = opaque;
7460e54f24aSAlex Williamson     VFIOPCIDevice *vdev = bar5->window.vdev;
747c00d61d8SAlex Williamson 
7480e54f24aSAlex Williamson     vfio_region_write(&vdev->bars[5].region, addr, data, size);
7490e54f24aSAlex Williamson 
7500e54f24aSAlex Williamson     bar5->master = data;
7510e54f24aSAlex Williamson     vfio_nvidia_bar5_enable(bar5);
752c00d61d8SAlex Williamson }
753c00d61d8SAlex Williamson 
7540e54f24aSAlex Williamson static const MemoryRegionOps vfio_nvidia_bar5_quirk_master = {
7550e54f24aSAlex Williamson     .read = vfio_nvidia_bar5_quirk_master_read,
7560e54f24aSAlex Williamson     .write = vfio_nvidia_bar5_quirk_master_write,
757c00d61d8SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
758c00d61d8SAlex Williamson };
759c00d61d8SAlex Williamson 
7600e54f24aSAlex Williamson static uint64_t vfio_nvidia_bar5_quirk_enable_read(void *opaque,
7610e54f24aSAlex Williamson                                                    hwaddr addr, unsigned size)
762c00d61d8SAlex Williamson {
7630e54f24aSAlex Williamson     VFIONvidiaBAR5Quirk *bar5 = opaque;
7640e54f24aSAlex Williamson     VFIOPCIDevice *vdev = bar5->window.vdev;
765c00d61d8SAlex Williamson 
7660e54f24aSAlex Williamson     return vfio_region_read(&vdev->bars[5].region, addr + 4, size);
7670e54f24aSAlex Williamson }
7680e54f24aSAlex Williamson 
7690e54f24aSAlex Williamson static void vfio_nvidia_bar5_quirk_enable_write(void *opaque, hwaddr addr,
7700e54f24aSAlex Williamson                                                 uint64_t data, unsigned size)
7710e54f24aSAlex Williamson {
7720e54f24aSAlex Williamson     VFIONvidiaBAR5Quirk *bar5 = opaque;
7730e54f24aSAlex Williamson     VFIOPCIDevice *vdev = bar5->window.vdev;
7740e54f24aSAlex Williamson 
7750e54f24aSAlex Williamson     vfio_region_write(&vdev->bars[5].region, addr + 4, data, size);
7760e54f24aSAlex Williamson 
7770e54f24aSAlex Williamson     bar5->enable = data;
7780e54f24aSAlex Williamson     vfio_nvidia_bar5_enable(bar5);
7790e54f24aSAlex Williamson }
7800e54f24aSAlex Williamson 
7810e54f24aSAlex Williamson static const MemoryRegionOps vfio_nvidia_bar5_quirk_enable = {
7820e54f24aSAlex Williamson     .read = vfio_nvidia_bar5_quirk_enable_read,
7830e54f24aSAlex Williamson     .write = vfio_nvidia_bar5_quirk_enable_write,
7840e54f24aSAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
7850e54f24aSAlex Williamson };
7860e54f24aSAlex Williamson 
7870e54f24aSAlex Williamson static void vfio_probe_nvidia_bar5_quirk(VFIOPCIDevice *vdev, int nr)
7880e54f24aSAlex Williamson {
7890e54f24aSAlex Williamson     VFIOQuirk *quirk;
7900e54f24aSAlex Williamson     VFIONvidiaBAR5Quirk *bar5;
7910e54f24aSAlex Williamson     VFIOConfigWindowQuirk *window;
7920e54f24aSAlex Williamson 
793db32d0f4SAlex Williamson     if (vdev->no_geforce_quirks ||
794db32d0f4SAlex Williamson         !vfio_pci_is(vdev, PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID) ||
7958f419c5bSAlex Williamson         !vdev->vga || nr != 5 || !vdev->bars[5].ioport) {
796c00d61d8SAlex Williamson         return;
797c00d61d8SAlex Williamson     }
798c00d61d8SAlex Williamson 
799bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(4);
8000e54f24aSAlex Williamson     bar5 = quirk->data = g_malloc0(sizeof(*bar5) +
8010e54f24aSAlex Williamson                                    (sizeof(VFIOConfigWindowMatch) * 2));
8020e54f24aSAlex Williamson     window = &bar5->window;
803c00d61d8SAlex Williamson 
8040e54f24aSAlex Williamson     window->vdev = vdev;
8050e54f24aSAlex Williamson     window->address_offset = 0x8;
8060e54f24aSAlex Williamson     window->data_offset = 0xc;
8070e54f24aSAlex Williamson     window->nr_matches = 2;
8080e54f24aSAlex Williamson     window->matches[0].match = 0x1800;
8090e54f24aSAlex Williamson     window->matches[0].mask = PCI_CONFIG_SPACE_SIZE - 1;
8100e54f24aSAlex Williamson     window->matches[1].match = 0x88000;
811f5793fd9SAlex Williamson     window->matches[1].mask = vdev->config_size - 1;
8120e54f24aSAlex Williamson     window->bar = nr;
8130e54f24aSAlex Williamson     window->addr_mem = bar5->addr_mem = &quirk->mem[0];
8140e54f24aSAlex Williamson     window->data_mem = bar5->data_mem = &quirk->mem[1];
8150e54f24aSAlex Williamson 
8160e54f24aSAlex Williamson     memory_region_init_io(window->addr_mem, OBJECT(vdev),
8170e54f24aSAlex Williamson                           &vfio_generic_window_address_quirk, window,
8180e54f24aSAlex Williamson                           "vfio-nvidia-bar5-window-address-quirk", 4);
819db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
8200e54f24aSAlex Williamson                                         window->address_offset,
8210e54f24aSAlex Williamson                                         window->addr_mem, 1);
8220e54f24aSAlex Williamson     memory_region_set_enabled(window->addr_mem, false);
8230e54f24aSAlex Williamson 
8240e54f24aSAlex Williamson     memory_region_init_io(window->data_mem, OBJECT(vdev),
8250e54f24aSAlex Williamson                           &vfio_generic_window_data_quirk, window,
8260e54f24aSAlex Williamson                           "vfio-nvidia-bar5-window-data-quirk", 4);
827db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
8280e54f24aSAlex Williamson                                         window->data_offset,
8290e54f24aSAlex Williamson                                         window->data_mem, 1);
8300e54f24aSAlex Williamson     memory_region_set_enabled(window->data_mem, false);
8310e54f24aSAlex Williamson 
8320e54f24aSAlex Williamson     memory_region_init_io(&quirk->mem[2], OBJECT(vdev),
8330e54f24aSAlex Williamson                           &vfio_nvidia_bar5_quirk_master, bar5,
8340e54f24aSAlex Williamson                           "vfio-nvidia-bar5-master-quirk", 4);
835db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
8360e54f24aSAlex Williamson                                         0, &quirk->mem[2], 1);
8370e54f24aSAlex Williamson 
8380e54f24aSAlex Williamson     memory_region_init_io(&quirk->mem[3], OBJECT(vdev),
8390e54f24aSAlex Williamson                           &vfio_nvidia_bar5_quirk_enable, bar5,
8400e54f24aSAlex Williamson                           "vfio-nvidia-bar5-enable-quirk", 4);
841db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
8420e54f24aSAlex Williamson                                         4, &quirk->mem[3], 1);
843c00d61d8SAlex Williamson 
844c00d61d8SAlex Williamson     QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
845c00d61d8SAlex Williamson 
8460e54f24aSAlex Williamson     trace_vfio_quirk_nvidia_bar5_probe(vdev->vbasedev.name);
847c00d61d8SAlex Williamson }
848c00d61d8SAlex Williamson 
849c958c51dSAlex Williamson typedef struct LastDataSet {
850c958c51dSAlex Williamson     VFIOQuirk *quirk;
851c958c51dSAlex Williamson     hwaddr addr;
852c958c51dSAlex Williamson     uint64_t data;
853c958c51dSAlex Williamson     unsigned size;
854c958c51dSAlex Williamson     int hits;
855c958c51dSAlex Williamson     int added;
856c958c51dSAlex Williamson } LastDataSet;
857c958c51dSAlex Williamson 
858c958c51dSAlex Williamson #define MAX_DYN_IOEVENTFD 10
859c958c51dSAlex Williamson #define HITS_FOR_IOEVENTFD 10
860c958c51dSAlex Williamson 
8610d38fb1cSAlex Williamson /*
8620d38fb1cSAlex Williamson  * Finally, BAR0 itself.  We want to redirect any accesses to either
8630d38fb1cSAlex Williamson  * 0x1800 or 0x88000 through the PCI config space access functions.
8640d38fb1cSAlex Williamson  */
8650d38fb1cSAlex Williamson static void vfio_nvidia_quirk_mirror_write(void *opaque, hwaddr addr,
866c00d61d8SAlex Williamson                                            uint64_t data, unsigned size)
867c00d61d8SAlex Williamson {
8680d38fb1cSAlex Williamson     VFIOConfigMirrorQuirk *mirror = opaque;
8690d38fb1cSAlex Williamson     VFIOPCIDevice *vdev = mirror->vdev;
870c00d61d8SAlex Williamson     PCIDevice *pdev = &vdev->pdev;
871c958c51dSAlex Williamson     LastDataSet *last = (LastDataSet *)&mirror->data;
872c00d61d8SAlex Williamson 
8730d38fb1cSAlex Williamson     vfio_generic_quirk_mirror_write(opaque, addr, data, size);
874c00d61d8SAlex Williamson 
875c00d61d8SAlex Williamson     /*
876c00d61d8SAlex Williamson      * Nvidia seems to acknowledge MSI interrupts by writing 0xff to the
877c00d61d8SAlex Williamson      * MSI capability ID register.  Both the ID and next register are
878c00d61d8SAlex Williamson      * read-only, so we allow writes covering either of those to real hw.
879c00d61d8SAlex Williamson      */
880c00d61d8SAlex Williamson     if ((pdev->cap_present & QEMU_PCI_CAP_MSI) &&
881c00d61d8SAlex Williamson         vfio_range_contained(addr, size, pdev->msi_cap, PCI_MSI_FLAGS)) {
8820d38fb1cSAlex Williamson         vfio_region_write(&vdev->bars[mirror->bar].region,
8830d38fb1cSAlex Williamson                           addr + mirror->offset, data, size);
8840d38fb1cSAlex Williamson         trace_vfio_quirk_nvidia_bar0_msi_ack(vdev->vbasedev.name);
885c00d61d8SAlex Williamson     }
886c958c51dSAlex Williamson 
887c958c51dSAlex Williamson     /*
888c958c51dSAlex Williamson      * Automatically add an ioeventfd to handle any repeated write with the
889c958c51dSAlex Williamson      * same data and size above the standard PCI config space header.  This is
890c958c51dSAlex Williamson      * primarily expected to accelerate the MSI-ACK behavior, such as noted
891c958c51dSAlex Williamson      * above.  Current hardware/drivers should trigger an ioeventfd at config
892c958c51dSAlex Williamson      * offset 0x704 (region offset 0x88704), with data 0x0, size 4.
893c958c51dSAlex Williamson      *
894c958c51dSAlex Williamson      * The criteria of 10 successive hits is arbitrary but reliably adds the
895c958c51dSAlex Williamson      * MSI-ACK region.  Note that as some writes are bypassed via the ioeventfd,
896c958c51dSAlex Williamson      * the remaining ones have a greater chance of being seen successively.
897c958c51dSAlex Williamson      * To avoid the pathological case of burning up all of QEMU's open file
898c958c51dSAlex Williamson      * handles, arbitrarily limit this algorithm from adding no more than 10
899c958c51dSAlex Williamson      * ioeventfds, print an error if we would have added an 11th, and then
900c958c51dSAlex Williamson      * stop counting.
901c958c51dSAlex Williamson      */
902c958c51dSAlex Williamson     if (!vdev->no_kvm_ioeventfd &&
903c958c51dSAlex Williamson         addr >= PCI_STD_HEADER_SIZEOF && last->added <= MAX_DYN_IOEVENTFD) {
904c958c51dSAlex Williamson         if (addr != last->addr || data != last->data || size != last->size) {
905c958c51dSAlex Williamson             last->addr = addr;
906c958c51dSAlex Williamson             last->data = data;
907c958c51dSAlex Williamson             last->size = size;
908c958c51dSAlex Williamson             last->hits = 1;
909c958c51dSAlex Williamson         } else if (++last->hits >= HITS_FOR_IOEVENTFD) {
910c958c51dSAlex Williamson             if (last->added < MAX_DYN_IOEVENTFD) {
911c958c51dSAlex Williamson                 VFIOIOEventFD *ioeventfd;
912c958c51dSAlex Williamson                 ioeventfd = vfio_ioeventfd_init(vdev, mirror->mem, addr, size,
913c958c51dSAlex Williamson                                         data, &vdev->bars[mirror->bar].region,
914c958c51dSAlex Williamson                                         mirror->offset + addr, true);
915c958c51dSAlex Williamson                 if (ioeventfd) {
916c958c51dSAlex Williamson                     VFIOQuirk *quirk = last->quirk;
917c958c51dSAlex Williamson 
918c958c51dSAlex Williamson                     QLIST_INSERT_HEAD(&quirk->ioeventfds, ioeventfd, next);
919c958c51dSAlex Williamson                     last->added++;
920c958c51dSAlex Williamson                 }
921c958c51dSAlex Williamson             } else {
922c958c51dSAlex Williamson                 last->added++;
923c958c51dSAlex Williamson                 warn_report("NVIDIA ioeventfd queue full for %s, unable to "
924c958c51dSAlex Williamson                             "accelerate 0x%"HWADDR_PRIx", data 0x%"PRIx64", "
925c958c51dSAlex Williamson                             "size %u", vdev->vbasedev.name, addr, data, size);
926c958c51dSAlex Williamson             }
927c958c51dSAlex Williamson         }
928c958c51dSAlex Williamson     }
929c00d61d8SAlex Williamson }
930c00d61d8SAlex Williamson 
9310d38fb1cSAlex Williamson static const MemoryRegionOps vfio_nvidia_mirror_quirk = {
9320d38fb1cSAlex Williamson     .read = vfio_generic_quirk_mirror_read,
9330d38fb1cSAlex Williamson     .write = vfio_nvidia_quirk_mirror_write,
934c00d61d8SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
935c00d61d8SAlex Williamson };
936c00d61d8SAlex Williamson 
937c958c51dSAlex Williamson static void vfio_nvidia_bar0_quirk_reset(VFIOPCIDevice *vdev, VFIOQuirk *quirk)
938c958c51dSAlex Williamson {
939c958c51dSAlex Williamson     VFIOConfigMirrorQuirk *mirror = quirk->data;
940c958c51dSAlex Williamson     LastDataSet *last = (LastDataSet *)&mirror->data;
941c958c51dSAlex Williamson 
942c958c51dSAlex Williamson     last->addr = last->data = last->size = last->hits = last->added = 0;
943c958c51dSAlex Williamson 
944c958c51dSAlex Williamson     vfio_drop_dynamic_eventfds(vdev, quirk);
945c958c51dSAlex Williamson }
946c958c51dSAlex Williamson 
9470d38fb1cSAlex Williamson static void vfio_probe_nvidia_bar0_quirk(VFIOPCIDevice *vdev, int nr)
948c00d61d8SAlex Williamson {
949c00d61d8SAlex Williamson     VFIOQuirk *quirk;
9500d38fb1cSAlex Williamson     VFIOConfigMirrorQuirk *mirror;
951c958c51dSAlex Williamson     LastDataSet *last;
952c00d61d8SAlex Williamson 
953db32d0f4SAlex Williamson     if (vdev->no_geforce_quirks ||
954db32d0f4SAlex Williamson         !vfio_pci_is(vdev, PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID) ||
9550d38fb1cSAlex Williamson         !vfio_is_vga(vdev) || nr != 0) {
956c00d61d8SAlex Williamson         return;
957c00d61d8SAlex Williamson     }
958c00d61d8SAlex Williamson 
959bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(1);
960c958c51dSAlex Williamson     quirk->reset = vfio_nvidia_bar0_quirk_reset;
961c958c51dSAlex Williamson     mirror = quirk->data = g_malloc0(sizeof(*mirror) + sizeof(LastDataSet));
962bcf3c3d0SAlex Williamson     mirror->mem = quirk->mem;
9630d38fb1cSAlex Williamson     mirror->vdev = vdev;
9640d38fb1cSAlex Williamson     mirror->offset = 0x88000;
9650d38fb1cSAlex Williamson     mirror->bar = nr;
966c958c51dSAlex Williamson     last = (LastDataSet *)&mirror->data;
967c958c51dSAlex Williamson     last->quirk = quirk;
968c00d61d8SAlex Williamson 
9690d38fb1cSAlex Williamson     memory_region_init_io(mirror->mem, OBJECT(vdev),
9700d38fb1cSAlex Williamson                           &vfio_nvidia_mirror_quirk, mirror,
9710d38fb1cSAlex Williamson                           "vfio-nvidia-bar0-88000-mirror-quirk",
972f5793fd9SAlex Williamson                           vdev->config_size);
973db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
9740d38fb1cSAlex Williamson                                         mirror->offset, mirror->mem, 1);
975c00d61d8SAlex Williamson 
976c00d61d8SAlex Williamson     QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
977c00d61d8SAlex Williamson 
9780d38fb1cSAlex Williamson     /* The 0x1800 offset mirror only seems to get used by legacy VGA */
9794d3fc4fdSAlex Williamson     if (vdev->vga) {
980bcf3c3d0SAlex Williamson         quirk = vfio_quirk_alloc(1);
981c958c51dSAlex Williamson         quirk->reset = vfio_nvidia_bar0_quirk_reset;
982c958c51dSAlex Williamson         mirror = quirk->data = g_malloc0(sizeof(*mirror) + sizeof(LastDataSet));
983bcf3c3d0SAlex Williamson         mirror->mem = quirk->mem;
9840d38fb1cSAlex Williamson         mirror->vdev = vdev;
9850d38fb1cSAlex Williamson         mirror->offset = 0x1800;
9860d38fb1cSAlex Williamson         mirror->bar = nr;
987c958c51dSAlex Williamson         last = (LastDataSet *)&mirror->data;
988c958c51dSAlex Williamson         last->quirk = quirk;
989c00d61d8SAlex Williamson 
9900d38fb1cSAlex Williamson         memory_region_init_io(mirror->mem, OBJECT(vdev),
9910d38fb1cSAlex Williamson                               &vfio_nvidia_mirror_quirk, mirror,
9920d38fb1cSAlex Williamson                               "vfio-nvidia-bar0-1800-mirror-quirk",
9930d38fb1cSAlex Williamson                               PCI_CONFIG_SPACE_SIZE);
994db0da029SAlex Williamson         memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
9950d38fb1cSAlex Williamson                                             mirror->offset, mirror->mem, 1);
996c00d61d8SAlex Williamson 
997c00d61d8SAlex Williamson         QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
9980d38fb1cSAlex Williamson     }
999c00d61d8SAlex Williamson 
10000d38fb1cSAlex Williamson     trace_vfio_quirk_nvidia_bar0_probe(vdev->vbasedev.name);
1001c00d61d8SAlex Williamson }
1002c00d61d8SAlex Williamson 
1003c00d61d8SAlex Williamson /*
1004c00d61d8SAlex Williamson  * TODO - Some Nvidia devices provide config access to their companion HDA
1005c00d61d8SAlex Williamson  * device and even to their parent bridge via these config space mirrors.
1006c00d61d8SAlex Williamson  * Add quirks for those regions.
1007c00d61d8SAlex Williamson  */
1008c00d61d8SAlex Williamson 
1009c00d61d8SAlex Williamson #define PCI_VENDOR_ID_REALTEK 0x10ec
1010c00d61d8SAlex Williamson 
1011c00d61d8SAlex Williamson /*
1012c00d61d8SAlex Williamson  * RTL8168 devices have a backdoor that can access the MSI-X table.  At BAR2
1013c00d61d8SAlex Williamson  * offset 0x70 there is a dword data register, offset 0x74 is a dword address
1014c00d61d8SAlex Williamson  * register.  According to the Linux r8169 driver, the MSI-X table is addressed
1015c00d61d8SAlex Williamson  * when the "type" portion of the address register is set to 0x1.  This appears
1016c00d61d8SAlex Williamson  * to be bits 16:30.  Bit 31 is both a write indicator and some sort of
1017c00d61d8SAlex Williamson  * "address latched" indicator.  Bits 12:15 are a mask field, which we can
1018c00d61d8SAlex Williamson  * ignore because the MSI-X table should always be accessed as a dword (full
1019c00d61d8SAlex Williamson  * mask).  Bits 0:11 is offset within the type.
1020c00d61d8SAlex Williamson  *
1021c00d61d8SAlex Williamson  * Example trace:
1022c00d61d8SAlex Williamson  *
1023c00d61d8SAlex Williamson  * Read from MSI-X table offset 0
1024c00d61d8SAlex Williamson  * vfio: vfio_bar_write(0000:05:00.0:BAR2+0x74, 0x1f000, 4) // store read addr
1025c00d61d8SAlex Williamson  * vfio: vfio_bar_read(0000:05:00.0:BAR2+0x74, 4) = 0x8001f000 // latch
1026c00d61d8SAlex Williamson  * vfio: vfio_bar_read(0000:05:00.0:BAR2+0x70, 4) = 0xfee00398 // read data
1027c00d61d8SAlex Williamson  *
1028c00d61d8SAlex Williamson  * Write 0xfee00000 to MSI-X table offset 0
1029c00d61d8SAlex Williamson  * vfio: vfio_bar_write(0000:05:00.0:BAR2+0x70, 0xfee00000, 4) // write data
1030c00d61d8SAlex Williamson  * vfio: vfio_bar_write(0000:05:00.0:BAR2+0x74, 0x8001f000, 4) // do write
1031c00d61d8SAlex Williamson  * vfio: vfio_bar_read(0000:05:00.0:BAR2+0x74, 4) = 0x1f000 // complete
1032c00d61d8SAlex Williamson  */
1033954258a5SAlex Williamson typedef struct VFIOrtl8168Quirk {
1034954258a5SAlex Williamson     VFIOPCIDevice *vdev;
1035954258a5SAlex Williamson     uint32_t addr;
1036954258a5SAlex Williamson     uint32_t data;
1037954258a5SAlex Williamson     bool enabled;
1038954258a5SAlex Williamson } VFIOrtl8168Quirk;
1039954258a5SAlex Williamson 
1040954258a5SAlex Williamson static uint64_t vfio_rtl8168_quirk_address_read(void *opaque,
1041c00d61d8SAlex Williamson                                                 hwaddr addr, unsigned size)
1042c00d61d8SAlex Williamson {
1043954258a5SAlex Williamson     VFIOrtl8168Quirk *rtl = opaque;
1044954258a5SAlex Williamson     VFIOPCIDevice *vdev = rtl->vdev;
1045954258a5SAlex Williamson     uint64_t data = vfio_region_read(&vdev->bars[2].region, addr + 0x74, size);
1046c00d61d8SAlex Williamson 
1047954258a5SAlex Williamson     if (rtl->enabled) {
1048954258a5SAlex Williamson         data = rtl->addr ^ 0x80000000U; /* latch/complete */
1049954258a5SAlex Williamson         trace_vfio_quirk_rtl8168_fake_latch(vdev->vbasedev.name, data);
1050c00d61d8SAlex Williamson     }
1051c00d61d8SAlex Williamson 
1052954258a5SAlex Williamson     return data;
1053c00d61d8SAlex Williamson }
1054c00d61d8SAlex Williamson 
1055954258a5SAlex Williamson static void vfio_rtl8168_quirk_address_write(void *opaque, hwaddr addr,
1056c00d61d8SAlex Williamson                                              uint64_t data, unsigned size)
1057c00d61d8SAlex Williamson {
1058954258a5SAlex Williamson     VFIOrtl8168Quirk *rtl = opaque;
1059954258a5SAlex Williamson     VFIOPCIDevice *vdev = rtl->vdev;
1060c00d61d8SAlex Williamson 
1061954258a5SAlex Williamson     rtl->enabled = false;
1062954258a5SAlex Williamson 
1063c00d61d8SAlex Williamson     if ((data & 0x7fff0000) == 0x10000) { /* MSI-X table */
1064954258a5SAlex Williamson         rtl->enabled = true;
1065954258a5SAlex Williamson         rtl->addr = (uint32_t)data;
1066c00d61d8SAlex Williamson 
1067c00d61d8SAlex Williamson         if (data & 0x80000000U) { /* Do write */
1068c00d61d8SAlex Williamson             if (vdev->pdev.cap_present & QEMU_PCI_CAP_MSIX) {
1069c00d61d8SAlex Williamson                 hwaddr offset = data & 0xfff;
1070954258a5SAlex Williamson                 uint64_t val = rtl->data;
1071c00d61d8SAlex Williamson 
1072954258a5SAlex Williamson                 trace_vfio_quirk_rtl8168_msix_write(vdev->vbasedev.name,
1073c00d61d8SAlex Williamson                                                     (uint16_t)offset, val);
1074c00d61d8SAlex Williamson 
1075c00d61d8SAlex Williamson                 /* Write to the proper guest MSI-X table instead */
1076c00d61d8SAlex Williamson                 memory_region_dispatch_write(&vdev->pdev.msix_table_mmio,
1077*475fbf0aSTony Nguyen                                              offset, val, size_memop(size),
1078c00d61d8SAlex Williamson                                              MEMTXATTRS_UNSPECIFIED);
1079c00d61d8SAlex Williamson             }
1080c00d61d8SAlex Williamson             return; /* Do not write guest MSI-X data to hardware */
1081c00d61d8SAlex Williamson         }
1082c00d61d8SAlex Williamson     }
1083c00d61d8SAlex Williamson 
1084954258a5SAlex Williamson     vfio_region_write(&vdev->bars[2].region, addr + 0x74, data, size);
1085c00d61d8SAlex Williamson }
1086c00d61d8SAlex Williamson 
1087954258a5SAlex Williamson static const MemoryRegionOps vfio_rtl_address_quirk = {
1088954258a5SAlex Williamson     .read = vfio_rtl8168_quirk_address_read,
1089954258a5SAlex Williamson     .write = vfio_rtl8168_quirk_address_write,
1090c00d61d8SAlex Williamson     .valid = {
1091c00d61d8SAlex Williamson         .min_access_size = 4,
1092c00d61d8SAlex Williamson         .max_access_size = 4,
1093c00d61d8SAlex Williamson         .unaligned = false,
1094c00d61d8SAlex Williamson     },
1095c00d61d8SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
1096c00d61d8SAlex Williamson };
1097c00d61d8SAlex Williamson 
1098954258a5SAlex Williamson static uint64_t vfio_rtl8168_quirk_data_read(void *opaque,
1099954258a5SAlex Williamson                                              hwaddr addr, unsigned size)
1100c00d61d8SAlex Williamson {
1101954258a5SAlex Williamson     VFIOrtl8168Quirk *rtl = opaque;
1102954258a5SAlex Williamson     VFIOPCIDevice *vdev = rtl->vdev;
110331e6a7b1SThorsten Kohfeldt     uint64_t data = vfio_region_read(&vdev->bars[2].region, addr + 0x70, size);
1104c00d61d8SAlex Williamson 
1105954258a5SAlex Williamson     if (rtl->enabled && (vdev->pdev.cap_present & QEMU_PCI_CAP_MSIX)) {
1106954258a5SAlex Williamson         hwaddr offset = rtl->addr & 0xfff;
1107954258a5SAlex Williamson         memory_region_dispatch_read(&vdev->pdev.msix_table_mmio, offset,
1108*475fbf0aSTony Nguyen                                     &data, size_memop(size),
1109*475fbf0aSTony Nguyen                                     MEMTXATTRS_UNSPECIFIED);
1110954258a5SAlex Williamson         trace_vfio_quirk_rtl8168_msix_read(vdev->vbasedev.name, offset, data);
1111954258a5SAlex Williamson     }
1112954258a5SAlex Williamson 
1113954258a5SAlex Williamson     return data;
1114954258a5SAlex Williamson }
1115954258a5SAlex Williamson 
1116954258a5SAlex Williamson static void vfio_rtl8168_quirk_data_write(void *opaque, hwaddr addr,
1117954258a5SAlex Williamson                                           uint64_t data, unsigned size)
1118954258a5SAlex Williamson {
1119954258a5SAlex Williamson     VFIOrtl8168Quirk *rtl = opaque;
1120954258a5SAlex Williamson     VFIOPCIDevice *vdev = rtl->vdev;
1121954258a5SAlex Williamson 
1122954258a5SAlex Williamson     rtl->data = (uint32_t)data;
1123954258a5SAlex Williamson 
1124954258a5SAlex Williamson     vfio_region_write(&vdev->bars[2].region, addr + 0x70, data, size);
1125954258a5SAlex Williamson }
1126954258a5SAlex Williamson 
1127954258a5SAlex Williamson static const MemoryRegionOps vfio_rtl_data_quirk = {
1128954258a5SAlex Williamson     .read = vfio_rtl8168_quirk_data_read,
1129954258a5SAlex Williamson     .write = vfio_rtl8168_quirk_data_write,
1130954258a5SAlex Williamson     .valid = {
1131954258a5SAlex Williamson         .min_access_size = 4,
1132954258a5SAlex Williamson         .max_access_size = 4,
1133954258a5SAlex Williamson         .unaligned = false,
1134954258a5SAlex Williamson     },
1135954258a5SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
1136954258a5SAlex Williamson };
1137954258a5SAlex Williamson 
1138954258a5SAlex Williamson static void vfio_probe_rtl8168_bar2_quirk(VFIOPCIDevice *vdev, int nr)
1139954258a5SAlex Williamson {
1140954258a5SAlex Williamson     VFIOQuirk *quirk;
1141954258a5SAlex Williamson     VFIOrtl8168Quirk *rtl;
1142954258a5SAlex Williamson 
1143954258a5SAlex Williamson     if (!vfio_pci_is(vdev, PCI_VENDOR_ID_REALTEK, 0x8168) || nr != 2) {
1144c00d61d8SAlex Williamson         return;
1145c00d61d8SAlex Williamson     }
1146c00d61d8SAlex Williamson 
1147bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(2);
1148954258a5SAlex Williamson     quirk->data = rtl = g_malloc0(sizeof(*rtl));
1149954258a5SAlex Williamson     rtl->vdev = vdev;
1150c00d61d8SAlex Williamson 
1151954258a5SAlex Williamson     memory_region_init_io(&quirk->mem[0], OBJECT(vdev),
1152954258a5SAlex Williamson                           &vfio_rtl_address_quirk, rtl,
1153954258a5SAlex Williamson                           "vfio-rtl8168-window-address-quirk", 4);
1154db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
1155954258a5SAlex Williamson                                         0x74, &quirk->mem[0], 1);
1156954258a5SAlex Williamson 
1157954258a5SAlex Williamson     memory_region_init_io(&quirk->mem[1], OBJECT(vdev),
1158954258a5SAlex Williamson                           &vfio_rtl_data_quirk, rtl,
1159954258a5SAlex Williamson                           "vfio-rtl8168-window-data-quirk", 4);
1160db0da029SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
1161954258a5SAlex Williamson                                         0x70, &quirk->mem[1], 1);
1162c00d61d8SAlex Williamson 
1163c00d61d8SAlex Williamson     QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
1164c00d61d8SAlex Williamson 
1165954258a5SAlex Williamson     trace_vfio_quirk_rtl8168_probe(vdev->vbasedev.name);
1166c00d61d8SAlex Williamson }
1167c00d61d8SAlex Williamson 
1168c00d61d8SAlex Williamson /*
1169c4c45e94SAlex Williamson  * Intel IGD support
1170c4c45e94SAlex Williamson  *
1171c4c45e94SAlex Williamson  * Obviously IGD is not a discrete device, this is evidenced not only by it
1172c4c45e94SAlex Williamson  * being integrated into the CPU, but by the various chipset and BIOS
1173c4c45e94SAlex Williamson  * dependencies that it brings along with it.  Intel is trying to move away
1174c4c45e94SAlex Williamson  * from this and Broadwell and newer devices can run in what Intel calls
1175c4c45e94SAlex Williamson  * "Universal Pass-Through" mode, or UPT.  Theoretically in UPT mode, nothing
1176c4c45e94SAlex Williamson  * more is required beyond assigning the IGD device to a VM.  There are
1177c4c45e94SAlex Williamson  * however support limitations to this mode.  It only supports IGD as a
1178c4c45e94SAlex Williamson  * secondary graphics device in the VM and it doesn't officially support any
1179c4c45e94SAlex Williamson  * physical outputs.
1180c4c45e94SAlex Williamson  *
1181c4c45e94SAlex Williamson  * The code here attempts to enable what we'll call legacy mode assignment,
1182c4c45e94SAlex Williamson  * IGD retains most of the capabilities we expect for it to have on bare
1183c4c45e94SAlex Williamson  * metal.  To enable this mode, the IGD device must be assigned to the VM
1184c4c45e94SAlex Williamson  * at PCI address 00:02.0, it must have a ROM, it very likely needs VGA
1185c4c45e94SAlex Williamson  * support, we must have VM BIOS support for reserving and populating some
1186c4c45e94SAlex Williamson  * of the required tables, and we need to tweak the chipset with revisions
1187c4c45e94SAlex Williamson  * and IDs and an LPC/ISA bridge device.  The intention is to make all of
1188c4c45e94SAlex Williamson  * this happen automatically by installing the device at the correct VM PCI
1189c4c45e94SAlex Williamson  * bus address.  If any of the conditions are not met, we cross our fingers
1190c4c45e94SAlex Williamson  * and hope the user knows better.
1191c4c45e94SAlex Williamson  *
1192c4c45e94SAlex Williamson  * NB - It is possible to enable physical outputs in UPT mode by supplying
1193c4c45e94SAlex Williamson  * an OpRegion table.  We don't do this by default because the guest driver
1194c4c45e94SAlex Williamson  * behaves differently if an OpRegion is provided and no monitor is attached
1195c4c45e94SAlex Williamson  * vs no OpRegion and a monitor being attached or not.  Effectively, if a
1196c4c45e94SAlex Williamson  * headless setup is desired, the OpRegion gets in the way of that.
1197c4c45e94SAlex Williamson  */
1198c4c45e94SAlex Williamson 
1199c4c45e94SAlex Williamson /*
1200c4c45e94SAlex Williamson  * This presumes the device is already known to be an Intel VGA device, so we
1201c4c45e94SAlex Williamson  * take liberties in which device ID bits match which generation.  This should
1202c4c45e94SAlex Williamson  * not be taken as an indication that all the devices are supported, or even
1203c4c45e94SAlex Williamson  * supportable, some of them don't even support VT-d.
1204c4c45e94SAlex Williamson  * See linux:include/drm/i915_pciids.h for IDs.
1205c4c45e94SAlex Williamson  */
1206c4c45e94SAlex Williamson static int igd_gen(VFIOPCIDevice *vdev)
1207c4c45e94SAlex Williamson {
1208c4c45e94SAlex Williamson     if ((vdev->device_id & 0xfff) == 0xa84) {
1209c4c45e94SAlex Williamson         return 8; /* Broxton */
1210c4c45e94SAlex Williamson     }
1211c4c45e94SAlex Williamson 
1212c4c45e94SAlex Williamson     switch (vdev->device_id & 0xff00) {
1213c4c45e94SAlex Williamson     /* Old, untested, unavailable, unknown */
1214c4c45e94SAlex Williamson     case 0x0000:
1215c4c45e94SAlex Williamson     case 0x2500:
1216c4c45e94SAlex Williamson     case 0x2700:
1217c4c45e94SAlex Williamson     case 0x2900:
1218c4c45e94SAlex Williamson     case 0x2a00:
1219c4c45e94SAlex Williamson     case 0x2e00:
1220c4c45e94SAlex Williamson     case 0x3500:
1221c4c45e94SAlex Williamson     case 0xa000:
1222c4c45e94SAlex Williamson         return -1;
1223c4c45e94SAlex Williamson     /* SandyBridge, IvyBridge, ValleyView, Haswell */
1224c4c45e94SAlex Williamson     case 0x0100:
1225c4c45e94SAlex Williamson     case 0x0400:
1226c4c45e94SAlex Williamson     case 0x0a00:
1227c4c45e94SAlex Williamson     case 0x0c00:
1228c4c45e94SAlex Williamson     case 0x0d00:
1229c4c45e94SAlex Williamson     case 0x0f00:
1230c4c45e94SAlex Williamson         return 6;
1231c4c45e94SAlex Williamson     /* BroadWell, CherryView, SkyLake, KabyLake */
1232c4c45e94SAlex Williamson     case 0x1600:
1233c4c45e94SAlex Williamson     case 0x1900:
1234c4c45e94SAlex Williamson     case 0x2200:
1235c4c45e94SAlex Williamson     case 0x5900:
1236c4c45e94SAlex Williamson         return 8;
1237c4c45e94SAlex Williamson     }
1238c4c45e94SAlex Williamson 
1239c4c45e94SAlex Williamson     return 8; /* Assume newer is compatible */
1240c4c45e94SAlex Williamson }
1241c4c45e94SAlex Williamson 
1242c4c45e94SAlex Williamson typedef struct VFIOIGDQuirk {
1243c4c45e94SAlex Williamson     struct VFIOPCIDevice *vdev;
1244c4c45e94SAlex Williamson     uint32_t index;
1245ac2a9862SAlex Williamson     uint32_t bdsm;
1246c4c45e94SAlex Williamson } VFIOIGDQuirk;
1247c4c45e94SAlex Williamson 
1248c4c45e94SAlex Williamson #define IGD_GMCH 0x50 /* Graphics Control Register */
1249c4c45e94SAlex Williamson #define IGD_BDSM 0x5c /* Base Data of Stolen Memory */
1250c4c45e94SAlex Williamson #define IGD_ASLS 0xfc /* ASL Storage Register */
1251c4c45e94SAlex Williamson 
1252c4c45e94SAlex Williamson /*
1253c4c45e94SAlex Williamson  * The OpRegion includes the Video BIOS Table, which seems important for
1254c4c45e94SAlex Williamson  * telling the driver what sort of outputs it has.  Without this, the device
1255c4c45e94SAlex Williamson  * may work in the guest, but we may not get output.  This also requires BIOS
1256c4c45e94SAlex Williamson  * support to reserve and populate a section of guest memory sufficient for
1257c4c45e94SAlex Williamson  * the table and to write the base address of that memory to the ASLS register
1258c4c45e94SAlex Williamson  * of the IGD device.
1259c4c45e94SAlex Williamson  */
12606ced0bbaSAlex Williamson int vfio_pci_igd_opregion_init(VFIOPCIDevice *vdev,
12617237011dSEric Auger                                struct vfio_region_info *info, Error **errp)
1262c4c45e94SAlex Williamson {
1263c4c45e94SAlex Williamson     int ret;
1264c4c45e94SAlex Williamson 
1265c4c45e94SAlex Williamson     vdev->igd_opregion = g_malloc0(info->size);
1266c4c45e94SAlex Williamson     ret = pread(vdev->vbasedev.fd, vdev->igd_opregion,
1267c4c45e94SAlex Williamson                 info->size, info->offset);
1268c4c45e94SAlex Williamson     if (ret != info->size) {
12697237011dSEric Auger         error_setg(errp, "failed to read IGD OpRegion");
1270c4c45e94SAlex Williamson         g_free(vdev->igd_opregion);
1271c4c45e94SAlex Williamson         vdev->igd_opregion = NULL;
1272c4c45e94SAlex Williamson         return -EINVAL;
1273c4c45e94SAlex Williamson     }
1274c4c45e94SAlex Williamson 
1275c4c45e94SAlex Williamson     /*
1276c4c45e94SAlex Williamson      * Provide fw_cfg with a copy of the OpRegion which the VM firmware is to
1277c4c45e94SAlex Williamson      * allocate 32bit reserved memory for, copy these contents into, and write
1278c4c45e94SAlex Williamson      * the reserved memory base address to the device ASLS register at 0xFC.
1279c4c45e94SAlex Williamson      * Alignment of this reserved region seems flexible, but using a 4k page
1280c4c45e94SAlex Williamson      * alignment seems to work well.  This interface assumes a single IGD
1281c4c45e94SAlex Williamson      * device, which may be at VM address 00:02.0 in legacy mode or another
1282c4c45e94SAlex Williamson      * address in UPT mode.
1283c4c45e94SAlex Williamson      *
1284c4c45e94SAlex Williamson      * NB, there may be future use cases discovered where the VM should have
1285c4c45e94SAlex Williamson      * direct interaction with the host OpRegion, in which case the write to
1286c4c45e94SAlex Williamson      * the ASLS register would trigger MemoryRegion setup to enable that.
1287c4c45e94SAlex Williamson      */
1288c4c45e94SAlex Williamson     fw_cfg_add_file(fw_cfg_find(), "etc/igd-opregion",
1289c4c45e94SAlex Williamson                     vdev->igd_opregion, info->size);
1290c4c45e94SAlex Williamson 
1291c4c45e94SAlex Williamson     trace_vfio_pci_igd_opregion_enabled(vdev->vbasedev.name);
1292c4c45e94SAlex Williamson 
1293c4c45e94SAlex Williamson     pci_set_long(vdev->pdev.config + IGD_ASLS, 0);
1294c4c45e94SAlex Williamson     pci_set_long(vdev->pdev.wmask + IGD_ASLS, ~0);
1295c4c45e94SAlex Williamson     pci_set_long(vdev->emulated_config_bits + IGD_ASLS, ~0);
1296c4c45e94SAlex Williamson 
1297c4c45e94SAlex Williamson     return 0;
1298c4c45e94SAlex Williamson }
1299c4c45e94SAlex Williamson 
1300c4c45e94SAlex Williamson /*
1301c4c45e94SAlex Williamson  * The rather short list of registers that we copy from the host devices.
1302c4c45e94SAlex Williamson  * The LPC/ISA bridge values are definitely needed to support the vBIOS, the
1303c4c45e94SAlex Williamson  * host bridge values may or may not be needed depending on the guest OS.
1304c4c45e94SAlex Williamson  * Since we're only munging revision and subsystem values on the host bridge,
1305c4c45e94SAlex Williamson  * we don't require our own device.  The LPC/ISA bridge needs to be our very
1306c4c45e94SAlex Williamson  * own though.
1307c4c45e94SAlex Williamson  */
1308c4c45e94SAlex Williamson typedef struct {
1309c4c45e94SAlex Williamson     uint8_t offset;
1310c4c45e94SAlex Williamson     uint8_t len;
1311c4c45e94SAlex Williamson } IGDHostInfo;
1312c4c45e94SAlex Williamson 
1313c4c45e94SAlex Williamson static const IGDHostInfo igd_host_bridge_infos[] = {
1314c4c45e94SAlex Williamson     {PCI_REVISION_ID,         2},
1315c4c45e94SAlex Williamson     {PCI_SUBSYSTEM_VENDOR_ID, 2},
1316c4c45e94SAlex Williamson     {PCI_SUBSYSTEM_ID,        2},
1317c4c45e94SAlex Williamson };
1318c4c45e94SAlex Williamson 
1319c4c45e94SAlex Williamson static const IGDHostInfo igd_lpc_bridge_infos[] = {
1320c4c45e94SAlex Williamson     {PCI_VENDOR_ID,           2},
1321c4c45e94SAlex Williamson     {PCI_DEVICE_ID,           2},
1322c4c45e94SAlex Williamson     {PCI_REVISION_ID,         2},
1323c4c45e94SAlex Williamson     {PCI_SUBSYSTEM_VENDOR_ID, 2},
1324c4c45e94SAlex Williamson     {PCI_SUBSYSTEM_ID,        2},
1325c4c45e94SAlex Williamson };
1326c4c45e94SAlex Williamson 
1327c4c45e94SAlex Williamson static int vfio_pci_igd_copy(VFIOPCIDevice *vdev, PCIDevice *pdev,
1328c4c45e94SAlex Williamson                              struct vfio_region_info *info,
1329c4c45e94SAlex Williamson                              const IGDHostInfo *list, int len)
1330c4c45e94SAlex Williamson {
1331c4c45e94SAlex Williamson     int i, ret;
1332c4c45e94SAlex Williamson 
1333c4c45e94SAlex Williamson     for (i = 0; i < len; i++) {
1334c4c45e94SAlex Williamson         ret = pread(vdev->vbasedev.fd, pdev->config + list[i].offset,
1335c4c45e94SAlex Williamson                     list[i].len, info->offset + list[i].offset);
1336c4c45e94SAlex Williamson         if (ret != list[i].len) {
1337c4c45e94SAlex Williamson             error_report("IGD copy failed: %m");
1338c4c45e94SAlex Williamson             return -errno;
1339c4c45e94SAlex Williamson         }
1340c4c45e94SAlex Williamson     }
1341c4c45e94SAlex Williamson 
1342c4c45e94SAlex Williamson     return 0;
1343c4c45e94SAlex Williamson }
1344c4c45e94SAlex Williamson 
1345c4c45e94SAlex Williamson /*
1346c4c45e94SAlex Williamson  * Stuff a few values into the host bridge.
1347c4c45e94SAlex Williamson  */
1348c4c45e94SAlex Williamson static int vfio_pci_igd_host_init(VFIOPCIDevice *vdev,
1349c4c45e94SAlex Williamson                                   struct vfio_region_info *info)
1350c4c45e94SAlex Williamson {
1351c4c45e94SAlex Williamson     PCIBus *bus;
1352c4c45e94SAlex Williamson     PCIDevice *host_bridge;
1353c4c45e94SAlex Williamson     int ret;
1354c4c45e94SAlex Williamson 
1355c4c45e94SAlex Williamson     bus = pci_device_root_bus(&vdev->pdev);
1356c4c45e94SAlex Williamson     host_bridge = pci_find_device(bus, 0, PCI_DEVFN(0, 0));
1357c4c45e94SAlex Williamson 
1358c4c45e94SAlex Williamson     if (!host_bridge) {
1359c4c45e94SAlex Williamson         error_report("Can't find host bridge");
1360c4c45e94SAlex Williamson         return -ENODEV;
1361c4c45e94SAlex Williamson     }
1362c4c45e94SAlex Williamson 
1363c4c45e94SAlex Williamson     ret = vfio_pci_igd_copy(vdev, host_bridge, info, igd_host_bridge_infos,
1364c4c45e94SAlex Williamson                             ARRAY_SIZE(igd_host_bridge_infos));
1365c4c45e94SAlex Williamson     if (!ret) {
1366c4c45e94SAlex Williamson         trace_vfio_pci_igd_host_bridge_enabled(vdev->vbasedev.name);
1367c4c45e94SAlex Williamson     }
1368c4c45e94SAlex Williamson 
1369c4c45e94SAlex Williamson     return ret;
1370c4c45e94SAlex Williamson }
1371c4c45e94SAlex Williamson 
1372c4c45e94SAlex Williamson /*
1373c4c45e94SAlex Williamson  * IGD LPC/ISA bridge support code.  The vBIOS needs this, but we can't write
1374c4c45e94SAlex Williamson  * arbitrary values into just any bridge, so we must create our own.  We try
1375c4c45e94SAlex Williamson  * to handle if the user has created it for us, which they might want to do
1376b12227afSStefan Weil  * to enable multifunction so we don't occupy the whole PCI slot.
1377c4c45e94SAlex Williamson  */
1378c4c45e94SAlex Williamson static void vfio_pci_igd_lpc_bridge_realize(PCIDevice *pdev, Error **errp)
1379c4c45e94SAlex Williamson {
1380c4c45e94SAlex Williamson     if (pdev->devfn != PCI_DEVFN(0x1f, 0)) {
1381c4c45e94SAlex Williamson         error_setg(errp, "VFIO dummy ISA/LPC bridge must have address 1f.0");
1382c4c45e94SAlex Williamson     }
1383c4c45e94SAlex Williamson }
1384c4c45e94SAlex Williamson 
1385c4c45e94SAlex Williamson static void vfio_pci_igd_lpc_bridge_class_init(ObjectClass *klass, void *data)
1386c4c45e94SAlex Williamson {
1387c4c45e94SAlex Williamson     DeviceClass *dc = DEVICE_CLASS(klass);
1388c4c45e94SAlex Williamson     PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
1389c4c45e94SAlex Williamson 
1390f23363eaSThomas Huth     set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
1391c4c45e94SAlex Williamson     dc->desc = "VFIO dummy ISA/LPC bridge for IGD assignment";
1392c4c45e94SAlex Williamson     dc->hotpluggable = false;
1393c4c45e94SAlex Williamson     k->realize = vfio_pci_igd_lpc_bridge_realize;
1394c4c45e94SAlex Williamson     k->class_id = PCI_CLASS_BRIDGE_ISA;
1395c4c45e94SAlex Williamson }
1396c4c45e94SAlex Williamson 
1397c4c45e94SAlex Williamson static TypeInfo vfio_pci_igd_lpc_bridge_info = {
1398c4c45e94SAlex Williamson     .name = "vfio-pci-igd-lpc-bridge",
1399c4c45e94SAlex Williamson     .parent = TYPE_PCI_DEVICE,
1400c4c45e94SAlex Williamson     .class_init = vfio_pci_igd_lpc_bridge_class_init,
1401fd3b02c8SEduardo Habkost     .interfaces = (InterfaceInfo[]) {
1402fd3b02c8SEduardo Habkost         { INTERFACE_CONVENTIONAL_PCI_DEVICE },
1403fd3b02c8SEduardo Habkost         { },
1404fd3b02c8SEduardo Habkost     },
1405c4c45e94SAlex Williamson };
1406c4c45e94SAlex Williamson 
1407c4c45e94SAlex Williamson static void vfio_pci_igd_register_types(void)
1408c4c45e94SAlex Williamson {
1409c4c45e94SAlex Williamson     type_register_static(&vfio_pci_igd_lpc_bridge_info);
1410c4c45e94SAlex Williamson }
1411c4c45e94SAlex Williamson 
1412c4c45e94SAlex Williamson type_init(vfio_pci_igd_register_types)
1413c4c45e94SAlex Williamson 
1414c4c45e94SAlex Williamson static int vfio_pci_igd_lpc_init(VFIOPCIDevice *vdev,
1415c4c45e94SAlex Williamson                                  struct vfio_region_info *info)
1416c4c45e94SAlex Williamson {
1417c4c45e94SAlex Williamson     PCIDevice *lpc_bridge;
1418c4c45e94SAlex Williamson     int ret;
1419c4c45e94SAlex Williamson 
1420c4c45e94SAlex Williamson     lpc_bridge = pci_find_device(pci_device_root_bus(&vdev->pdev),
1421c4c45e94SAlex Williamson                                  0, PCI_DEVFN(0x1f, 0));
1422c4c45e94SAlex Williamson     if (!lpc_bridge) {
1423c4c45e94SAlex Williamson         lpc_bridge = pci_create_simple(pci_device_root_bus(&vdev->pdev),
1424c4c45e94SAlex Williamson                                  PCI_DEVFN(0x1f, 0), "vfio-pci-igd-lpc-bridge");
1425c4c45e94SAlex Williamson     }
1426c4c45e94SAlex Williamson 
1427c4c45e94SAlex Williamson     ret = vfio_pci_igd_copy(vdev, lpc_bridge, info, igd_lpc_bridge_infos,
1428c4c45e94SAlex Williamson                             ARRAY_SIZE(igd_lpc_bridge_infos));
1429c4c45e94SAlex Williamson     if (!ret) {
1430c4c45e94SAlex Williamson         trace_vfio_pci_igd_lpc_bridge_enabled(vdev->vbasedev.name);
1431c4c45e94SAlex Williamson     }
1432c4c45e94SAlex Williamson 
1433c4c45e94SAlex Williamson     return ret;
1434c4c45e94SAlex Williamson }
1435c4c45e94SAlex Williamson 
1436c4c45e94SAlex Williamson /*
1437c4c45e94SAlex Williamson  * IGD Gen8 and newer support up to 8MB for the GTT and use a 64bit PTE
1438c4c45e94SAlex Williamson  * entry, older IGDs use 2MB and 32bit.  Each PTE maps a 4k page.  Therefore
1439c4c45e94SAlex Williamson  * we either have 2M/4k * 4 = 2k or 8M/4k * 8 = 16k as the maximum iobar index
1440c4c45e94SAlex Williamson  * for programming the GTT.
1441c4c45e94SAlex Williamson  *
1442c4c45e94SAlex Williamson  * See linux:include/drm/i915_drm.h for shift and mask values.
1443c4c45e94SAlex Williamson  */
1444c4c45e94SAlex Williamson static int vfio_igd_gtt_max(VFIOPCIDevice *vdev)
1445c4c45e94SAlex Williamson {
1446c4c45e94SAlex Williamson     uint32_t gmch = vfio_pci_read_config(&vdev->pdev, IGD_GMCH, sizeof(gmch));
1447c4c45e94SAlex Williamson     int ggms, gen = igd_gen(vdev);
1448c4c45e94SAlex Williamson 
1449c4c45e94SAlex Williamson     gmch = vfio_pci_read_config(&vdev->pdev, IGD_GMCH, sizeof(gmch));
1450c4c45e94SAlex Williamson     ggms = (gmch >> (gen < 8 ? 8 : 6)) & 0x3;
1451c4c45e94SAlex Williamson     if (gen > 6) {
1452c4c45e94SAlex Williamson         ggms = 1 << ggms;
1453c4c45e94SAlex Williamson     }
1454c4c45e94SAlex Williamson 
1455e0255bb1SPhilippe Mathieu-Daudé     ggms *= MiB;
1456c4c45e94SAlex Williamson 
1457e0255bb1SPhilippe Mathieu-Daudé     return (ggms / (4 * KiB)) * (gen < 8 ? 4 : 8);
1458c4c45e94SAlex Williamson }
1459c4c45e94SAlex Williamson 
1460c4c45e94SAlex Williamson /*
1461c4c45e94SAlex Williamson  * The IGD ROM will make use of stolen memory (GGMS) for support of VESA modes.
1462c4c45e94SAlex Williamson  * Somehow the host stolen memory range is used for this, but how the ROM gets
1463c4c45e94SAlex Williamson  * it is a mystery, perhaps it's hardcoded into the ROM.  Thankfully though, it
1464c4c45e94SAlex Williamson  * reprograms the GTT through the IOBAR where we can trap it and transpose the
1465c4c45e94SAlex Williamson  * programming to the VM allocated buffer.  That buffer gets reserved by the VM
1466c4c45e94SAlex Williamson  * firmware via the fw_cfg entry added below.  Here we're just monitoring the
1467c4c45e94SAlex Williamson  * IOBAR address and data registers to detect a write sequence targeting the
1468c4c45e94SAlex Williamson  * GTTADR.  This code is developed by observed behavior and doesn't have a
1469c4c45e94SAlex Williamson  * direct spec reference, unfortunately.
1470c4c45e94SAlex Williamson  */
1471c4c45e94SAlex Williamson static uint64_t vfio_igd_quirk_data_read(void *opaque,
1472c4c45e94SAlex Williamson                                          hwaddr addr, unsigned size)
1473c4c45e94SAlex Williamson {
1474c4c45e94SAlex Williamson     VFIOIGDQuirk *igd = opaque;
1475c4c45e94SAlex Williamson     VFIOPCIDevice *vdev = igd->vdev;
1476c4c45e94SAlex Williamson 
1477c4c45e94SAlex Williamson     igd->index = ~0;
1478c4c45e94SAlex Williamson 
1479c4c45e94SAlex Williamson     return vfio_region_read(&vdev->bars[4].region, addr + 4, size);
1480c4c45e94SAlex Williamson }
1481c4c45e94SAlex Williamson 
1482c4c45e94SAlex Williamson static void vfio_igd_quirk_data_write(void *opaque, hwaddr addr,
1483c4c45e94SAlex Williamson                                       uint64_t data, unsigned size)
1484c4c45e94SAlex Williamson {
1485c4c45e94SAlex Williamson     VFIOIGDQuirk *igd = opaque;
1486c4c45e94SAlex Williamson     VFIOPCIDevice *vdev = igd->vdev;
1487c4c45e94SAlex Williamson     uint64_t val = data;
1488c4c45e94SAlex Williamson     int gen = igd_gen(vdev);
1489c4c45e94SAlex Williamson 
1490c4c45e94SAlex Williamson     /*
1491c4c45e94SAlex Williamson      * Programming the GGMS starts at index 0x1 and uses every 4th index (ie.
1492c4c45e94SAlex Williamson      * 0x1, 0x5, 0x9, 0xd,...).  For pre-Gen8 each 4-byte write is a whole PTE
1493c4c45e94SAlex Williamson      * entry, with 0th bit enable set.  For Gen8 and up, PTEs are 64bit, so
1494c4c45e94SAlex Williamson      * entries 0x5 & 0xd are the high dword, in our case zero.  Each PTE points
1495c4c45e94SAlex Williamson      * to a 4k page, which we translate to a page from the VM allocated region,
1496c4c45e94SAlex Williamson      * pointed to by the BDSM register.  If this is not set, we fail.
1497c4c45e94SAlex Williamson      *
1498c4c45e94SAlex Williamson      * We trap writes to the full configured GTT size, but we typically only
1499c4c45e94SAlex Williamson      * see the vBIOS writing up to (nearly) the 1MB barrier.  In fact it often
1500c4c45e94SAlex Williamson      * seems to miss the last entry for an even 1MB GTT.  Doing a gratuitous
1501c4c45e94SAlex Williamson      * write of that last entry does work, but is hopefully unnecessary since
1502c4c45e94SAlex Williamson      * we clear the previous GTT on initialization.
1503c4c45e94SAlex Williamson      */
1504c4c45e94SAlex Williamson     if ((igd->index % 4 == 1) && igd->index < vfio_igd_gtt_max(vdev)) {
1505c4c45e94SAlex Williamson         if (gen < 8 || (igd->index % 8 == 1)) {
1506c4c45e94SAlex Williamson             uint32_t base;
1507c4c45e94SAlex Williamson 
1508c4c45e94SAlex Williamson             base = pci_get_long(vdev->pdev.config + IGD_BDSM);
1509c4c45e94SAlex Williamson             if (!base) {
1510c4c45e94SAlex Williamson                 hw_error("vfio-igd: Guest attempted to program IGD GTT before "
1511c4c45e94SAlex Williamson                          "BIOS reserved stolen memory.  Unsupported BIOS?");
1512c4c45e94SAlex Williamson             }
1513c4c45e94SAlex Williamson 
1514ac2a9862SAlex Williamson             val = data - igd->bdsm + base;
1515c4c45e94SAlex Williamson         } else {
1516c4c45e94SAlex Williamson             val = 0; /* upper 32bits of pte, we only enable below 4G PTEs */
1517c4c45e94SAlex Williamson         }
1518c4c45e94SAlex Williamson 
1519c4c45e94SAlex Williamson         trace_vfio_pci_igd_bar4_write(vdev->vbasedev.name,
1520c4c45e94SAlex Williamson                                       igd->index, data, val);
1521c4c45e94SAlex Williamson     }
1522c4c45e94SAlex Williamson 
1523c4c45e94SAlex Williamson     vfio_region_write(&vdev->bars[4].region, addr + 4, val, size);
1524c4c45e94SAlex Williamson 
1525c4c45e94SAlex Williamson     igd->index = ~0;
1526c4c45e94SAlex Williamson }
1527c4c45e94SAlex Williamson 
1528c4c45e94SAlex Williamson static const MemoryRegionOps vfio_igd_data_quirk = {
1529c4c45e94SAlex Williamson     .read = vfio_igd_quirk_data_read,
1530c4c45e94SAlex Williamson     .write = vfio_igd_quirk_data_write,
1531c4c45e94SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
1532c4c45e94SAlex Williamson };
1533c4c45e94SAlex Williamson 
1534c4c45e94SAlex Williamson static uint64_t vfio_igd_quirk_index_read(void *opaque,
1535c4c45e94SAlex Williamson                                           hwaddr addr, unsigned size)
1536c4c45e94SAlex Williamson {
1537c4c45e94SAlex Williamson     VFIOIGDQuirk *igd = opaque;
1538c4c45e94SAlex Williamson     VFIOPCIDevice *vdev = igd->vdev;
1539c4c45e94SAlex Williamson 
1540c4c45e94SAlex Williamson     igd->index = ~0;
1541c4c45e94SAlex Williamson 
1542c4c45e94SAlex Williamson     return vfio_region_read(&vdev->bars[4].region, addr, size);
1543c4c45e94SAlex Williamson }
1544c4c45e94SAlex Williamson 
1545c4c45e94SAlex Williamson static void vfio_igd_quirk_index_write(void *opaque, hwaddr addr,
1546c4c45e94SAlex Williamson                                        uint64_t data, unsigned size)
1547c4c45e94SAlex Williamson {
1548c4c45e94SAlex Williamson     VFIOIGDQuirk *igd = opaque;
1549c4c45e94SAlex Williamson     VFIOPCIDevice *vdev = igd->vdev;
1550c4c45e94SAlex Williamson 
1551c4c45e94SAlex Williamson     igd->index = data;
1552c4c45e94SAlex Williamson 
1553c4c45e94SAlex Williamson     vfio_region_write(&vdev->bars[4].region, addr, data, size);
1554c4c45e94SAlex Williamson }
1555c4c45e94SAlex Williamson 
1556c4c45e94SAlex Williamson static const MemoryRegionOps vfio_igd_index_quirk = {
1557c4c45e94SAlex Williamson     .read = vfio_igd_quirk_index_read,
1558c4c45e94SAlex Williamson     .write = vfio_igd_quirk_index_write,
1559c4c45e94SAlex Williamson     .endianness = DEVICE_LITTLE_ENDIAN,
1560c4c45e94SAlex Williamson };
1561c4c45e94SAlex Williamson 
1562c4c45e94SAlex Williamson static void vfio_probe_igd_bar4_quirk(VFIOPCIDevice *vdev, int nr)
1563c4c45e94SAlex Williamson {
1564c4c45e94SAlex Williamson     struct vfio_region_info *rom = NULL, *opregion = NULL,
1565c4c45e94SAlex Williamson                             *host = NULL, *lpc = NULL;
1566c4c45e94SAlex Williamson     VFIOQuirk *quirk;
1567c4c45e94SAlex Williamson     VFIOIGDQuirk *igd;
1568c4c45e94SAlex Williamson     PCIDevice *lpc_bridge;
1569c4c45e94SAlex Williamson     int i, ret, ggms_mb, gms_mb = 0, gen;
1570c4c45e94SAlex Williamson     uint64_t *bdsm_size;
1571c4c45e94SAlex Williamson     uint32_t gmch;
1572c4c45e94SAlex Williamson     uint16_t cmd_orig, cmd;
1573cde4279bSEric Auger     Error *err = NULL;
1574c4c45e94SAlex Williamson 
157593587e3aSXiong Zhang     /*
157693587e3aSXiong Zhang      * This must be an Intel VGA device at address 00:02.0 for us to even
157793587e3aSXiong Zhang      * consider enabling legacy mode.  The vBIOS has dependencies on the
157893587e3aSXiong Zhang      * PCI bus address.
157993587e3aSXiong Zhang      */
1580c4c45e94SAlex Williamson     if (!vfio_pci_is(vdev, PCI_VENDOR_ID_INTEL, PCI_ANY_ID) ||
158193587e3aSXiong Zhang         !vfio_is_vga(vdev) || nr != 4 ||
158293587e3aSXiong Zhang         &vdev->pdev != pci_find_device(pci_device_root_bus(&vdev->pdev),
1583c4c45e94SAlex Williamson                                        0, PCI_DEVFN(0x2, 0))) {
1584c4c45e94SAlex Williamson         return;
1585c4c45e94SAlex Williamson     }
1586c4c45e94SAlex Williamson 
1587c4c45e94SAlex Williamson     /*
1588c4c45e94SAlex Williamson      * We need to create an LPC/ISA bridge at PCI bus address 00:1f.0 that we
1589c4c45e94SAlex Williamson      * can stuff host values into, so if there's already one there and it's not
1590c4c45e94SAlex Williamson      * one we can hack on, legacy mode is no-go.  Sorry Q35.
1591c4c45e94SAlex Williamson      */
1592c4c45e94SAlex Williamson     lpc_bridge = pci_find_device(pci_device_root_bus(&vdev->pdev),
1593c4c45e94SAlex Williamson                                  0, PCI_DEVFN(0x1f, 0));
1594c4c45e94SAlex Williamson     if (lpc_bridge && !object_dynamic_cast(OBJECT(lpc_bridge),
1595c4c45e94SAlex Williamson                                            "vfio-pci-igd-lpc-bridge")) {
1596c4c45e94SAlex Williamson         error_report("IGD device %s cannot support legacy mode due to existing "
1597c4c45e94SAlex Williamson                      "devices at address 1f.0", vdev->vbasedev.name);
1598c4c45e94SAlex Williamson         return;
1599c4c45e94SAlex Williamson     }
1600c4c45e94SAlex Williamson 
1601c4c45e94SAlex Williamson     /*
160293587e3aSXiong Zhang      * IGD is not a standard, they like to change their specs often.  We
160393587e3aSXiong Zhang      * only attempt to support back to SandBridge and we hope that newer
160493587e3aSXiong Zhang      * devices maintain compatibility with generation 8.
160593587e3aSXiong Zhang      */
160693587e3aSXiong Zhang     gen = igd_gen(vdev);
160793587e3aSXiong Zhang     if (gen != 6 && gen != 8) {
160893587e3aSXiong Zhang         error_report("IGD device %s is unsupported in legacy mode, "
160993587e3aSXiong Zhang                      "try SandyBridge or newer", vdev->vbasedev.name);
161093587e3aSXiong Zhang         return;
161193587e3aSXiong Zhang     }
161293587e3aSXiong Zhang 
161393587e3aSXiong Zhang     /*
1614c4c45e94SAlex Williamson      * Most of what we're doing here is to enable the ROM to run, so if
1615c4c45e94SAlex Williamson      * there's no ROM, there's no point in setting up this quirk.
1616c4c45e94SAlex Williamson      * NB. We only seem to get BIOS ROMs, so a UEFI VM would need CSM support.
1617c4c45e94SAlex Williamson      */
1618c4c45e94SAlex Williamson     ret = vfio_get_region_info(&vdev->vbasedev,
1619c4c45e94SAlex Williamson                                VFIO_PCI_ROM_REGION_INDEX, &rom);
1620c4c45e94SAlex Williamson     if ((ret || !rom->size) && !vdev->pdev.romfile) {
1621c4c45e94SAlex Williamson         error_report("IGD device %s has no ROM, legacy mode disabled",
1622c4c45e94SAlex Williamson                      vdev->vbasedev.name);
1623c4c45e94SAlex Williamson         goto out;
1624c4c45e94SAlex Williamson     }
1625c4c45e94SAlex Williamson 
1626c4c45e94SAlex Williamson     /*
1627c4c45e94SAlex Williamson      * Ignore the hotplug corner case, mark the ROM failed, we can't
1628c4c45e94SAlex Williamson      * create the devices we need for legacy mode in the hotplug scenario.
1629c4c45e94SAlex Williamson      */
1630c4c45e94SAlex Williamson     if (vdev->pdev.qdev.hotplugged) {
1631c4c45e94SAlex Williamson         error_report("IGD device %s hotplugged, ROM disabled, "
1632c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1633c4c45e94SAlex Williamson         vdev->rom_read_failed = true;
1634c4c45e94SAlex Williamson         goto out;
1635c4c45e94SAlex Williamson     }
1636c4c45e94SAlex Williamson 
1637c4c45e94SAlex Williamson     /*
1638c4c45e94SAlex Williamson      * Check whether we have all the vfio device specific regions to
1639c4c45e94SAlex Williamson      * support legacy mode (added in Linux v4.6).  If not, bail.
1640c4c45e94SAlex Williamson      */
1641c4c45e94SAlex Williamson     ret = vfio_get_dev_region_info(&vdev->vbasedev,
1642c4c45e94SAlex Williamson                         VFIO_REGION_TYPE_PCI_VENDOR_TYPE | PCI_VENDOR_ID_INTEL,
1643c4c45e94SAlex Williamson                         VFIO_REGION_SUBTYPE_INTEL_IGD_OPREGION, &opregion);
1644c4c45e94SAlex Williamson     if (ret) {
1645c4c45e94SAlex Williamson         error_report("IGD device %s does not support OpRegion access,"
1646c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1647c4c45e94SAlex Williamson         goto out;
1648c4c45e94SAlex Williamson     }
1649c4c45e94SAlex Williamson 
1650c4c45e94SAlex Williamson     ret = vfio_get_dev_region_info(&vdev->vbasedev,
1651c4c45e94SAlex Williamson                         VFIO_REGION_TYPE_PCI_VENDOR_TYPE | PCI_VENDOR_ID_INTEL,
1652c4c45e94SAlex Williamson                         VFIO_REGION_SUBTYPE_INTEL_IGD_HOST_CFG, &host);
1653c4c45e94SAlex Williamson     if (ret) {
1654c4c45e94SAlex Williamson         error_report("IGD device %s does not support host bridge access,"
1655c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1656c4c45e94SAlex Williamson         goto out;
1657c4c45e94SAlex Williamson     }
1658c4c45e94SAlex Williamson 
1659c4c45e94SAlex Williamson     ret = vfio_get_dev_region_info(&vdev->vbasedev,
1660c4c45e94SAlex Williamson                         VFIO_REGION_TYPE_PCI_VENDOR_TYPE | PCI_VENDOR_ID_INTEL,
1661c4c45e94SAlex Williamson                         VFIO_REGION_SUBTYPE_INTEL_IGD_LPC_CFG, &lpc);
1662c4c45e94SAlex Williamson     if (ret) {
1663c4c45e94SAlex Williamson         error_report("IGD device %s does not support LPC bridge access,"
1664c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1665c4c45e94SAlex Williamson         goto out;
1666c4c45e94SAlex Williamson     }
1667c4c45e94SAlex Williamson 
166893587e3aSXiong Zhang     gmch = vfio_pci_read_config(&vdev->pdev, IGD_GMCH, 4);
166993587e3aSXiong Zhang 
1670c4c45e94SAlex Williamson     /*
1671c4c45e94SAlex Williamson      * If IGD VGA Disable is clear (expected) and VGA is not already enabled,
1672c4c45e94SAlex Williamson      * try to enable it.  Probably shouldn't be using legacy mode without VGA,
1673c4c45e94SAlex Williamson      * but also no point in us enabling VGA if disabled in hardware.
1674c4c45e94SAlex Williamson      */
1675cde4279bSEric Auger     if (!(gmch & 0x2) && !vdev->vga && vfio_populate_vga(vdev, &err)) {
1676c3b8e3e0SMarkus Armbruster         error_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
1677c4c45e94SAlex Williamson         error_report("IGD device %s failed to enable VGA access, "
1678c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1679c4c45e94SAlex Williamson         goto out;
1680c4c45e94SAlex Williamson     }
1681c4c45e94SAlex Williamson 
1682c4c45e94SAlex Williamson     /* Create our LPC/ISA bridge */
1683c4c45e94SAlex Williamson     ret = vfio_pci_igd_lpc_init(vdev, lpc);
1684c4c45e94SAlex Williamson     if (ret) {
1685c4c45e94SAlex Williamson         error_report("IGD device %s failed to create LPC bridge, "
1686c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1687c4c45e94SAlex Williamson         goto out;
1688c4c45e94SAlex Williamson     }
1689c4c45e94SAlex Williamson 
1690c4c45e94SAlex Williamson     /* Stuff some host values into the VM PCI host bridge */
1691c4c45e94SAlex Williamson     ret = vfio_pci_igd_host_init(vdev, host);
1692c4c45e94SAlex Williamson     if (ret) {
1693c4c45e94SAlex Williamson         error_report("IGD device %s failed to modify host bridge, "
1694c4c45e94SAlex Williamson                      "legacy mode disabled", vdev->vbasedev.name);
1695c4c45e94SAlex Williamson         goto out;
1696c4c45e94SAlex Williamson     }
1697c4c45e94SAlex Williamson 
1698c4c45e94SAlex Williamson     /* Setup OpRegion access */
16997237011dSEric Auger     ret = vfio_pci_igd_opregion_init(vdev, opregion, &err);
1700c4c45e94SAlex Williamson     if (ret) {
17017237011dSEric Auger         error_append_hint(&err, "IGD legacy mode disabled\n");
1702c3b8e3e0SMarkus Armbruster         error_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
1703c4c45e94SAlex Williamson         goto out;
1704c4c45e94SAlex Williamson     }
1705c4c45e94SAlex Williamson 
1706c4c45e94SAlex Williamson     /* Setup our quirk to munge GTT addresses to the VM allocated buffer */
1707bcf3c3d0SAlex Williamson     quirk = vfio_quirk_alloc(2);
1708c4c45e94SAlex Williamson     igd = quirk->data = g_malloc0(sizeof(*igd));
1709c4c45e94SAlex Williamson     igd->vdev = vdev;
1710c4c45e94SAlex Williamson     igd->index = ~0;
1711ac2a9862SAlex Williamson     igd->bdsm = vfio_pci_read_config(&vdev->pdev, IGD_BDSM, 4);
1712e0255bb1SPhilippe Mathieu-Daudé     igd->bdsm &= ~((1 * MiB) - 1); /* 1MB aligned */
1713c4c45e94SAlex Williamson 
1714c4c45e94SAlex Williamson     memory_region_init_io(&quirk->mem[0], OBJECT(vdev), &vfio_igd_index_quirk,
1715c4c45e94SAlex Williamson                           igd, "vfio-igd-index-quirk", 4);
1716c4c45e94SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
1717c4c45e94SAlex Williamson                                         0, &quirk->mem[0], 1);
1718c4c45e94SAlex Williamson 
1719c4c45e94SAlex Williamson     memory_region_init_io(&quirk->mem[1], OBJECT(vdev), &vfio_igd_data_quirk,
1720c4c45e94SAlex Williamson                           igd, "vfio-igd-data-quirk", 4);
1721c4c45e94SAlex Williamson     memory_region_add_subregion_overlap(vdev->bars[nr].region.mem,
1722c4c45e94SAlex Williamson                                         4, &quirk->mem[1], 1);
1723c4c45e94SAlex Williamson 
1724c4c45e94SAlex Williamson     QLIST_INSERT_HEAD(&vdev->bars[nr].quirks, quirk, next);
1725c4c45e94SAlex Williamson 
1726c4c45e94SAlex Williamson     /* Determine the size of stolen memory needed for GTT */
1727c4c45e94SAlex Williamson     ggms_mb = (gmch >> (gen < 8 ? 8 : 6)) & 0x3;
1728c4c45e94SAlex Williamson     if (gen > 6) {
1729c4c45e94SAlex Williamson         ggms_mb = 1 << ggms_mb;
1730c4c45e94SAlex Williamson     }
1731c4c45e94SAlex Williamson 
1732c4c45e94SAlex Williamson     /*
1733c4c45e94SAlex Williamson      * Assume we have no GMS memory, but allow it to be overrided by device
1734c4c45e94SAlex Williamson      * option (experimental).  The spec doesn't actually allow zero GMS when
1735c4c45e94SAlex Williamson      * when IVD (IGD VGA Disable) is clear, but the claim is that it's unused,
1736c4c45e94SAlex Williamson      * so let's not waste VM memory for it.
1737c4c45e94SAlex Williamson      */
173893587e3aSXiong Zhang     gmch &= ~((gen < 8 ? 0x1f : 0xff) << (gen < 8 ? 3 : 8));
173993587e3aSXiong Zhang 
1740c4c45e94SAlex Williamson     if (vdev->igd_gms) {
1741c4c45e94SAlex Williamson         if (vdev->igd_gms <= 0x10) {
1742c4c45e94SAlex Williamson             gms_mb = vdev->igd_gms * 32;
1743c4c45e94SAlex Williamson             gmch |= vdev->igd_gms << (gen < 8 ? 3 : 8);
1744c4c45e94SAlex Williamson         } else {
1745c4c45e94SAlex Williamson             error_report("Unsupported IGD GMS value 0x%x", vdev->igd_gms);
1746c4c45e94SAlex Williamson             vdev->igd_gms = 0;
1747c4c45e94SAlex Williamson         }
1748c4c45e94SAlex Williamson     }
1749c4c45e94SAlex Williamson 
1750c4c45e94SAlex Williamson     /*
1751c4c45e94SAlex Williamson      * Request reserved memory for stolen memory via fw_cfg.  VM firmware
1752c4c45e94SAlex Williamson      * must allocate a 1MB aligned reserved memory region below 4GB with
1753c4c45e94SAlex Williamson      * the requested size (in bytes) for use by the Intel PCI class VGA
1754c4c45e94SAlex Williamson      * device at VM address 00:02.0.  The base address of this reserved
1755c4c45e94SAlex Williamson      * memory region must be written to the device BDSM regsiter at PCI
1756c4c45e94SAlex Williamson      * config offset 0x5C.
1757c4c45e94SAlex Williamson      */
1758c4c45e94SAlex Williamson     bdsm_size = g_malloc(sizeof(*bdsm_size));
1759e0255bb1SPhilippe Mathieu-Daudé     *bdsm_size = cpu_to_le64((ggms_mb + gms_mb) * MiB);
1760c4c45e94SAlex Williamson     fw_cfg_add_file(fw_cfg_find(), "etc/igd-bdsm-size",
1761c4c45e94SAlex Williamson                     bdsm_size, sizeof(*bdsm_size));
1762c4c45e94SAlex Williamson 
176393587e3aSXiong Zhang     /* GMCH is read-only, emulated */
176493587e3aSXiong Zhang     pci_set_long(vdev->pdev.config + IGD_GMCH, gmch);
176593587e3aSXiong Zhang     pci_set_long(vdev->pdev.wmask + IGD_GMCH, 0);
176693587e3aSXiong Zhang     pci_set_long(vdev->emulated_config_bits + IGD_GMCH, ~0);
176793587e3aSXiong Zhang 
1768c4c45e94SAlex Williamson     /* BDSM is read-write, emulated.  The BIOS needs to be able to write it */
1769c4c45e94SAlex Williamson     pci_set_long(vdev->pdev.config + IGD_BDSM, 0);
1770c4c45e94SAlex Williamson     pci_set_long(vdev->pdev.wmask + IGD_BDSM, ~0);
1771c4c45e94SAlex Williamson     pci_set_long(vdev->emulated_config_bits + IGD_BDSM, ~0);
1772c4c45e94SAlex Williamson 
1773c4c45e94SAlex Williamson     /*
1774c4c45e94SAlex Williamson      * This IOBAR gives us access to GTTADR, which allows us to write to
1775c4c45e94SAlex Williamson      * the GTT itself.  So let's go ahead and write zero to all the GTT
1776c4c45e94SAlex Williamson      * entries to avoid spurious DMA faults.  Be sure I/O access is enabled
1777c4c45e94SAlex Williamson      * before talking to the device.
1778c4c45e94SAlex Williamson      */
1779c4c45e94SAlex Williamson     if (pread(vdev->vbasedev.fd, &cmd_orig, sizeof(cmd_orig),
1780c4c45e94SAlex Williamson               vdev->config_offset + PCI_COMMAND) != sizeof(cmd_orig)) {
1781c4c45e94SAlex Williamson         error_report("IGD device %s - failed to read PCI command register",
1782c4c45e94SAlex Williamson                      vdev->vbasedev.name);
1783c4c45e94SAlex Williamson     }
1784c4c45e94SAlex Williamson 
1785c4c45e94SAlex Williamson     cmd = cmd_orig | PCI_COMMAND_IO;
1786c4c45e94SAlex Williamson 
1787c4c45e94SAlex Williamson     if (pwrite(vdev->vbasedev.fd, &cmd, sizeof(cmd),
1788c4c45e94SAlex Williamson                vdev->config_offset + PCI_COMMAND) != sizeof(cmd)) {
1789c4c45e94SAlex Williamson         error_report("IGD device %s - failed to write PCI command register",
1790c4c45e94SAlex Williamson                      vdev->vbasedev.name);
1791c4c45e94SAlex Williamson     }
1792c4c45e94SAlex Williamson 
1793c4c45e94SAlex Williamson     for (i = 1; i < vfio_igd_gtt_max(vdev); i += 4) {
1794c4c45e94SAlex Williamson         vfio_region_write(&vdev->bars[4].region, 0, i, 4);
1795c4c45e94SAlex Williamson         vfio_region_write(&vdev->bars[4].region, 4, 0, 4);
1796c4c45e94SAlex Williamson     }
1797c4c45e94SAlex Williamson 
1798c4c45e94SAlex Williamson     if (pwrite(vdev->vbasedev.fd, &cmd_orig, sizeof(cmd_orig),
1799c4c45e94SAlex Williamson                vdev->config_offset + PCI_COMMAND) != sizeof(cmd_orig)) {
1800c4c45e94SAlex Williamson         error_report("IGD device %s - failed to restore PCI command register",
1801c4c45e94SAlex Williamson                      vdev->vbasedev.name);
1802c4c45e94SAlex Williamson     }
1803c4c45e94SAlex Williamson 
1804c4c45e94SAlex Williamson     trace_vfio_pci_igd_bdsm_enabled(vdev->vbasedev.name, ggms_mb + gms_mb);
1805c4c45e94SAlex Williamson 
1806c4c45e94SAlex Williamson out:
1807c4c45e94SAlex Williamson     g_free(rom);
1808c4c45e94SAlex Williamson     g_free(opregion);
1809c4c45e94SAlex Williamson     g_free(host);
1810c4c45e94SAlex Williamson     g_free(lpc);
1811c4c45e94SAlex Williamson }
1812c4c45e94SAlex Williamson 
1813c4c45e94SAlex Williamson /*
1814c00d61d8SAlex Williamson  * Common quirk probe entry points.
1815c00d61d8SAlex Williamson  */
1816c00d61d8SAlex Williamson void vfio_vga_quirk_setup(VFIOPCIDevice *vdev)
1817c00d61d8SAlex Williamson {
1818c00d61d8SAlex Williamson     vfio_vga_probe_ati_3c3_quirk(vdev);
1819c00d61d8SAlex Williamson     vfio_vga_probe_nvidia_3d0_quirk(vdev);
1820c00d61d8SAlex Williamson }
1821c00d61d8SAlex Williamson 
18222d82f8a3SAlex Williamson void vfio_vga_quirk_exit(VFIOPCIDevice *vdev)
1823c00d61d8SAlex Williamson {
1824c00d61d8SAlex Williamson     VFIOQuirk *quirk;
18258c4f2348SAlex Williamson     int i, j;
1826c00d61d8SAlex Williamson 
18272d82f8a3SAlex Williamson     for (i = 0; i < ARRAY_SIZE(vdev->vga->region); i++) {
18282d82f8a3SAlex Williamson         QLIST_FOREACH(quirk, &vdev->vga->region[i].quirks, next) {
18298c4f2348SAlex Williamson             for (j = 0; j < quirk->nr_mem; j++) {
18302d82f8a3SAlex Williamson                 memory_region_del_subregion(&vdev->vga->region[i].mem,
18318c4f2348SAlex Williamson                                             &quirk->mem[j]);
18328c4f2348SAlex Williamson             }
1833c00d61d8SAlex Williamson         }
1834c00d61d8SAlex Williamson     }
1835c00d61d8SAlex Williamson }
1836c00d61d8SAlex Williamson 
18372d82f8a3SAlex Williamson void vfio_vga_quirk_finalize(VFIOPCIDevice *vdev)
1838c00d61d8SAlex Williamson {
18398c4f2348SAlex Williamson     int i, j;
1840c00d61d8SAlex Williamson 
18412d82f8a3SAlex Williamson     for (i = 0; i < ARRAY_SIZE(vdev->vga->region); i++) {
18422d82f8a3SAlex Williamson         while (!QLIST_EMPTY(&vdev->vga->region[i].quirks)) {
18432d82f8a3SAlex Williamson             VFIOQuirk *quirk = QLIST_FIRST(&vdev->vga->region[i].quirks);
1844c00d61d8SAlex Williamson             QLIST_REMOVE(quirk, next);
18458c4f2348SAlex Williamson             for (j = 0; j < quirk->nr_mem; j++) {
18468c4f2348SAlex Williamson                 object_unparent(OBJECT(&quirk->mem[j]));
18478c4f2348SAlex Williamson             }
18488c4f2348SAlex Williamson             g_free(quirk->mem);
18498c4f2348SAlex Williamson             g_free(quirk->data);
1850c00d61d8SAlex Williamson             g_free(quirk);
1851c00d61d8SAlex Williamson         }
1852c00d61d8SAlex Williamson     }
1853c00d61d8SAlex Williamson }
1854c00d61d8SAlex Williamson 
1855c00d61d8SAlex Williamson void vfio_bar_quirk_setup(VFIOPCIDevice *vdev, int nr)
1856c00d61d8SAlex Williamson {
18570e54f24aSAlex Williamson     vfio_probe_ati_bar4_quirk(vdev, nr);
18580d38fb1cSAlex Williamson     vfio_probe_ati_bar2_quirk(vdev, nr);
18590e54f24aSAlex Williamson     vfio_probe_nvidia_bar5_quirk(vdev, nr);
18600d38fb1cSAlex Williamson     vfio_probe_nvidia_bar0_quirk(vdev, nr);
1861954258a5SAlex Williamson     vfio_probe_rtl8168_bar2_quirk(vdev, nr);
1862c4c45e94SAlex Williamson     vfio_probe_igd_bar4_quirk(vdev, nr);
1863c00d61d8SAlex Williamson }
1864c00d61d8SAlex Williamson 
18652d82f8a3SAlex Williamson void vfio_bar_quirk_exit(VFIOPCIDevice *vdev, int nr)
1866c00d61d8SAlex Williamson {
1867c00d61d8SAlex Williamson     VFIOBAR *bar = &vdev->bars[nr];
1868c00d61d8SAlex Williamson     VFIOQuirk *quirk;
18698c4f2348SAlex Williamson     int i;
1870c00d61d8SAlex Williamson 
1871c00d61d8SAlex Williamson     QLIST_FOREACH(quirk, &bar->quirks, next) {
1872c958c51dSAlex Williamson         while (!QLIST_EMPTY(&quirk->ioeventfds)) {
18732b1dbd0dSAlex Williamson             vfio_ioeventfd_exit(vdev, QLIST_FIRST(&quirk->ioeventfds));
1874c958c51dSAlex Williamson         }
1875c958c51dSAlex Williamson 
18768c4f2348SAlex Williamson         for (i = 0; i < quirk->nr_mem; i++) {
1877db0da029SAlex Williamson             memory_region_del_subregion(bar->region.mem, &quirk->mem[i]);
18788c4f2348SAlex Williamson         }
1879c00d61d8SAlex Williamson     }
1880c00d61d8SAlex Williamson }
1881c00d61d8SAlex Williamson 
18822d82f8a3SAlex Williamson void vfio_bar_quirk_finalize(VFIOPCIDevice *vdev, int nr)
1883c00d61d8SAlex Williamson {
1884c00d61d8SAlex Williamson     VFIOBAR *bar = &vdev->bars[nr];
18858c4f2348SAlex Williamson     int i;
1886c00d61d8SAlex Williamson 
1887c00d61d8SAlex Williamson     while (!QLIST_EMPTY(&bar->quirks)) {
1888c00d61d8SAlex Williamson         VFIOQuirk *quirk = QLIST_FIRST(&bar->quirks);
1889c00d61d8SAlex Williamson         QLIST_REMOVE(quirk, next);
18908c4f2348SAlex Williamson         for (i = 0; i < quirk->nr_mem; i++) {
18918c4f2348SAlex Williamson             object_unparent(OBJECT(&quirk->mem[i]));
18928c4f2348SAlex Williamson         }
18938c4f2348SAlex Williamson         g_free(quirk->mem);
18948c4f2348SAlex Williamson         g_free(quirk->data);
1895c00d61d8SAlex Williamson         g_free(quirk);
1896c00d61d8SAlex Williamson     }
1897c00d61d8SAlex Williamson }
1898c9c50009SAlex Williamson 
1899c9c50009SAlex Williamson /*
1900c9c50009SAlex Williamson  * Reset quirks
1901c9c50009SAlex Williamson  */
1902469d02deSAlex Williamson void vfio_quirk_reset(VFIOPCIDevice *vdev)
1903469d02deSAlex Williamson {
1904469d02deSAlex Williamson     int i;
1905469d02deSAlex Williamson 
1906469d02deSAlex Williamson     for (i = 0; i < PCI_ROM_SLOT; i++) {
1907469d02deSAlex Williamson         VFIOQuirk *quirk;
1908469d02deSAlex Williamson         VFIOBAR *bar = &vdev->bars[i];
1909469d02deSAlex Williamson 
1910469d02deSAlex Williamson         QLIST_FOREACH(quirk, &bar->quirks, next) {
1911469d02deSAlex Williamson             if (quirk->reset) {
1912469d02deSAlex Williamson                 quirk->reset(vdev, quirk);
1913469d02deSAlex Williamson             }
1914469d02deSAlex Williamson         }
1915469d02deSAlex Williamson     }
1916469d02deSAlex Williamson }
1917c9c50009SAlex Williamson 
1918c9c50009SAlex Williamson /*
1919c9c50009SAlex Williamson  * AMD Radeon PCI config reset, based on Linux:
1920c9c50009SAlex Williamson  *   drivers/gpu/drm/radeon/ci_smc.c:ci_is_smc_running()
1921c9c50009SAlex Williamson  *   drivers/gpu/drm/radeon/radeon_device.c:radeon_pci_config_reset
1922c9c50009SAlex Williamson  *   drivers/gpu/drm/radeon/ci_smc.c:ci_reset_smc()
1923c9c50009SAlex Williamson  *   drivers/gpu/drm/radeon/ci_smc.c:ci_stop_smc_clock()
1924c9c50009SAlex Williamson  * IDs: include/drm/drm_pciids.h
1925c9c50009SAlex Williamson  * Registers: http://cgit.freedesktop.org/~agd5f/linux/commit/?id=4e2aa447f6f0
1926c9c50009SAlex Williamson  *
1927c9c50009SAlex Williamson  * Bonaire and Hawaii GPUs do not respond to a bus reset.  This is a bug in the
1928c9c50009SAlex Williamson  * hardware that should be fixed on future ASICs.  The symptom of this is that
1929c9c50009SAlex Williamson  * once the accerlated driver loads, Windows guests will bsod on subsequent
1930c9c50009SAlex Williamson  * attmpts to load the driver, such as after VM reset or shutdown/restart.  To
1931c9c50009SAlex Williamson  * work around this, we do an AMD specific PCI config reset, followed by an SMC
1932c9c50009SAlex Williamson  * reset.  The PCI config reset only works if SMC firmware is running, so we
1933c9c50009SAlex Williamson  * have a dependency on the state of the device as to whether this reset will
1934c9c50009SAlex Williamson  * be effective.  There are still cases where we won't be able to kick the
1935c9c50009SAlex Williamson  * device into working, but this greatly improves the usability overall.  The
1936c9c50009SAlex Williamson  * config reset magic is relatively common on AMD GPUs, but the setup and SMC
1937c9c50009SAlex Williamson  * poking is largely ASIC specific.
1938c9c50009SAlex Williamson  */
1939c9c50009SAlex Williamson static bool vfio_radeon_smc_is_running(VFIOPCIDevice *vdev)
1940c9c50009SAlex Williamson {
1941c9c50009SAlex Williamson     uint32_t clk, pc_c;
1942c9c50009SAlex Williamson 
1943c9c50009SAlex Williamson     /*
1944c9c50009SAlex Williamson      * Registers 200h and 204h are index and data registers for accessing
1945c9c50009SAlex Williamson      * indirect configuration registers within the device.
1946c9c50009SAlex Williamson      */
1947c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x200, 0x80000004, 4);
1948c9c50009SAlex Williamson     clk = vfio_region_read(&vdev->bars[5].region, 0x204, 4);
1949c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x200, 0x80000370, 4);
1950c9c50009SAlex Williamson     pc_c = vfio_region_read(&vdev->bars[5].region, 0x204, 4);
1951c9c50009SAlex Williamson 
1952c9c50009SAlex Williamson     return (!(clk & 1) && (0x20100 <= pc_c));
1953c9c50009SAlex Williamson }
1954c9c50009SAlex Williamson 
1955c9c50009SAlex Williamson /*
1956c9c50009SAlex Williamson  * The scope of a config reset is controlled by a mode bit in the misc register
1957c9c50009SAlex Williamson  * and a fuse, exposed as a bit in another register.  The fuse is the default
1958c9c50009SAlex Williamson  * (0 = GFX, 1 = whole GPU), the misc bit is a toggle, with the forumula
1959c9c50009SAlex Williamson  * scope = !(misc ^ fuse), where the resulting scope is defined the same as
1960c9c50009SAlex Williamson  * the fuse.  A truth table therefore tells us that if misc == fuse, we need
1961c9c50009SAlex Williamson  * to flip the value of the bit in the misc register.
1962c9c50009SAlex Williamson  */
1963c9c50009SAlex Williamson static void vfio_radeon_set_gfx_only_reset(VFIOPCIDevice *vdev)
1964c9c50009SAlex Williamson {
1965c9c50009SAlex Williamson     uint32_t misc, fuse;
1966c9c50009SAlex Williamson     bool a, b;
1967c9c50009SAlex Williamson 
1968c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x200, 0xc00c0000, 4);
1969c9c50009SAlex Williamson     fuse = vfio_region_read(&vdev->bars[5].region, 0x204, 4);
1970c9c50009SAlex Williamson     b = fuse & 64;
1971c9c50009SAlex Williamson 
1972c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x200, 0xc0000010, 4);
1973c9c50009SAlex Williamson     misc = vfio_region_read(&vdev->bars[5].region, 0x204, 4);
1974c9c50009SAlex Williamson     a = misc & 2;
1975c9c50009SAlex Williamson 
1976c9c50009SAlex Williamson     if (a == b) {
1977c9c50009SAlex Williamson         vfio_region_write(&vdev->bars[5].region, 0x204, misc ^ 2, 4);
1978c9c50009SAlex Williamson         vfio_region_read(&vdev->bars[5].region, 0x204, 4); /* flush */
1979c9c50009SAlex Williamson     }
1980c9c50009SAlex Williamson }
1981c9c50009SAlex Williamson 
1982c9c50009SAlex Williamson static int vfio_radeon_reset(VFIOPCIDevice *vdev)
1983c9c50009SAlex Williamson {
1984c9c50009SAlex Williamson     PCIDevice *pdev = &vdev->pdev;
1985c9c50009SAlex Williamson     int i, ret = 0;
1986c9c50009SAlex Williamson     uint32_t data;
1987c9c50009SAlex Williamson 
1988c9c50009SAlex Williamson     /* Defer to a kernel implemented reset */
1989c9c50009SAlex Williamson     if (vdev->vbasedev.reset_works) {
1990c9c50009SAlex Williamson         trace_vfio_quirk_ati_bonaire_reset_skipped(vdev->vbasedev.name);
1991c9c50009SAlex Williamson         return -ENODEV;
1992c9c50009SAlex Williamson     }
1993c9c50009SAlex Williamson 
1994c9c50009SAlex Williamson     /* Enable only memory BAR access */
1995c9c50009SAlex Williamson     vfio_pci_write_config(pdev, PCI_COMMAND, PCI_COMMAND_MEMORY, 2);
1996c9c50009SAlex Williamson 
1997c9c50009SAlex Williamson     /* Reset only works if SMC firmware is loaded and running */
1998c9c50009SAlex Williamson     if (!vfio_radeon_smc_is_running(vdev)) {
1999c9c50009SAlex Williamson         ret = -EINVAL;
2000c9c50009SAlex Williamson         trace_vfio_quirk_ati_bonaire_reset_no_smc(vdev->vbasedev.name);
2001c9c50009SAlex Williamson         goto out;
2002c9c50009SAlex Williamson     }
2003c9c50009SAlex Williamson 
2004c9c50009SAlex Williamson     /* Make sure only the GFX function is reset */
2005c9c50009SAlex Williamson     vfio_radeon_set_gfx_only_reset(vdev);
2006c9c50009SAlex Williamson 
2007c9c50009SAlex Williamson     /* AMD PCI config reset */
2008c9c50009SAlex Williamson     vfio_pci_write_config(pdev, 0x7c, 0x39d5e86b, 4);
2009c9c50009SAlex Williamson     usleep(100);
2010c9c50009SAlex Williamson 
2011c9c50009SAlex Williamson     /* Read back the memory size to make sure we're out of reset */
2012c9c50009SAlex Williamson     for (i = 0; i < 100000; i++) {
2013c9c50009SAlex Williamson         if (vfio_region_read(&vdev->bars[5].region, 0x5428, 4) != 0xffffffff) {
2014c9c50009SAlex Williamson             goto reset_smc;
2015c9c50009SAlex Williamson         }
2016c9c50009SAlex Williamson         usleep(1);
2017c9c50009SAlex Williamson     }
2018c9c50009SAlex Williamson 
2019c9c50009SAlex Williamson     trace_vfio_quirk_ati_bonaire_reset_timeout(vdev->vbasedev.name);
2020c9c50009SAlex Williamson 
2021c9c50009SAlex Williamson reset_smc:
2022c9c50009SAlex Williamson     /* Reset SMC */
2023c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x200, 0x80000000, 4);
2024c9c50009SAlex Williamson     data = vfio_region_read(&vdev->bars[5].region, 0x204, 4);
2025c9c50009SAlex Williamson     data |= 1;
2026c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x204, data, 4);
2027c9c50009SAlex Williamson 
2028c9c50009SAlex Williamson     /* Disable SMC clock */
2029c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x200, 0x80000004, 4);
2030c9c50009SAlex Williamson     data = vfio_region_read(&vdev->bars[5].region, 0x204, 4);
2031c9c50009SAlex Williamson     data |= 1;
2032c9c50009SAlex Williamson     vfio_region_write(&vdev->bars[5].region, 0x204, data, 4);
2033c9c50009SAlex Williamson 
2034c9c50009SAlex Williamson     trace_vfio_quirk_ati_bonaire_reset_done(vdev->vbasedev.name);
2035c9c50009SAlex Williamson 
2036c9c50009SAlex Williamson out:
2037c9c50009SAlex Williamson     /* Restore PCI command register */
2038c9c50009SAlex Williamson     vfio_pci_write_config(pdev, PCI_COMMAND, 0, 2);
2039c9c50009SAlex Williamson 
2040c9c50009SAlex Williamson     return ret;
2041c9c50009SAlex Williamson }
2042c9c50009SAlex Williamson 
2043c9c50009SAlex Williamson void vfio_setup_resetfn_quirk(VFIOPCIDevice *vdev)
2044c9c50009SAlex Williamson {
2045ff635e37SAlex Williamson     switch (vdev->vendor_id) {
2046c9c50009SAlex Williamson     case 0x1002:
2047ff635e37SAlex Williamson         switch (vdev->device_id) {
2048c9c50009SAlex Williamson         /* Bonaire */
2049c9c50009SAlex Williamson         case 0x6649: /* Bonaire [FirePro W5100] */
2050c9c50009SAlex Williamson         case 0x6650:
2051c9c50009SAlex Williamson         case 0x6651:
2052c9c50009SAlex Williamson         case 0x6658: /* Bonaire XTX [Radeon R7 260X] */
2053c9c50009SAlex Williamson         case 0x665c: /* Bonaire XT [Radeon HD 7790/8770 / R9 260 OEM] */
2054c9c50009SAlex Williamson         case 0x665d: /* Bonaire [Radeon R7 200 Series] */
2055c9c50009SAlex Williamson         /* Hawaii */
2056c9c50009SAlex Williamson         case 0x67A0: /* Hawaii XT GL [FirePro W9100] */
2057c9c50009SAlex Williamson         case 0x67A1: /* Hawaii PRO GL [FirePro W8100] */
2058c9c50009SAlex Williamson         case 0x67A2:
2059c9c50009SAlex Williamson         case 0x67A8:
2060c9c50009SAlex Williamson         case 0x67A9:
2061c9c50009SAlex Williamson         case 0x67AA:
2062c9c50009SAlex Williamson         case 0x67B0: /* Hawaii XT [Radeon R9 290X] */
2063c9c50009SAlex Williamson         case 0x67B1: /* Hawaii PRO [Radeon R9 290] */
2064c9c50009SAlex Williamson         case 0x67B8:
2065c9c50009SAlex Williamson         case 0x67B9:
2066c9c50009SAlex Williamson         case 0x67BA:
2067c9c50009SAlex Williamson         case 0x67BE:
2068c9c50009SAlex Williamson             vdev->resetfn = vfio_radeon_reset;
2069c9c50009SAlex Williamson             trace_vfio_quirk_ati_bonaire_reset(vdev->vbasedev.name);
2070c9c50009SAlex Williamson             break;
2071c9c50009SAlex Williamson         }
2072c9c50009SAlex Williamson         break;
2073c9c50009SAlex Williamson     }
2074c9c50009SAlex Williamson }
2075dfbee78dSAlex Williamson 
2076dfbee78dSAlex Williamson /*
2077dfbee78dSAlex Williamson  * The NVIDIA GPUDirect P2P Vendor capability allows the user to specify
2078dfbee78dSAlex Williamson  * devices as a member of a clique.  Devices within the same clique ID
2079dfbee78dSAlex Williamson  * are capable of direct P2P.  It's the user's responsibility that this
2080dfbee78dSAlex Williamson  * is correct.  The spec says that this may reside at any unused config
2081dfbee78dSAlex Williamson  * offset, but reserves and recommends hypervisors place this at C8h.
2082dfbee78dSAlex Williamson  * The spec also states that the hypervisor should place this capability
2083dfbee78dSAlex Williamson  * at the end of the capability list, thus next is defined as 0h.
2084dfbee78dSAlex Williamson  *
2085dfbee78dSAlex Williamson  * +----------------+----------------+----------------+----------------+
2086dfbee78dSAlex Williamson  * | sig 7:0 ('P')  |  vndr len (8h) |    next (0h)   |   cap id (9h)  |
2087dfbee78dSAlex Williamson  * +----------------+----------------+----------------+----------------+
2088dfbee78dSAlex Williamson  * | rsvd 15:7(0h),id 6:3,ver 2:0(0h)|          sig 23:8 ('P2')        |
2089dfbee78dSAlex Williamson  * +---------------------------------+---------------------------------+
2090dfbee78dSAlex Williamson  *
2091dfbee78dSAlex Williamson  * https://lists.gnu.org/archive/html/qemu-devel/2017-08/pdfUda5iEpgOS.pdf
2092dfbee78dSAlex Williamson  */
2093dfbee78dSAlex Williamson static void get_nv_gpudirect_clique_id(Object *obj, Visitor *v,
2094dfbee78dSAlex Williamson                                        const char *name, void *opaque,
2095dfbee78dSAlex Williamson                                        Error **errp)
2096dfbee78dSAlex Williamson {
2097dfbee78dSAlex Williamson     DeviceState *dev = DEVICE(obj);
2098dfbee78dSAlex Williamson     Property *prop = opaque;
2099dfbee78dSAlex Williamson     uint8_t *ptr = qdev_get_prop_ptr(dev, prop);
2100dfbee78dSAlex Williamson 
2101dfbee78dSAlex Williamson     visit_type_uint8(v, name, ptr, errp);
2102dfbee78dSAlex Williamson }
2103dfbee78dSAlex Williamson 
2104dfbee78dSAlex Williamson static void set_nv_gpudirect_clique_id(Object *obj, Visitor *v,
2105dfbee78dSAlex Williamson                                        const char *name, void *opaque,
2106dfbee78dSAlex Williamson                                        Error **errp)
2107dfbee78dSAlex Williamson {
2108dfbee78dSAlex Williamson     DeviceState *dev = DEVICE(obj);
2109dfbee78dSAlex Williamson     Property *prop = opaque;
2110dfbee78dSAlex Williamson     uint8_t value, *ptr = qdev_get_prop_ptr(dev, prop);
2111dfbee78dSAlex Williamson     Error *local_err = NULL;
2112dfbee78dSAlex Williamson 
2113dfbee78dSAlex Williamson     if (dev->realized) {
2114dfbee78dSAlex Williamson         qdev_prop_set_after_realize(dev, name, errp);
2115dfbee78dSAlex Williamson         return;
2116dfbee78dSAlex Williamson     }
2117dfbee78dSAlex Williamson 
2118dfbee78dSAlex Williamson     visit_type_uint8(v, name, &value, &local_err);
2119dfbee78dSAlex Williamson     if (local_err) {
2120dfbee78dSAlex Williamson         error_propagate(errp, local_err);
2121dfbee78dSAlex Williamson         return;
2122dfbee78dSAlex Williamson     }
2123dfbee78dSAlex Williamson 
2124dfbee78dSAlex Williamson     if (value & ~0xF) {
2125dfbee78dSAlex Williamson         error_setg(errp, "Property %s: valid range 0-15", name);
2126dfbee78dSAlex Williamson         return;
2127dfbee78dSAlex Williamson     }
2128dfbee78dSAlex Williamson 
2129dfbee78dSAlex Williamson     *ptr = value;
2130dfbee78dSAlex Williamson }
2131dfbee78dSAlex Williamson 
2132dfbee78dSAlex Williamson const PropertyInfo qdev_prop_nv_gpudirect_clique = {
2133dfbee78dSAlex Williamson     .name = "uint4",
2134dfbee78dSAlex Williamson     .description = "NVIDIA GPUDirect Clique ID (0 - 15)",
2135dfbee78dSAlex Williamson     .get = get_nv_gpudirect_clique_id,
2136dfbee78dSAlex Williamson     .set = set_nv_gpudirect_clique_id,
2137dfbee78dSAlex Williamson };
2138dfbee78dSAlex Williamson 
2139dfbee78dSAlex Williamson static int vfio_add_nv_gpudirect_cap(VFIOPCIDevice *vdev, Error **errp)
2140dfbee78dSAlex Williamson {
2141dfbee78dSAlex Williamson     PCIDevice *pdev = &vdev->pdev;
2142dfbee78dSAlex Williamson     int ret, pos = 0xC8;
2143dfbee78dSAlex Williamson 
2144dfbee78dSAlex Williamson     if (vdev->nv_gpudirect_clique == 0xFF) {
2145dfbee78dSAlex Williamson         return 0;
2146dfbee78dSAlex Williamson     }
2147dfbee78dSAlex Williamson 
2148dfbee78dSAlex Williamson     if (!vfio_pci_is(vdev, PCI_VENDOR_ID_NVIDIA, PCI_ANY_ID)) {
2149dfbee78dSAlex Williamson         error_setg(errp, "NVIDIA GPUDirect Clique ID: invalid device vendor");
2150dfbee78dSAlex Williamson         return -EINVAL;
2151dfbee78dSAlex Williamson     }
2152dfbee78dSAlex Williamson 
2153dfbee78dSAlex Williamson     if (pci_get_byte(pdev->config + PCI_CLASS_DEVICE + 1) !=
2154dfbee78dSAlex Williamson         PCI_BASE_CLASS_DISPLAY) {
2155dfbee78dSAlex Williamson         error_setg(errp, "NVIDIA GPUDirect Clique ID: unsupported PCI class");
2156dfbee78dSAlex Williamson         return -EINVAL;
2157dfbee78dSAlex Williamson     }
2158dfbee78dSAlex Williamson 
2159dfbee78dSAlex Williamson     ret = pci_add_capability(pdev, PCI_CAP_ID_VNDR, pos, 8, errp);
2160dfbee78dSAlex Williamson     if (ret < 0) {
2161dfbee78dSAlex Williamson         error_prepend(errp, "Failed to add NVIDIA GPUDirect cap: ");
2162dfbee78dSAlex Williamson         return ret;
2163dfbee78dSAlex Williamson     }
2164dfbee78dSAlex Williamson 
2165dfbee78dSAlex Williamson     memset(vdev->emulated_config_bits + pos, 0xFF, 8);
2166dfbee78dSAlex Williamson     pos += PCI_CAP_FLAGS;
2167dfbee78dSAlex Williamson     pci_set_byte(pdev->config + pos++, 8);
2168dfbee78dSAlex Williamson     pci_set_byte(pdev->config + pos++, 'P');
2169dfbee78dSAlex Williamson     pci_set_byte(pdev->config + pos++, '2');
2170dfbee78dSAlex Williamson     pci_set_byte(pdev->config + pos++, 'P');
2171dfbee78dSAlex Williamson     pci_set_byte(pdev->config + pos++, vdev->nv_gpudirect_clique << 3);
2172dfbee78dSAlex Williamson     pci_set_byte(pdev->config + pos, 0);
2173dfbee78dSAlex Williamson 
2174dfbee78dSAlex Williamson     return 0;
2175dfbee78dSAlex Williamson }
2176dfbee78dSAlex Williamson 
2177e3f79f3bSAlex Williamson int vfio_add_virt_caps(VFIOPCIDevice *vdev, Error **errp)
2178e3f79f3bSAlex Williamson {
2179dfbee78dSAlex Williamson     int ret;
2180dfbee78dSAlex Williamson 
2181dfbee78dSAlex Williamson     ret = vfio_add_nv_gpudirect_cap(vdev, errp);
2182dfbee78dSAlex Williamson     if (ret) {
2183dfbee78dSAlex Williamson         return ret;
2184dfbee78dSAlex Williamson     }
2185dfbee78dSAlex Williamson 
2186e3f79f3bSAlex Williamson     return 0;
2187e3f79f3bSAlex Williamson }
2188ec132efaSAlexey Kardashevskiy 
2189ec132efaSAlexey Kardashevskiy static void vfio_pci_nvlink2_get_tgt(Object *obj, Visitor *v,
2190ec132efaSAlexey Kardashevskiy                                      const char *name,
2191ec132efaSAlexey Kardashevskiy                                      void *opaque, Error **errp)
2192ec132efaSAlexey Kardashevskiy {
2193ec132efaSAlexey Kardashevskiy     uint64_t tgt = (uintptr_t) opaque;
2194ec132efaSAlexey Kardashevskiy     visit_type_uint64(v, name, &tgt, errp);
2195ec132efaSAlexey Kardashevskiy }
2196ec132efaSAlexey Kardashevskiy 
2197ec132efaSAlexey Kardashevskiy static void vfio_pci_nvlink2_get_link_speed(Object *obj, Visitor *v,
2198ec132efaSAlexey Kardashevskiy                                                  const char *name,
2199ec132efaSAlexey Kardashevskiy                                                  void *opaque, Error **errp)
2200ec132efaSAlexey Kardashevskiy {
2201ec132efaSAlexey Kardashevskiy     uint32_t link_speed = (uint32_t)(uintptr_t) opaque;
2202ec132efaSAlexey Kardashevskiy     visit_type_uint32(v, name, &link_speed, errp);
2203ec132efaSAlexey Kardashevskiy }
2204ec132efaSAlexey Kardashevskiy 
2205ec132efaSAlexey Kardashevskiy int vfio_pci_nvidia_v100_ram_init(VFIOPCIDevice *vdev, Error **errp)
2206ec132efaSAlexey Kardashevskiy {
2207ec132efaSAlexey Kardashevskiy     int ret;
2208ec132efaSAlexey Kardashevskiy     void *p;
2209ec132efaSAlexey Kardashevskiy     struct vfio_region_info *nv2reg = NULL;
2210ec132efaSAlexey Kardashevskiy     struct vfio_info_cap_header *hdr;
2211ec132efaSAlexey Kardashevskiy     struct vfio_region_info_cap_nvlink2_ssatgt *cap;
2212ec132efaSAlexey Kardashevskiy     VFIOQuirk *quirk;
2213ec132efaSAlexey Kardashevskiy 
2214ec132efaSAlexey Kardashevskiy     ret = vfio_get_dev_region_info(&vdev->vbasedev,
2215ec132efaSAlexey Kardashevskiy                                    VFIO_REGION_TYPE_PCI_VENDOR_TYPE |
2216ec132efaSAlexey Kardashevskiy                                    PCI_VENDOR_ID_NVIDIA,
2217ec132efaSAlexey Kardashevskiy                                    VFIO_REGION_SUBTYPE_NVIDIA_NVLINK2_RAM,
2218ec132efaSAlexey Kardashevskiy                                    &nv2reg);
2219ec132efaSAlexey Kardashevskiy     if (ret) {
2220ec132efaSAlexey Kardashevskiy         return ret;
2221ec132efaSAlexey Kardashevskiy     }
2222ec132efaSAlexey Kardashevskiy 
2223ec132efaSAlexey Kardashevskiy     hdr = vfio_get_region_info_cap(nv2reg, VFIO_REGION_INFO_CAP_NVLINK2_SSATGT);
2224ec132efaSAlexey Kardashevskiy     if (!hdr) {
2225ec132efaSAlexey Kardashevskiy         ret = -ENODEV;
2226ec132efaSAlexey Kardashevskiy         goto free_exit;
2227ec132efaSAlexey Kardashevskiy     }
2228ec132efaSAlexey Kardashevskiy     cap = (void *) hdr;
2229ec132efaSAlexey Kardashevskiy 
2230ec132efaSAlexey Kardashevskiy     p = mmap(NULL, nv2reg->size, PROT_READ | PROT_WRITE | PROT_EXEC,
2231ec132efaSAlexey Kardashevskiy              MAP_SHARED, vdev->vbasedev.fd, nv2reg->offset);
2232ec132efaSAlexey Kardashevskiy     if (p == MAP_FAILED) {
2233ec132efaSAlexey Kardashevskiy         ret = -errno;
2234ec132efaSAlexey Kardashevskiy         goto free_exit;
2235ec132efaSAlexey Kardashevskiy     }
2236ec132efaSAlexey Kardashevskiy 
2237ec132efaSAlexey Kardashevskiy     quirk = vfio_quirk_alloc(1);
2238ec132efaSAlexey Kardashevskiy     memory_region_init_ram_ptr(&quirk->mem[0], OBJECT(vdev), "nvlink2-mr",
2239ec132efaSAlexey Kardashevskiy                                nv2reg->size, p);
2240ec132efaSAlexey Kardashevskiy     QLIST_INSERT_HEAD(&vdev->bars[0].quirks, quirk, next);
2241ec132efaSAlexey Kardashevskiy 
2242ec132efaSAlexey Kardashevskiy     object_property_add(OBJECT(vdev), "nvlink2-tgt", "uint64",
2243ec132efaSAlexey Kardashevskiy                         vfio_pci_nvlink2_get_tgt, NULL, NULL,
2244ec132efaSAlexey Kardashevskiy                         (void *) (uintptr_t) cap->tgt, NULL);
2245ec132efaSAlexey Kardashevskiy     trace_vfio_pci_nvidia_gpu_setup_quirk(vdev->vbasedev.name, cap->tgt,
2246ec132efaSAlexey Kardashevskiy                                           nv2reg->size);
2247ec132efaSAlexey Kardashevskiy free_exit:
2248ec132efaSAlexey Kardashevskiy     g_free(nv2reg);
2249ec132efaSAlexey Kardashevskiy 
2250ec132efaSAlexey Kardashevskiy     return ret;
2251ec132efaSAlexey Kardashevskiy }
2252ec132efaSAlexey Kardashevskiy 
2253ec132efaSAlexey Kardashevskiy int vfio_pci_nvlink2_init(VFIOPCIDevice *vdev, Error **errp)
2254ec132efaSAlexey Kardashevskiy {
2255ec132efaSAlexey Kardashevskiy     int ret;
2256ec132efaSAlexey Kardashevskiy     void *p;
2257ec132efaSAlexey Kardashevskiy     struct vfio_region_info *atsdreg = NULL;
2258ec132efaSAlexey Kardashevskiy     struct vfio_info_cap_header *hdr;
2259ec132efaSAlexey Kardashevskiy     struct vfio_region_info_cap_nvlink2_ssatgt *captgt;
2260ec132efaSAlexey Kardashevskiy     struct vfio_region_info_cap_nvlink2_lnkspd *capspeed;
2261ec132efaSAlexey Kardashevskiy     VFIOQuirk *quirk;
2262ec132efaSAlexey Kardashevskiy 
2263ec132efaSAlexey Kardashevskiy     ret = vfio_get_dev_region_info(&vdev->vbasedev,
2264ec132efaSAlexey Kardashevskiy                                    VFIO_REGION_TYPE_PCI_VENDOR_TYPE |
2265ec132efaSAlexey Kardashevskiy                                    PCI_VENDOR_ID_IBM,
2266ec132efaSAlexey Kardashevskiy                                    VFIO_REGION_SUBTYPE_IBM_NVLINK2_ATSD,
2267ec132efaSAlexey Kardashevskiy                                    &atsdreg);
2268ec132efaSAlexey Kardashevskiy     if (ret) {
2269ec132efaSAlexey Kardashevskiy         return ret;
2270ec132efaSAlexey Kardashevskiy     }
2271ec132efaSAlexey Kardashevskiy 
2272ec132efaSAlexey Kardashevskiy     hdr = vfio_get_region_info_cap(atsdreg,
2273ec132efaSAlexey Kardashevskiy                                    VFIO_REGION_INFO_CAP_NVLINK2_SSATGT);
2274ec132efaSAlexey Kardashevskiy     if (!hdr) {
2275ec132efaSAlexey Kardashevskiy         ret = -ENODEV;
2276ec132efaSAlexey Kardashevskiy         goto free_exit;
2277ec132efaSAlexey Kardashevskiy     }
2278ec132efaSAlexey Kardashevskiy     captgt = (void *) hdr;
2279ec132efaSAlexey Kardashevskiy 
2280ec132efaSAlexey Kardashevskiy     hdr = vfio_get_region_info_cap(atsdreg,
2281ec132efaSAlexey Kardashevskiy                                    VFIO_REGION_INFO_CAP_NVLINK2_LNKSPD);
2282ec132efaSAlexey Kardashevskiy     if (!hdr) {
2283ec132efaSAlexey Kardashevskiy         ret = -ENODEV;
2284ec132efaSAlexey Kardashevskiy         goto free_exit;
2285ec132efaSAlexey Kardashevskiy     }
2286ec132efaSAlexey Kardashevskiy     capspeed = (void *) hdr;
2287ec132efaSAlexey Kardashevskiy 
2288ec132efaSAlexey Kardashevskiy     /* Some NVLink bridges may not have assigned ATSD */
2289ec132efaSAlexey Kardashevskiy     if (atsdreg->size) {
2290ec132efaSAlexey Kardashevskiy         p = mmap(NULL, atsdreg->size, PROT_READ | PROT_WRITE | PROT_EXEC,
2291ec132efaSAlexey Kardashevskiy                  MAP_SHARED, vdev->vbasedev.fd, atsdreg->offset);
2292ec132efaSAlexey Kardashevskiy         if (p == MAP_FAILED) {
2293ec132efaSAlexey Kardashevskiy             ret = -errno;
2294ec132efaSAlexey Kardashevskiy             goto free_exit;
2295ec132efaSAlexey Kardashevskiy         }
2296ec132efaSAlexey Kardashevskiy 
2297ec132efaSAlexey Kardashevskiy         quirk = vfio_quirk_alloc(1);
2298ec132efaSAlexey Kardashevskiy         memory_region_init_ram_device_ptr(&quirk->mem[0], OBJECT(vdev),
2299ec132efaSAlexey Kardashevskiy                                           "nvlink2-atsd-mr", atsdreg->size, p);
2300ec132efaSAlexey Kardashevskiy         QLIST_INSERT_HEAD(&vdev->bars[0].quirks, quirk, next);
2301ec132efaSAlexey Kardashevskiy     }
2302ec132efaSAlexey Kardashevskiy 
2303ec132efaSAlexey Kardashevskiy     object_property_add(OBJECT(vdev), "nvlink2-tgt", "uint64",
2304ec132efaSAlexey Kardashevskiy                         vfio_pci_nvlink2_get_tgt, NULL, NULL,
2305ec132efaSAlexey Kardashevskiy                         (void *) (uintptr_t) captgt->tgt, NULL);
2306ec132efaSAlexey Kardashevskiy     trace_vfio_pci_nvlink2_setup_quirk_ssatgt(vdev->vbasedev.name, captgt->tgt,
2307ec132efaSAlexey Kardashevskiy                                               atsdreg->size);
2308ec132efaSAlexey Kardashevskiy 
2309ec132efaSAlexey Kardashevskiy     object_property_add(OBJECT(vdev), "nvlink2-link-speed", "uint32",
2310ec132efaSAlexey Kardashevskiy                         vfio_pci_nvlink2_get_link_speed, NULL, NULL,
2311ec132efaSAlexey Kardashevskiy                         (void *) (uintptr_t) capspeed->link_speed, NULL);
2312ec132efaSAlexey Kardashevskiy     trace_vfio_pci_nvlink2_setup_quirk_lnkspd(vdev->vbasedev.name,
2313ec132efaSAlexey Kardashevskiy                                               capspeed->link_speed);
2314ec132efaSAlexey Kardashevskiy free_exit:
2315ec132efaSAlexey Kardashevskiy     g_free(atsdreg);
2316ec132efaSAlexey Kardashevskiy 
2317ec132efaSAlexey Kardashevskiy     return ret;
2318ec132efaSAlexey Kardashevskiy }
2319