pci.c 104.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
/*
 * vfio based device assignment support
 *
 * Copyright Red Hat, Inc. 2012
 *
 * Authors:
 *  Alex Williamson <alex.williamson@redhat.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2.  See
 * the COPYING file in the top-level directory.
 *
 * Based on qemu-kvm device-assignment:
 *  Adapted for KVM by Qumranet.
 *  Copyright (c) 2007, Neocleus, Alex Novik (alex@neocleus.com)
 *  Copyright (c) 2007, Neocleus, Guy Zana (guy@neocleus.com)
 *  Copyright (C) 2008, Qumranet, Amit Shah (amit.shah@qumranet.com)
 *  Copyright (C) 2008, Red Hat, Amit Shah (amit.shah@redhat.com)
 *  Copyright (C) 2008, IBM, Muli Ben-Yehuda (muli@il.ibm.com)
 */

P
Peter Maydell 已提交
21
#include "qemu/osdep.h"
A
Alex Williamson 已提交
22
#include <linux/vfio.h>
23 24
#include <sys/ioctl.h>

25 26
#include "hw/pci/msi.h"
#include "hw/pci/msix.h"
27
#include "hw/pci/pci_bridge.h"
28
#include "qemu/error-report.h"
29
#include "qemu/option.h"
30
#include "qemu/range.h"
31
#include "qemu/units.h"
A
Alex Williamson 已提交
32 33
#include "sysemu/kvm.h"
#include "sysemu/sysemu.h"
34
#include "pci.h"
E
Eric Auger 已提交
35
#include "trace.h"
36
#include "qapi/error.h"
37

38 39
#define MSIX_CAP_LENGTH 12

40 41 42
#define TYPE_VFIO_PCI "vfio-pci"
#define PCI_VFIO(obj)    OBJECT_CHECK(VFIOPCIDevice, obj, TYPE_VFIO_PCI)

43 44
static void vfio_disable_interrupts(VFIOPCIDevice *vdev);
static void vfio_mmap_set_enabled(VFIOPCIDevice *vdev, bool enabled);
45

46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62
/*
 * Disabling BAR mmaping can be slow, but toggling it around INTx can
 * also be a huge overhead.  We try to get the best of both worlds by
 * waiting until an interrupt to disable mmaps (subsequent transitions
 * to the same state are effectively no overhead).  If the interrupt has
 * been serviced and the time gap is long enough, we re-enable mmaps for
 * performance.  This works well for things like graphics cards, which
 * may not use their interrupt at all and are penalized to an unusable
 * level by read/write BAR traps.  Other devices, like NICs, have more
 * regular interrupts and see much better latency by staying in non-mmap
 * mode.  We therefore set the default mmap_timeout such that a ping
 * is just enough to keep the mmap disabled.  Users can experiment with
 * other options with the x-intx-mmap-timeout-ms parameter (a value of
 * zero disables the timer).
 */
static void vfio_intx_mmap_enable(void *opaque)
{
63
    VFIOPCIDevice *vdev = opaque;
64 65

    if (vdev->intx.pending) {
66 67
        timer_mod(vdev->intx.mmap_timer,
                       qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + vdev->intx.mmap_timeout);
68 69 70 71 72 73
        return;
    }

    vfio_mmap_set_enabled(vdev, true);
}

74 75
static void vfio_intx_interrupt(void *opaque)
{
76
    VFIOPCIDevice *vdev = opaque;
77 78 79 80 81

    if (!event_notifier_test_and_clear(&vdev->intx.interrupt)) {
        return;
    }

82
    trace_vfio_intx_interrupt(vdev->vbasedev.name, 'A' + vdev->intx.pin);
83 84

    vdev->intx.pending = true;
85
    pci_irq_assert(&vdev->pdev);
86 87
    vfio_mmap_set_enabled(vdev, false);
    if (vdev->intx.mmap_timeout) {
88 89
        timer_mod(vdev->intx.mmap_timer,
                       qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + vdev->intx.mmap_timeout);
90
    }
91 92
}

93
static void vfio_intx_eoi(VFIODevice *vbasedev)
94
{
E
Eric Auger 已提交
95 96
    VFIOPCIDevice *vdev = container_of(vbasedev, VFIOPCIDevice, vbasedev);

97 98 99 100
    if (!vdev->intx.pending) {
        return;
    }

101
    trace_vfio_intx_eoi(vbasedev->name);
102 103

    vdev->intx.pending = false;
104
    pci_irq_deassert(&vdev->pdev);
E
Eric Auger 已提交
105
    vfio_unmask_single_irqindex(vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
106 107
}

108
static void vfio_intx_enable_kvm(VFIOPCIDevice *vdev, Error **errp)
109 110 111 112 113 114 115 116 117 118 119
{
#ifdef CONFIG_KVM
    struct kvm_irqfd irqfd = {
        .fd = event_notifier_get_fd(&vdev->intx.interrupt),
        .gsi = vdev->intx.route.irq,
        .flags = KVM_IRQFD_FLAG_RESAMPLE,
    };
    struct vfio_irq_set *irq_set;
    int ret, argsz;
    int32_t *pfd;

120
    if (vdev->no_kvm_intx || !kvm_irqfds_enabled() ||
121
        vdev->intx.route.mode != PCI_INTX_ENABLED ||
E
Eric Auger 已提交
122
        !kvm_resamplefds_enabled()) {
123 124 125 126 127
        return;
    }

    /* Get to a known interrupt state */
    qemu_set_fd_handler(irqfd.fd, NULL, NULL, vdev);
128
    vfio_mask_single_irqindex(&vdev->vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
129
    vdev->intx.pending = false;
130
    pci_irq_deassert(&vdev->pdev);
131 132 133

    /* Get an eventfd for resample/unmask */
    if (event_notifier_init(&vdev->intx.unmask, 0)) {
134
        error_setg(errp, "event_notifier_init failed eoi");
135 136 137 138 139 140 141
        goto fail;
    }

    /* KVM triggers it, VFIO listens for it */
    irqfd.resamplefd = event_notifier_get_fd(&vdev->intx.unmask);

    if (kvm_vm_ioctl(kvm_state, KVM_IRQFD, &irqfd)) {
142
        error_setg_errno(errp, errno, "failed to setup resample irqfd");
143 144 145 146 147 148 149 150 151 152 153 154 155 156 157
        goto fail_irqfd;
    }

    argsz = sizeof(*irq_set) + sizeof(*pfd);

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_UNMASK;
    irq_set->index = VFIO_PCI_INTX_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = 1;
    pfd = (int32_t *)&irq_set->data;

    *pfd = irqfd.resamplefd;

158
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
159 160
    g_free(irq_set);
    if (ret) {
161
        error_setg_errno(errp, -ret, "failed to setup INTx unmask fd");
162 163 164 165
        goto fail_vfio;
    }

    /* Let'em rip */
166
    vfio_unmask_single_irqindex(&vdev->vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
167 168 169

    vdev->intx.kvm_accel = true;

170
    trace_vfio_intx_enable_kvm(vdev->vbasedev.name);
171 172 173 174 175 176 177 178 179 180

    return;

fail_vfio:
    irqfd.flags = KVM_IRQFD_FLAG_DEASSIGN;
    kvm_vm_ioctl(kvm_state, KVM_IRQFD, &irqfd);
fail_irqfd:
    event_notifier_cleanup(&vdev->intx.unmask);
fail:
    qemu_set_fd_handler(irqfd.fd, vfio_intx_interrupt, NULL, vdev);
181
    vfio_unmask_single_irqindex(&vdev->vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
182 183 184
#endif
}

185
static void vfio_intx_disable_kvm(VFIOPCIDevice *vdev)
186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201
{
#ifdef CONFIG_KVM
    struct kvm_irqfd irqfd = {
        .fd = event_notifier_get_fd(&vdev->intx.interrupt),
        .gsi = vdev->intx.route.irq,
        .flags = KVM_IRQFD_FLAG_DEASSIGN,
    };

    if (!vdev->intx.kvm_accel) {
        return;
    }

    /*
     * Get to a known state, hardware masked, QEMU ready to accept new
     * interrupts, QEMU IRQ de-asserted.
     */
202
    vfio_mask_single_irqindex(&vdev->vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
203
    vdev->intx.pending = false;
204
    pci_irq_deassert(&vdev->pdev);
205 206 207

    /* Tell KVM to stop listening for an INTx irqfd */
    if (kvm_vm_ioctl(kvm_state, KVM_IRQFD, &irqfd)) {
208
        error_report("vfio: Error: Failed to disable INTx irqfd: %m");
209 210 211 212 213 214 215 216 217 218 219
    }

    /* We only need to close the eventfd for VFIO to cleanup the kernel side */
    event_notifier_cleanup(&vdev->intx.unmask);

    /* QEMU starts listening for interrupt events. */
    qemu_set_fd_handler(irqfd.fd, vfio_intx_interrupt, NULL, vdev);

    vdev->intx.kvm_accel = false;

    /* If we've missed an event, let it re-fire through QEMU */
220
    vfio_unmask_single_irqindex(&vdev->vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
221

222
    trace_vfio_intx_disable_kvm(vdev->vbasedev.name);
223 224 225
#endif
}

226
static void vfio_intx_update(PCIDevice *pdev)
227
{
228
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
229
    PCIINTxRoute route;
230
    Error *err = NULL;
231 232 233 234 235 236 237 238 239 240 241

    if (vdev->interrupt != VFIO_INT_INTx) {
        return;
    }

    route = pci_device_route_intx_to_irq(&vdev->pdev, vdev->intx.pin);

    if (!pci_intx_route_changed(&vdev->intx.route, &route)) {
        return; /* Nothing changed */
    }

242 243
    trace_vfio_intx_update(vdev->vbasedev.name,
                           vdev->intx.route.irq, route.irq);
244

245
    vfio_intx_disable_kvm(vdev);
246 247 248 249 250 251 252

    vdev->intx.route = route;

    if (route.mode != PCI_INTX_ENABLED) {
        return;
    }

253 254
    vfio_intx_enable_kvm(vdev, &err);
    if (err) {
255
        warn_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
256
    }
257 258

    /* Re-enable the interrupt in cased we missed an EOI */
259
    vfio_intx_eoi(&vdev->vbasedev);
260 261
}

262
static int vfio_intx_enable(VFIOPCIDevice *vdev, Error **errp)
263 264
{
    uint8_t pin = vfio_pci_read_config(&vdev->pdev, PCI_INTERRUPT_PIN, 1);
265
    int ret, argsz, retval = 0;
A
Alex Williamson 已提交
266 267
    struct vfio_irq_set *irq_set;
    int32_t *pfd;
268
    Error *err = NULL;
269

270
    if (!pin) {
271 272 273 274 275 276
        return 0;
    }

    vfio_disable_interrupts(vdev);

    vdev->intx.pin = pin - 1; /* Pin A (1) -> irq[0] */
277
    pci_config_set_interrupt_pin(vdev->pdev.config, pin);
278 279 280 281 282 283

#ifdef CONFIG_KVM
    /*
     * Only conditional to avoid generating error messages on platforms
     * where we won't actually use the result anyway.
     */
E
Eric Auger 已提交
284
    if (kvm_irqfds_enabled() && kvm_resamplefds_enabled()) {
285 286 287 288 289
        vdev->intx.route = pci_device_route_intx_to_irq(&vdev->pdev,
                                                        vdev->intx.pin);
    }
#endif

290 291
    ret = event_notifier_init(&vdev->intx.interrupt, 0);
    if (ret) {
292
        error_setg_errno(errp, -ret, "event_notifier_init failed");
293 294 295
        return ret;
    }

A
Alex Williamson 已提交
296 297 298 299 300 301 302 303 304 305 306 307
    argsz = sizeof(*irq_set) + sizeof(*pfd);

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_TRIGGER;
    irq_set->index = VFIO_PCI_INTX_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = 1;
    pfd = (int32_t *)&irq_set->data;

    *pfd = event_notifier_get_fd(&vdev->intx.interrupt);
    qemu_set_fd_handler(*pfd, vfio_intx_interrupt, NULL, vdev);
308

309
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
A
Alex Williamson 已提交
310
    if (ret) {
311
        error_setg_errno(errp, -ret, "failed to setup INTx fd");
A
Alex Williamson 已提交
312
        qemu_set_fd_handler(*pfd, NULL, NULL, vdev);
313
        event_notifier_cleanup(&vdev->intx.interrupt);
314 315
        retval = -errno;
        goto cleanup;
316 317
    }

318 319
    vfio_intx_enable_kvm(vdev, &err);
    if (err) {
320
        warn_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
321
    }
322

323 324
    vdev->interrupt = VFIO_INT_INTx;

325
    trace_vfio_intx_enable(vdev->vbasedev.name);
326

327 328 329 330
cleanup:
    g_free(irq_set);

    return retval;
331 332
}

333
static void vfio_intx_disable(VFIOPCIDevice *vdev)
334 335 336
{
    int fd;

337
    timer_del(vdev->intx.mmap_timer);
338
    vfio_intx_disable_kvm(vdev);
339
    vfio_disable_irqindex(&vdev->vbasedev, VFIO_PCI_INTX_IRQ_INDEX);
340
    vdev->intx.pending = false;
341
    pci_irq_deassert(&vdev->pdev);
342 343 344 345 346 347 348 349
    vfio_mmap_set_enabled(vdev, true);

    fd = event_notifier_get_fd(&vdev->intx.interrupt);
    qemu_set_fd_handler(fd, NULL, NULL, vdev);
    event_notifier_cleanup(&vdev->intx.interrupt);

    vdev->interrupt = VFIO_INT_NONE;

350
    trace_vfio_intx_disable(vdev->vbasedev.name);
351 352 353 354 355 356 357 358
}

/*
 * MSI/X
 */
static void vfio_msi_interrupt(void *opaque)
{
    VFIOMSIVector *vector = opaque;
359
    VFIOPCIDevice *vdev = vector->vdev;
360 361 362
    MSIMessage (*get_msg)(PCIDevice *dev, unsigned vector);
    void (*notify)(PCIDevice *dev, unsigned vector);
    MSIMessage msg;
363 364 365 366 367 368
    int nr = vector - vdev->msi_vectors;

    if (!event_notifier_test_and_clear(&vector->interrupt)) {
        return;
    }

369
    if (vdev->interrupt == VFIO_INT_MSIX) {
370 371
        get_msg = msix_get_message;
        notify = msix_notify;
A
Alex Williamson 已提交
372 373 374 375 376 377 378

        /* A masked vector firing needs to use the PBA, enable it */
        if (msix_is_masked(&vdev->pdev, nr)) {
            set_bit(nr, vdev->msix->pending);
            memory_region_set_enabled(&vdev->pdev.msix_pba_mmio, true);
            trace_vfio_msix_pba_enable(vdev->vbasedev.name);
        }
A
Alex Williamson 已提交
379
    } else if (vdev->interrupt == VFIO_INT_MSI) {
380 381
        get_msg = msi_get_message;
        notify = msi_notify;
382 383 384 385
    } else {
        abort();
    }

386
    msg = get_msg(&vdev->pdev, nr);
387
    trace_vfio_msi_interrupt(vdev->vbasedev.name, nr, msg.address, msg.data);
388
    notify(&vdev->pdev, nr);
389 390
}

391
static int vfio_enable_vectors(VFIOPCIDevice *vdev, bool msix)
392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
{
    struct vfio_irq_set *irq_set;
    int ret = 0, i, argsz;
    int32_t *fds;

    argsz = sizeof(*irq_set) + (vdev->nr_vectors * sizeof(*fds));

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_TRIGGER;
    irq_set->index = msix ? VFIO_PCI_MSIX_IRQ_INDEX : VFIO_PCI_MSI_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = vdev->nr_vectors;
    fds = (int32_t *)&irq_set->data;

    for (i = 0; i < vdev->nr_vectors; i++) {
408 409 410 411 412 413 414 415 416 417 418 419 420 421 422
        int fd = -1;

        /*
         * MSI vs MSI-X - The guest has direct access to MSI mask and pending
         * bits, therefore we always use the KVM signaling path when setup.
         * MSI-X mask and pending bits are emulated, so we want to use the
         * KVM signaling path only when configured and unmasked.
         */
        if (vdev->msi_vectors[i].use) {
            if (vdev->msi_vectors[i].virq < 0 ||
                (msix && msix_is_masked(&vdev->pdev, i))) {
                fd = event_notifier_get_fd(&vdev->msi_vectors[i].interrupt);
            } else {
                fd = event_notifier_get_fd(&vdev->msi_vectors[i].kvm_interrupt);
            }
423
        }
424 425

        fds[i] = fd;
426 427
    }

428
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
429 430 431 432 433 434

    g_free(irq_set);

    return ret;
}

435
static void vfio_add_kvm_msi_virq(VFIOPCIDevice *vdev, VFIOMSIVector *vector,
436
                                  int vector_n, bool msix)
437 438 439
{
    int virq;

440
    if ((msix && vdev->no_kvm_msix) || (!msix && vdev->no_kvm_msi)) {
441 442 443 444 445 446 447
        return;
    }

    if (event_notifier_init(&vector->kvm_interrupt, 0)) {
        return;
    }

448
    virq = kvm_irqchip_add_msi_route(kvm_state, vector_n, &vdev->pdev);
449 450 451 452 453
    if (virq < 0) {
        event_notifier_cleanup(&vector->kvm_interrupt);
        return;
    }

454
    if (kvm_irqchip_add_irqfd_notifier_gsi(kvm_state, &vector->kvm_interrupt,
455 456 457 458 459 460 461 462 463 464 465
                                       NULL, virq) < 0) {
        kvm_irqchip_release_virq(kvm_state, virq);
        event_notifier_cleanup(&vector->kvm_interrupt);
        return;
    }

    vector->virq = virq;
}

static void vfio_remove_kvm_msi_virq(VFIOMSIVector *vector)
{
466 467
    kvm_irqchip_remove_irqfd_notifier_gsi(kvm_state, &vector->kvm_interrupt,
                                          vector->virq);
468 469 470 471 472
    kvm_irqchip_release_virq(kvm_state, vector->virq);
    vector->virq = -1;
    event_notifier_cleanup(&vector->kvm_interrupt);
}

473 474
static void vfio_update_kvm_msi_virq(VFIOMSIVector *vector, MSIMessage msg,
                                     PCIDevice *pdev)
475
{
476
    kvm_irqchip_update_msi_route(kvm_state, vector->virq, msg, pdev);
477
    kvm_irqchip_commit_routes(kvm_state);
478 479
}

480 481
static int vfio_msix_vector_do_use(PCIDevice *pdev, unsigned int nr,
                                   MSIMessage *msg, IOHandler *handler)
482
{
483
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
484 485 486
    VFIOMSIVector *vector;
    int ret;

487
    trace_vfio_msix_vector_do_use(vdev->vbasedev.name, nr);
488 489 490

    vector = &vdev->msi_vectors[nr];

491 492 493 494 495 496 497 498
    if (!vector->use) {
        vector->vdev = vdev;
        vector->virq = -1;
        if (event_notifier_init(&vector->interrupt, 0)) {
            error_report("vfio: Error: event_notifier_init failed");
        }
        vector->use = true;
        msix_vector_use(pdev, nr);
499 500
    }

501 502 503
    qemu_set_fd_handler(event_notifier_get_fd(&vector->interrupt),
                        handler, NULL, vector);

504 505 506 507
    /*
     * Attempt to enable route through KVM irqchip,
     * default to userspace handling if unavailable.
     */
508 509 510 511
    if (vector->virq >= 0) {
        if (!msg) {
            vfio_remove_kvm_msi_virq(vector);
        } else {
512
            vfio_update_kvm_msi_virq(vector, *msg, pdev);
513
        }
514
    } else {
515 516 517
        if (msg) {
            vfio_add_kvm_msi_virq(vdev, vector, nr, true);
        }
518 519 520 521 522 523 524 525
    }

    /*
     * We don't want to have the host allocate all possible MSI vectors
     * for a device if they're not in use, so we shutdown and incrementally
     * increase them as needed.
     */
    if (vdev->nr_vectors < nr + 1) {
526
        vfio_disable_irqindex(&vdev->vbasedev, VFIO_PCI_MSIX_IRQ_INDEX);
527 528 529
        vdev->nr_vectors = nr + 1;
        ret = vfio_enable_vectors(vdev, true);
        if (ret) {
530
            error_report("vfio: failed to enable vectors, %d", ret);
531 532
        }
    } else {
A
Alex Williamson 已提交
533 534 535 536 537 538 539 540 541 542 543 544 545 546 547
        int argsz;
        struct vfio_irq_set *irq_set;
        int32_t *pfd;

        argsz = sizeof(*irq_set) + sizeof(*pfd);

        irq_set = g_malloc0(argsz);
        irq_set->argsz = argsz;
        irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD |
                         VFIO_IRQ_SET_ACTION_TRIGGER;
        irq_set->index = VFIO_PCI_MSIX_IRQ_INDEX;
        irq_set->start = nr;
        irq_set->count = 1;
        pfd = (int32_t *)&irq_set->data;

548 549 550 551 552
        if (vector->virq >= 0) {
            *pfd = event_notifier_get_fd(&vector->kvm_interrupt);
        } else {
            *pfd = event_notifier_get_fd(&vector->interrupt);
        }
A
Alex Williamson 已提交
553

554
        ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
A
Alex Williamson 已提交
555
        g_free(irq_set);
556
        if (ret) {
557
            error_report("vfio: failed to modify vector, %d", ret);
558 559 560
        }
    }

A
Alex Williamson 已提交
561 562 563 564 565 566 567 568
    /* Disable PBA emulation when nothing more is pending. */
    clear_bit(nr, vdev->msix->pending);
    if (find_first_bit(vdev->msix->pending,
                       vdev->nr_vectors) == vdev->nr_vectors) {
        memory_region_set_enabled(&vdev->pdev.msix_pba_mmio, false);
        trace_vfio_msix_pba_disable(vdev->vbasedev.name);
    }

569 570 571
    return 0;
}

572 573 574 575 576 577
static int vfio_msix_vector_use(PCIDevice *pdev,
                                unsigned int nr, MSIMessage msg)
{
    return vfio_msix_vector_do_use(pdev, nr, &msg, vfio_msi_interrupt);
}

578 579
static void vfio_msix_vector_release(PCIDevice *pdev, unsigned int nr)
{
580
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
581 582
    VFIOMSIVector *vector = &vdev->msi_vectors[nr];

583
    trace_vfio_msix_vector_release(vdev->vbasedev.name, nr);
584 585

    /*
586 587 588 589 590 591
     * There are still old guests that mask and unmask vectors on every
     * interrupt.  If we're using QEMU bypass with a KVM irqfd, leave all of
     * the KVM setup in place, simply switch VFIO to use the non-bypass
     * eventfd.  We'll then fire the interrupt through QEMU and the MSI-X
     * core will mask the interrupt and set pending bits, allowing it to
     * be re-asserted on unmask.  Nothing to do if already using QEMU mode.
592
     */
593 594 595 596
    if (vector->virq >= 0) {
        int argsz;
        struct vfio_irq_set *irq_set;
        int32_t *pfd;
A
Alex Williamson 已提交
597

598
        argsz = sizeof(*irq_set) + sizeof(*pfd);
A
Alex Williamson 已提交
599

600 601 602 603 604 605 606 607
        irq_set = g_malloc0(argsz);
        irq_set->argsz = argsz;
        irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD |
                         VFIO_IRQ_SET_ACTION_TRIGGER;
        irq_set->index = VFIO_PCI_MSIX_IRQ_INDEX;
        irq_set->start = nr;
        irq_set->count = 1;
        pfd = (int32_t *)&irq_set->data;
A
Alex Williamson 已提交
608

609
        *pfd = event_notifier_get_fd(&vector->interrupt);
A
Alex Williamson 已提交
610

611
        ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
612

613
        g_free(irq_set);
614 615 616
    }
}

617
static void vfio_msix_enable(VFIOPCIDevice *vdev)
618 619 620
{
    vfio_disable_interrupts(vdev);

621
    vdev->msi_vectors = g_new0(VFIOMSIVector, vdev->msix->entries);
622 623 624

    vdev->interrupt = VFIO_INT_MSIX;

625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640
    /*
     * Some communication channels between VF & PF or PF & fw rely on the
     * physical state of the device and expect that enabling MSI-X from the
     * guest enables the same on the host.  When our guest is Linux, the
     * guest driver call to pci_enable_msix() sets the enabling bit in the
     * MSI-X capability, but leaves the vector table masked.  We therefore
     * can't rely on a vector_use callback (from request_irq() in the guest)
     * to switch the physical device into MSI-X mode because that may come a
     * long time after pci_enable_msix().  This code enables vector 0 with
     * triggering to userspace, then immediately release the vector, leaving
     * the physical device with no vectors enabled, but MSI-X enabled, just
     * like the guest view.
     */
    vfio_msix_vector_do_use(&vdev->pdev, 0, NULL, NULL);
    vfio_msix_vector_release(&vdev->pdev, 0);

641
    if (msix_set_vector_notifiers(&vdev->pdev, vfio_msix_vector_use,
642
                                  vfio_msix_vector_release, NULL)) {
643
        error_report("vfio: msix_set_vector_notifiers failed");
644 645
    }

646
    trace_vfio_msix_enable(vdev->vbasedev.name);
647 648
}

649
static void vfio_msi_enable(VFIOPCIDevice *vdev)
650 651 652 653 654 655 656
{
    int ret, i;

    vfio_disable_interrupts(vdev);

    vdev->nr_vectors = msi_nr_vectors_allocated(&vdev->pdev);
retry:
657
    vdev->msi_vectors = g_new0(VFIOMSIVector, vdev->nr_vectors);
658 659 660 661 662

    for (i = 0; i < vdev->nr_vectors; i++) {
        VFIOMSIVector *vector = &vdev->msi_vectors[i];

        vector->vdev = vdev;
663
        vector->virq = -1;
664 665 666
        vector->use = true;

        if (event_notifier_init(&vector->interrupt, 0)) {
667
            error_report("vfio: Error: event_notifier_init failed");
668 669
        }

670 671 672
        qemu_set_fd_handler(event_notifier_get_fd(&vector->interrupt),
                            vfio_msi_interrupt, NULL, vector);

673 674 675 676
        /*
         * Attempt to enable route through KVM irqchip,
         * default to userspace handling if unavailable.
         */
677
        vfio_add_kvm_msi_virq(vdev, vector, i, false);
678 679
    }

680 681 682
    /* Set interrupt type prior to possible interrupts */
    vdev->interrupt = VFIO_INT_MSI;

683 684 685
    ret = vfio_enable_vectors(vdev, false);
    if (ret) {
        if (ret < 0) {
686
            error_report("vfio: Error: Failed to setup MSI fds: %m");
687 688
        } else if (ret != vdev->nr_vectors) {
            error_report("vfio: Error: Failed to enable %d "
689
                         "MSI vectors, retry with %d", vdev->nr_vectors, ret);
690 691 692 693 694
        }

        for (i = 0; i < vdev->nr_vectors; i++) {
            VFIOMSIVector *vector = &vdev->msi_vectors[i];
            if (vector->virq >= 0) {
695
                vfio_remove_kvm_msi_virq(vector);
696
            }
697 698
            qemu_set_fd_handler(event_notifier_get_fd(&vector->interrupt),
                                NULL, NULL, NULL);
699 700 701 702 703 704 705 706 707 708 709
            event_notifier_cleanup(&vector->interrupt);
        }

        g_free(vdev->msi_vectors);

        if (ret > 0 && ret != vdev->nr_vectors) {
            vdev->nr_vectors = ret;
            goto retry;
        }
        vdev->nr_vectors = 0;

710 711 712 713 714 715 716 717
        /*
         * Failing to setup MSI doesn't really fall within any specification.
         * Let's try leaving interrupts disabled and hope the guest figures
         * out to fall back to INTx for this device.
         */
        error_report("vfio: Error: Failed to enable MSI");
        vdev->interrupt = VFIO_INT_NONE;

718 719 720
        return;
    }

721
    trace_vfio_msi_enable(vdev->vbasedev.name, vdev->nr_vectors);
722 723
}

724
static void vfio_msi_disable_common(VFIOPCIDevice *vdev)
725
{
726
    Error *err = NULL;
727 728 729 730 731 732 733 734 735 736 737 738 739 740
    int i;

    for (i = 0; i < vdev->nr_vectors; i++) {
        VFIOMSIVector *vector = &vdev->msi_vectors[i];
        if (vdev->msi_vectors[i].use) {
            if (vector->virq >= 0) {
                vfio_remove_kvm_msi_virq(vector);
            }
            qemu_set_fd_handler(event_notifier_get_fd(&vector->interrupt),
                                NULL, NULL, NULL);
            event_notifier_cleanup(&vector->interrupt);
        }
    }

741 742 743 744 745
    g_free(vdev->msi_vectors);
    vdev->msi_vectors = NULL;
    vdev->nr_vectors = 0;
    vdev->interrupt = VFIO_INT_NONE;

746 747
    vfio_intx_enable(vdev, &err);
    if (err) {
748
        error_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
749
    }
750 751
}

752
static void vfio_msix_disable(VFIOPCIDevice *vdev)
753
{
754 755
    int i;

756 757
    msix_unset_vector_notifiers(&vdev->pdev);

758 759 760 761 762 763 764
    /*
     * MSI-X will only release vectors if MSI-X is still enabled on the
     * device, check through the rest and release it ourselves if necessary.
     */
    for (i = 0; i < vdev->nr_vectors; i++) {
        if (vdev->msi_vectors[i].use) {
            vfio_msix_vector_release(&vdev->pdev, i);
765
            msix_vector_unuse(&vdev->pdev, i);
766 767 768
        }
    }

769
    if (vdev->nr_vectors) {
770
        vfio_disable_irqindex(&vdev->vbasedev, VFIO_PCI_MSIX_IRQ_INDEX);
771 772
    }

773
    vfio_msi_disable_common(vdev);
774

A
Alex Williamson 已提交
775 776 777
    memset(vdev->msix->pending, 0,
           BITS_TO_LONGS(vdev->msix->entries) * sizeof(unsigned long));

778
    trace_vfio_msix_disable(vdev->vbasedev.name);
779 780
}

781
static void vfio_msi_disable(VFIOPCIDevice *vdev)
782
{
783
    vfio_disable_irqindex(&vdev->vbasedev, VFIO_PCI_MSI_IRQ_INDEX);
784
    vfio_msi_disable_common(vdev);
785

786
    trace_vfio_msi_disable(vdev->vbasedev.name);
787 788
}

789
static void vfio_update_msi(VFIOPCIDevice *vdev)
790 791 792 793 794 795 796 797 798 799 800 801
{
    int i;

    for (i = 0; i < vdev->nr_vectors; i++) {
        VFIOMSIVector *vector = &vdev->msi_vectors[i];
        MSIMessage msg;

        if (!vector->use || vector->virq < 0) {
            continue;
        }

        msg = msi_get_message(&vdev->pdev, i);
802
        vfio_update_kvm_msi_virq(vector, msg, &vdev->pdev);
803 804 805
    }
}

806
static void vfio_pci_load_rom(VFIOPCIDevice *vdev)
807
{
808
    struct vfio_region_info *reg_info;
809 810
    uint64_t size;
    off_t off = 0;
P
Paolo Bonzini 已提交
811
    ssize_t bytes;
812

813 814
    if (vfio_get_region_info(&vdev->vbasedev,
                             VFIO_PCI_ROM_REGION_INDEX, &reg_info)) {
815 816 817 818
        error_report("vfio: Error getting ROM info: %m");
        return;
    }

819 820 821 822 823 824
    trace_vfio_pci_load_rom(vdev->vbasedev.name, (unsigned long)reg_info->size,
                            (unsigned long)reg_info->offset,
                            (unsigned long)reg_info->flags);

    vdev->rom_size = size = reg_info->size;
    vdev->rom_offset = reg_info->offset;
825

826
    g_free(reg_info);
827 828

    if (!vdev->rom_size) {
829
        vdev->rom_read_failed = true;
830
        error_report("vfio-pci: Cannot read device rom at "
831
                    "%s", vdev->vbasedev.name);
832 833 834
        error_printf("Device option ROM contents are probably invalid "
                    "(check dmesg).\nSkip option ROM probe with rombar=0, "
                    "or load from file with romfile=\n");
835 836 837 838 839 840 841
        return;
    }

    vdev->rom = g_malloc(size);
    memset(vdev->rom, 0xff, size);

    while (size) {
842 843
        bytes = pread(vdev->vbasedev.fd, vdev->rom + off,
                      size, vdev->rom_offset + off);
844 845 846 847 848 849 850 851 852 853 854 855 856
        if (bytes == 0) {
            break;
        } else if (bytes > 0) {
            off += bytes;
            size -= bytes;
        } else {
            if (errno == EINTR || errno == EAGAIN) {
                continue;
            }
            error_report("vfio: Error reading device ROM: %m");
            break;
        }
    }
857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886

    /*
     * Test the ROM signature against our device, if the vendor is correct
     * but the device ID doesn't match, store the correct device ID and
     * recompute the checksum.  Intel IGD devices need this and are known
     * to have bogus checksums so we can't simply adjust the checksum.
     */
    if (pci_get_word(vdev->rom) == 0xaa55 &&
        pci_get_word(vdev->rom + 0x18) + 8 < vdev->rom_size &&
        !memcmp(vdev->rom + pci_get_word(vdev->rom + 0x18), "PCIR", 4)) {
        uint16_t vid, did;

        vid = pci_get_word(vdev->rom + pci_get_word(vdev->rom + 0x18) + 4);
        did = pci_get_word(vdev->rom + pci_get_word(vdev->rom + 0x18) + 6);

        if (vid == vdev->vendor_id && did != vdev->device_id) {
            int i;
            uint8_t csum, *data = vdev->rom;

            pci_set_word(vdev->rom + pci_get_word(vdev->rom + 0x18) + 6,
                         vdev->device_id);
            data[6] = 0;

            for (csum = 0, i = 0; i < vdev->rom_size; i++) {
                csum += data[i];
            }

            data[6] = -csum;
        }
    }
887 888 889 890
}

static uint64_t vfio_rom_read(void *opaque, hwaddr addr, unsigned size)
{
891
    VFIOPCIDevice *vdev = opaque;
892 893 894 895 896 897 898
    union {
        uint8_t byte;
        uint16_t word;
        uint32_t dword;
        uint64_t qword;
    } val;
    uint64_t data = 0;
899 900

    /* Load the ROM lazily when the guest tries to read it */
901
    if (unlikely(!vdev->rom && !vdev->rom_read_failed)) {
902 903 904
        vfio_pci_load_rom(vdev);
    }

905
    memcpy(&val, vdev->rom + addr,
906 907
           (addr < vdev->rom_size) ? MIN(size, vdev->rom_size - addr) : 0);

908 909 910 911 912 913 914 915 916 917 918 919 920 921 922
    switch (size) {
    case 1:
        data = val.byte;
        break;
    case 2:
        data = le16_to_cpu(val.word);
        break;
    case 4:
        data = le32_to_cpu(val.dword);
        break;
    default:
        hw_error("vfio: unsupported read size, %d bytes\n", size);
        break;
    }

923
    trace_vfio_rom_read(vdev->vbasedev.name, addr, size, data);
924

925
    return data;
926 927
}

928 929 930 931 932
static void vfio_rom_write(void *opaque, hwaddr addr,
                           uint64_t data, unsigned size)
{
}

933 934
static const MemoryRegionOps vfio_rom_ops = {
    .read = vfio_rom_read,
935
    .write = vfio_rom_write,
936
    .endianness = DEVICE_LITTLE_ENDIAN,
937 938
};

939
static void vfio_pci_size_rom(VFIOPCIDevice *vdev)
940
{
941
    uint32_t orig, size = cpu_to_le32((uint32_t)PCI_ROM_ADDRESS_MASK);
942
    off_t offset = vdev->config_offset + PCI_ROM_ADDRESS;
943
    DeviceState *dev = DEVICE(vdev);
944
    char *name;
945
    int fd = vdev->vbasedev.fd;
946 947

    if (vdev->pdev.romfile || !vdev->pdev.rom_bar) {
948 949
        /* Since pci handles romfile, just print a message and return */
        if (vfio_blacklist_opt_rom(vdev) && vdev->pdev.romfile) {
950 951
            error_printf("Warning : Device at %s is known to cause system instability issues during option rom execution. Proceeding anyway since user specified romfile\n",
                         vdev->vbasedev.name);
952
        }
953 954 955 956 957 958 959
        return;
    }

    /*
     * Use the same size ROM BAR as the physical device.  The contents
     * will get filled in later when the guest tries to read it.
     */
960 961 962 963
    if (pread(fd, &orig, 4, offset) != 4 ||
        pwrite(fd, &size, 4, offset) != 4 ||
        pread(fd, &size, 4, offset) != 4 ||
        pwrite(fd, &orig, 4, offset) != 4) {
964
        error_report("%s(%s) failed: %m", __func__, vdev->vbasedev.name);
965 966 967
        return;
    }

968
    size = ~(le32_to_cpu(size) & PCI_ROM_ADDRESS_MASK) + 1;
969 970 971 972 973

    if (!size) {
        return;
    }

974 975
    if (vfio_blacklist_opt_rom(vdev)) {
        if (dev->opts && qemu_opt_get(dev->opts, "rombar")) {
976 977
            error_printf("Warning : Device at %s is known to cause system instability issues during option rom execution. Proceeding anyway since user specified non zero value for rombar\n",
                         vdev->vbasedev.name);
978
        } else {
979 980
            error_printf("Warning : Rom loading for device at %s has been disabled due to system instability issues. Specify rombar=1 or romfile to force\n",
                         vdev->vbasedev.name);
981 982 983 984
            return;
        }
    }

985
    trace_vfio_pci_size_rom(vdev->vbasedev.name, size);
986

987
    name = g_strdup_printf("vfio[%s].rom", vdev->vbasedev.name);
988 989 990

    memory_region_init_io(&vdev->pdev.rom, OBJECT(vdev),
                          &vfio_rom_ops, vdev, name, size);
991
    g_free(name);
992 993 994 995

    pci_register_bar(&vdev->pdev, PCI_ROM_SLOT,
                     PCI_BASE_ADDRESS_SPACE_MEMORY, &vdev->pdev.rom);

996
    vdev->rom_read_failed = false;
997 998
}

999
void vfio_vga_write(void *opaque, hwaddr addr,
1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
                           uint64_t data, unsigned size)
{
    VFIOVGARegion *region = opaque;
    VFIOVGA *vga = container_of(region, VFIOVGA, region[region->nr]);
    union {
        uint8_t byte;
        uint16_t word;
        uint32_t dword;
        uint64_t qword;
    } buf;
    off_t offset = vga->fd_offset + region->offset + addr;

    switch (size) {
    case 1:
        buf.byte = data;
        break;
    case 2:
        buf.word = cpu_to_le16(data);
        break;
    case 4:
        buf.dword = cpu_to_le32(data);
        break;
    default:
1023
        hw_error("vfio: unsupported write size, %d bytes", size);
1024 1025 1026 1027 1028 1029 1030 1031
        break;
    }

    if (pwrite(vga->fd, &buf, size, offset) != size) {
        error_report("%s(,0x%"HWADDR_PRIx", 0x%"PRIx64", %d) failed: %m",
                     __func__, region->offset + addr, data, size);
    }

E
Eric Auger 已提交
1032
    trace_vfio_vga_write(region->offset + addr, data, size);
1033 1034
}

1035
uint64_t vfio_vga_read(void *opaque, hwaddr addr, unsigned size)
1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064
{
    VFIOVGARegion *region = opaque;
    VFIOVGA *vga = container_of(region, VFIOVGA, region[region->nr]);
    union {
        uint8_t byte;
        uint16_t word;
        uint32_t dword;
        uint64_t qword;
    } buf;
    uint64_t data = 0;
    off_t offset = vga->fd_offset + region->offset + addr;

    if (pread(vga->fd, &buf, size, offset) != size) {
        error_report("%s(,0x%"HWADDR_PRIx", %d) failed: %m",
                     __func__, region->offset + addr, size);
        return (uint64_t)-1;
    }

    switch (size) {
    case 1:
        data = buf.byte;
        break;
    case 2:
        data = le16_to_cpu(buf.word);
        break;
    case 4:
        data = le32_to_cpu(buf.dword);
        break;
    default:
1065
        hw_error("vfio: unsupported read size, %d bytes", size);
1066 1067 1068
        break;
    }

E
Eric Auger 已提交
1069
    trace_vfio_vga_read(region->offset + addr, size, data);
1070 1071 1072 1073 1074 1075 1076 1077 1078 1079

    return data;
}

static const MemoryRegionOps vfio_vga_ops = {
    .read = vfio_vga_read,
    .write = vfio_vga_write,
    .endianness = DEVICE_LITTLE_ENDIAN,
};

1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
/*
 * Expand memory region of sub-page(size < PAGE_SIZE) MMIO BAR to page
 * size if the BAR is in an exclusive page in host so that we could map
 * this BAR to guest. But this sub-page BAR may not occupy an exclusive
 * page in guest. So we should set the priority of the expanded memory
 * region to zero in case of overlap with BARs which share the same page
 * with the sub-page BAR in guest. Besides, we should also recover the
 * size of this sub-page BAR when its base address is changed in guest
 * and not page aligned any more.
 */
static void vfio_sub_page_bar_update_mapping(PCIDevice *pdev, int bar)
{
1092
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
1093
    VFIORegion *region = &vdev->bars[bar].region;
1094
    MemoryRegion *mmap_mr, *region_mr, *base_mr;
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106
    PCIIORegion *r;
    pcibus_t bar_addr;
    uint64_t size = region->size;

    /* Make sure that the whole region is allowed to be mmapped */
    if (region->nr_mmaps != 1 || !region->mmaps[0].mmap ||
        region->mmaps[0].size != region->size) {
        return;
    }

    r = &pdev->io_regions[bar];
    bar_addr = r->addr;
1107 1108
    base_mr = vdev->bars[bar].mr;
    region_mr = region->mem;
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118
    mmap_mr = &region->mmaps[0].mem;

    /* If BAR is mapped and page aligned, update to fill PAGE_SIZE */
    if (bar_addr != PCI_BAR_UNMAPPED &&
        !(bar_addr & ~qemu_real_host_page_mask)) {
        size = qemu_real_host_page_size;
    }

    memory_region_transaction_begin();

1119 1120 1121 1122
    if (vdev->bars[bar].size < size) {
        memory_region_set_size(base_mr, size);
    }
    memory_region_set_size(region_mr, size);
1123
    memory_region_set_size(mmap_mr, size);
1124 1125
    if (size != vdev->bars[bar].size && memory_region_is_mapped(base_mr)) {
        memory_region_del_subregion(r->address_space, base_mr);
1126
        memory_region_add_subregion_overlap(r->address_space,
1127
                                            bar_addr, base_mr, 0);
1128 1129 1130 1131 1132
    }

    memory_region_transaction_commit();
}

1133 1134 1135
/*
 * PCI config space
 */
1136
uint32_t vfio_pci_read_config(PCIDevice *pdev, uint32_t addr, int len)
1137
{
1138
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
1139
    uint32_t emu_bits = 0, emu_val = 0, phys_val = 0, val;
1140

1141 1142
    memcpy(&emu_bits, vdev->emulated_config_bits + addr, len);
    emu_bits = le32_to_cpu(emu_bits);
1143

1144 1145 1146 1147 1148 1149 1150
    if (emu_bits) {
        emu_val = pci_default_read_config(pdev, addr, len);
    }

    if (~emu_bits & (0xffffffffU >> (32 - len * 8))) {
        ssize_t ret;

1151 1152
        ret = pread(vdev->vbasedev.fd, &phys_val, len,
                    vdev->config_offset + addr);
1153
        if (ret != len) {
1154 1155
            error_report("%s(%s, 0x%x, 0x%x) failed: %m",
                         __func__, vdev->vbasedev.name, addr, len);
1156 1157
            return -errno;
        }
1158
        phys_val = le32_to_cpu(phys_val);
1159 1160
    }

1161
    val = (emu_val & emu_bits) | (phys_val & ~emu_bits);
1162

1163
    trace_vfio_pci_read_config(vdev->vbasedev.name, addr, len, val);
1164 1165 1166 1167

    return val;
}

1168 1169
void vfio_pci_write_config(PCIDevice *pdev,
                           uint32_t addr, uint32_t val, int len)
1170
{
1171
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
1172 1173
    uint32_t val_le = cpu_to_le32(val);

1174
    trace_vfio_pci_write_config(vdev->vbasedev.name, addr, val, len);
1175 1176

    /* Write everything to VFIO, let it filter out what we can't write */
1177 1178
    if (pwrite(vdev->vbasedev.fd, &val_le, len, vdev->config_offset + addr)
                != len) {
1179 1180
        error_report("%s(%s, 0x%x, 0x%x, 0x%x) failed: %m",
                     __func__, vdev->vbasedev.name, addr, val, len);
1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
    }

    /* MSI/MSI-X Enabling/Disabling */
    if (pdev->cap_present & QEMU_PCI_CAP_MSI &&
        ranges_overlap(addr, len, pdev->msi_cap, vdev->msi_cap_size)) {
        int is_enabled, was_enabled = msi_enabled(pdev);

        pci_default_write_config(pdev, addr, val, len);

        is_enabled = msi_enabled(pdev);

1192 1193
        if (!was_enabled) {
            if (is_enabled) {
1194
                vfio_msi_enable(vdev);
1195 1196 1197
            }
        } else {
            if (!is_enabled) {
1198
                vfio_msi_disable(vdev);
1199 1200 1201
            } else {
                vfio_update_msi(vdev);
            }
1202
        }
1203
    } else if (pdev->cap_present & QEMU_PCI_CAP_MSIX &&
1204 1205 1206 1207 1208 1209 1210 1211
        ranges_overlap(addr, len, pdev->msix_cap, MSIX_CAP_LENGTH)) {
        int is_enabled, was_enabled = msix_enabled(pdev);

        pci_default_write_config(pdev, addr, val, len);

        is_enabled = msix_enabled(pdev);

        if (!was_enabled && is_enabled) {
1212
            vfio_msix_enable(vdev);
1213
        } else if (was_enabled && !is_enabled) {
1214
            vfio_msix_disable(vdev);
1215
        }
1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228
    } else if (ranges_overlap(addr, len, PCI_BASE_ADDRESS_0, 24) ||
        range_covers_byte(addr, len, PCI_COMMAND)) {
        pcibus_t old_addr[PCI_NUM_REGIONS - 1];
        int bar;

        for (bar = 0; bar < PCI_ROM_SLOT; bar++) {
            old_addr[bar] = pdev->io_regions[bar].addr;
        }

        pci_default_write_config(pdev, addr, val, len);

        for (bar = 0; bar < PCI_ROM_SLOT; bar++) {
            if (old_addr[bar] != pdev->io_regions[bar].addr &&
1229 1230
                vdev->bars[bar].region.size > 0 &&
                vdev->bars[bar].region.size < qemu_real_host_page_size) {
1231 1232 1233
                vfio_sub_page_bar_update_mapping(pdev, bar);
            }
        }
1234 1235 1236
    } else {
        /* Write everything to QEMU to keep emulated bits correct */
        pci_default_write_config(pdev, addr, val, len);
1237 1238 1239 1240 1241 1242
    }
}

/*
 * Interrupt setup
 */
1243
static void vfio_disable_interrupts(VFIOPCIDevice *vdev)
1244
{
1245 1246 1247 1248 1249 1250
    /*
     * More complicated than it looks.  Disabling MSI/X transitions the
     * device to INTx mode (if supported).  Therefore we need to first
     * disable MSI/X and then cleanup by disabling INTx.
     */
    if (vdev->interrupt == VFIO_INT_MSIX) {
1251
        vfio_msix_disable(vdev);
1252
    } else if (vdev->interrupt == VFIO_INT_MSI) {
1253
        vfio_msi_disable(vdev);
1254 1255 1256
    }

    if (vdev->interrupt == VFIO_INT_INTx) {
1257
        vfio_intx_disable(vdev);
1258 1259 1260
    }
}

1261
static int vfio_msi_setup(VFIOPCIDevice *vdev, int pos, Error **errp)
1262 1263 1264 1265
{
    uint16_t ctrl;
    bool msi_64bit, msi_maskbit;
    int ret, entries;
1266
    Error *err = NULL;
1267

1268
    if (pread(vdev->vbasedev.fd, &ctrl, sizeof(ctrl),
1269
              vdev->config_offset + pos + PCI_CAP_FLAGS) != sizeof(ctrl)) {
1270
        error_setg_errno(errp, errno, "failed reading MSI PCI_CAP_FLAGS");
1271 1272 1273 1274 1275 1276 1277 1278
        return -errno;
    }
    ctrl = le16_to_cpu(ctrl);

    msi_64bit = !!(ctrl & PCI_MSI_FLAGS_64BIT);
    msi_maskbit = !!(ctrl & PCI_MSI_FLAGS_MASKBIT);
    entries = 1 << ((ctrl & PCI_MSI_FLAGS_QMASK) >> 1);

1279
    trace_vfio_msi_setup(vdev->vbasedev.name, pos);
1280

1281
    ret = msi_init(&vdev->pdev, pos, entries, msi_64bit, msi_maskbit, &err);
1282
    if (ret < 0) {
1283 1284 1285
        if (ret == -ENOTSUP) {
            return 0;
        }
1286
        error_propagate_prepend(errp, err, "msi_init failed: ");
1287 1288 1289 1290 1291 1292 1293
        return ret;
    }
    vdev->msi_cap_size = 0xa + (msi_maskbit ? 0xa : 0) + (msi_64bit ? 0x4 : 0);

    return 0;
}

1294 1295 1296 1297 1298
static void vfio_pci_fixup_msix_region(VFIOPCIDevice *vdev)
{
    off_t start, end;
    VFIORegion *region = &vdev->bars[vdev->msix->table_bar].region;

1299 1300 1301 1302 1303 1304 1305 1306 1307
    /*
     * If the host driver allows mapping of a MSIX data, we are going to
     * do map the entire BAR and emulate MSIX table on top of that.
     */
    if (vfio_has_region_cap(&vdev->vbasedev, region->nr,
                            VFIO_REGION_INFO_CAP_MSIX_MAPPABLE)) {
        return;
    }

1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370
    /*
     * We expect to find a single mmap covering the whole BAR, anything else
     * means it's either unsupported or already setup.
     */
    if (region->nr_mmaps != 1 || region->mmaps[0].offset ||
        region->size != region->mmaps[0].size) {
        return;
    }

    /* MSI-X table start and end aligned to host page size */
    start = vdev->msix->table_offset & qemu_real_host_page_mask;
    end = REAL_HOST_PAGE_ALIGN((uint64_t)vdev->msix->table_offset +
                               (vdev->msix->entries * PCI_MSIX_ENTRY_SIZE));

    /*
     * Does the MSI-X table cover the beginning of the BAR?  The whole BAR?
     * NB - Host page size is necessarily a power of two and so is the PCI
     * BAR (not counting EA yet), therefore if we have host page aligned
     * @start and @end, then any remainder of the BAR before or after those
     * must be at least host page sized and therefore mmap'able.
     */
    if (!start) {
        if (end >= region->size) {
            region->nr_mmaps = 0;
            g_free(region->mmaps);
            region->mmaps = NULL;
            trace_vfio_msix_fixup(vdev->vbasedev.name,
                                  vdev->msix->table_bar, 0, 0);
        } else {
            region->mmaps[0].offset = end;
            region->mmaps[0].size = region->size - end;
            trace_vfio_msix_fixup(vdev->vbasedev.name,
                              vdev->msix->table_bar, region->mmaps[0].offset,
                              region->mmaps[0].offset + region->mmaps[0].size);
        }

    /* Maybe it's aligned at the end of the BAR */
    } else if (end >= region->size) {
        region->mmaps[0].size = start;
        trace_vfio_msix_fixup(vdev->vbasedev.name,
                              vdev->msix->table_bar, region->mmaps[0].offset,
                              region->mmaps[0].offset + region->mmaps[0].size);

    /* Otherwise it must split the BAR */
    } else {
        region->nr_mmaps = 2;
        region->mmaps = g_renew(VFIOMmap, region->mmaps, 2);

        memcpy(&region->mmaps[1], &region->mmaps[0], sizeof(VFIOMmap));

        region->mmaps[0].size = start;
        trace_vfio_msix_fixup(vdev->vbasedev.name,
                              vdev->msix->table_bar, region->mmaps[0].offset,
                              region->mmaps[0].offset + region->mmaps[0].size);

        region->mmaps[1].offset = end;
        region->mmaps[1].size = region->size - end;
        trace_vfio_msix_fixup(vdev->vbasedev.name,
                              vdev->msix->table_bar, region->mmaps[1].offset,
                              region->mmaps[1].offset + region->mmaps[1].size);
    }
}

1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421
static void vfio_pci_relocate_msix(VFIOPCIDevice *vdev, Error **errp)
{
    int target_bar = -1;
    size_t msix_sz;

    if (!vdev->msix || vdev->msix_relo == OFF_AUTOPCIBAR_OFF) {
        return;
    }

    /* The actual minimum size of MSI-X structures */
    msix_sz = (vdev->msix->entries * PCI_MSIX_ENTRY_SIZE) +
              (QEMU_ALIGN_UP(vdev->msix->entries, 64) / 8);
    /* Round up to host pages, we don't want to share a page */
    msix_sz = REAL_HOST_PAGE_ALIGN(msix_sz);
    /* PCI BARs must be a power of 2 */
    msix_sz = pow2ceil(msix_sz);

    if (vdev->msix_relo == OFF_AUTOPCIBAR_AUTO) {
        /*
         * TODO: Lookup table for known devices.
         *
         * Logically we might use an algorithm here to select the BAR adding
         * the least additional MMIO space, but we cannot programatically
         * predict the driver dependency on BAR ordering or sizing, therefore
         * 'auto' becomes a lookup for combinations reported to work.
         */
        if (target_bar < 0) {
            error_setg(errp, "No automatic MSI-X relocation available for "
                       "device %04x:%04x", vdev->vendor_id, vdev->device_id);
            return;
        }
    } else {
        target_bar = (int)(vdev->msix_relo - OFF_AUTOPCIBAR_BAR0);
    }

    /* I/O port BARs cannot host MSI-X structures */
    if (vdev->bars[target_bar].ioport) {
        error_setg(errp, "Invalid MSI-X relocation BAR %d, "
                   "I/O port BAR", target_bar);
        return;
    }

    /* Cannot use a BAR in the "shadow" of a 64-bit BAR */
    if (!vdev->bars[target_bar].size &&
         target_bar > 0 && vdev->bars[target_bar - 1].mem64) {
        error_setg(errp, "Invalid MSI-X relocation BAR %d, "
                   "consumed by 64-bit BAR %d", target_bar, target_bar - 1);
        return;
    }

    /* 2GB max size for 32-bit BARs, cannot double if already > 1G */
1422
    if (vdev->bars[target_bar].size > 1 * GiB &&
1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462
        !vdev->bars[target_bar].mem64) {
        error_setg(errp, "Invalid MSI-X relocation BAR %d, "
                   "no space to extend 32-bit BAR", target_bar);
        return;
    }

    /*
     * If adding a new BAR, test if we can make it 64bit.  We make it
     * prefetchable since QEMU MSI-X emulation has no read side effects
     * and doing so makes mapping more flexible.
     */
    if (!vdev->bars[target_bar].size) {
        if (target_bar < (PCI_ROM_SLOT - 1) &&
            !vdev->bars[target_bar + 1].size) {
            vdev->bars[target_bar].mem64 = true;
            vdev->bars[target_bar].type = PCI_BASE_ADDRESS_MEM_TYPE_64;
        }
        vdev->bars[target_bar].type |= PCI_BASE_ADDRESS_MEM_PREFETCH;
        vdev->bars[target_bar].size = msix_sz;
        vdev->msix->table_offset = 0;
    } else {
        vdev->bars[target_bar].size = MAX(vdev->bars[target_bar].size * 2,
                                          msix_sz * 2);
        /*
         * Due to above size calc, MSI-X always starts halfway into the BAR,
         * which will always be a separate host page.
         */
        vdev->msix->table_offset = vdev->bars[target_bar].size / 2;
    }

    vdev->msix->table_bar = target_bar;
    vdev->msix->pba_bar = target_bar;
    /* Requires 8-byte alignment, but PCI_MSIX_ENTRY_SIZE guarantees that */
    vdev->msix->pba_offset = vdev->msix->table_offset +
                                  (vdev->msix->entries * PCI_MSIX_ENTRY_SIZE);

    trace_vfio_msix_relo(vdev->vbasedev.name,
                         vdev->msix->table_bar, vdev->msix->table_offset);
}

1463 1464 1465 1466 1467 1468 1469 1470
/*
 * We don't have any control over how pci_add_capability() inserts
 * capabilities into the chain.  In order to setup MSI-X we need a
 * MemoryRegion for the BAR.  In order to setup the BAR and not
 * attempt to mmap the MSI-X table area, which VFIO won't allow, we
 * need to first look for where the MSI-X table lives.  So we
 * unfortunately split MSI-X setup across two functions.
 */
1471
static void vfio_msix_early_setup(VFIOPCIDevice *vdev, Error **errp)
1472 1473 1474 1475
{
    uint8_t pos;
    uint16_t ctrl;
    uint32_t table, pba;
1476
    int fd = vdev->vbasedev.fd;
1477
    VFIOMSIXInfo *msix;
1478 1479 1480

    pos = pci_find_capability(&vdev->pdev, PCI_CAP_ID_MSIX);
    if (!pos) {
1481
        return;
1482 1483
    }

1484
    if (pread(fd, &ctrl, sizeof(ctrl),
1485
              vdev->config_offset + pos + PCI_MSIX_FLAGS) != sizeof(ctrl)) {
1486
        error_setg_errno(errp, errno, "failed to read PCI MSIX FLAGS");
1487
        return;
1488 1489
    }

1490
    if (pread(fd, &table, sizeof(table),
1491
              vdev->config_offset + pos + PCI_MSIX_TABLE) != sizeof(table)) {
1492
        error_setg_errno(errp, errno, "failed to read PCI MSIX TABLE");
1493
        return;
1494 1495
    }

1496
    if (pread(fd, &pba, sizeof(pba),
1497
              vdev->config_offset + pos + PCI_MSIX_PBA) != sizeof(pba)) {
1498
        error_setg_errno(errp, errno, "failed to read PCI MSIX PBA");
1499
        return;
1500 1501 1502 1503 1504 1505
    }

    ctrl = le16_to_cpu(ctrl);
    table = le32_to_cpu(table);
    pba = le32_to_cpu(pba);

1506 1507 1508 1509 1510 1511
    msix = g_malloc0(sizeof(*msix));
    msix->table_bar = table & PCI_MSIX_FLAGS_BIRMASK;
    msix->table_offset = table & ~PCI_MSIX_FLAGS_BIRMASK;
    msix->pba_bar = pba & PCI_MSIX_FLAGS_BIRMASK;
    msix->pba_offset = pba & ~PCI_MSIX_FLAGS_BIRMASK;
    msix->entries = (ctrl & PCI_MSIX_FLAGS_QSIZE) + 1;
1512

1513 1514 1515 1516 1517
    /*
     * Test the size of the pba_offset variable and catch if it extends outside
     * of the specified BAR. If it is the case, we need to apply a hardware
     * specific quirk if the device is known or we have a broken configuration.
     */
1518
    if (msix->pba_offset >= vdev->bars[msix->pba_bar].region.size) {
1519 1520 1521 1522 1523 1524
        /*
         * Chelsio T5 Virtual Function devices are encoded as 0x58xx for T5
         * adapters. The T5 hardware returns an incorrect value of 0x8000 for
         * the VF PBA offset while the BAR itself is only 8k. The correct value
         * is 0x1000, so we hard code that here.
         */
1525 1526
        if (vdev->vendor_id == PCI_VENDOR_ID_CHELSIO &&
            (vdev->device_id & 0xff00) == 0x5800) {
1527
            msix->pba_offset = 0x1000;
1528
        } else {
1529 1530
            error_setg(errp, "hardware reports invalid configuration, "
                       "MSIX PBA outside of specified BAR");
1531
            g_free(msix);
1532
            return;
1533 1534 1535
        }
    }

1536
    trace_vfio_msix_early_setup(vdev->vbasedev.name, pos, msix->table_bar,
1537 1538
                                msix->table_offset, msix->entries);
    vdev->msix = msix;
1539

1540
    vfio_pci_fixup_msix_region(vdev);
1541 1542

    vfio_pci_relocate_msix(vdev, errp);
1543 1544
}

1545
static int vfio_msix_setup(VFIOPCIDevice *vdev, int pos, Error **errp)
1546 1547
{
    int ret;
1548
    Error *err = NULL;
1549

A
Alex Williamson 已提交
1550 1551
    vdev->msix->pending = g_malloc0(BITS_TO_LONGS(vdev->msix->entries) *
                                    sizeof(unsigned long));
1552
    ret = msix_init(&vdev->pdev, vdev->msix->entries,
1553
                    vdev->bars[vdev->msix->table_bar].mr,
1554
                    vdev->msix->table_bar, vdev->msix->table_offset,
1555
                    vdev->bars[vdev->msix->pba_bar].mr,
1556 1557
                    vdev->msix->pba_bar, vdev->msix->pba_offset, pos,
                    &err);
1558
    if (ret < 0) {
1559
        if (ret == -ENOTSUP) {
1560
            warn_report_err(err);
1561 1562
            return 0;
        }
1563 1564

        error_propagate(errp, err);
1565 1566 1567
        return ret;
    }

A
Alex Williamson 已提交
1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585
    /*
     * The PCI spec suggests that devices provide additional alignment for
     * MSI-X structures and avoid overlapping non-MSI-X related registers.
     * For an assigned device, this hopefully means that emulation of MSI-X
     * structures does not affect the performance of the device.  If devices
     * fail to provide that alignment, a significant performance penalty may
     * result, for instance Mellanox MT27500 VFs:
     * http://www.spinics.net/lists/kvm/msg125881.html
     *
     * The PBA is simply not that important for such a serious regression and
     * most drivers do not appear to look at it.  The solution for this is to
     * disable the PBA MemoryRegion unless it's being used.  We disable it
     * here and only enable it if a masked vector fires through QEMU.  As the
     * vector-use notifier is called, which occurs on unmask, we test whether
     * PBA emulation is needed and again disable if not.
     */
    memory_region_set_enabled(&vdev->pdev.msix_pba_mmio, false);

1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598
    /*
     * The emulated machine may provide a paravirt interface for MSIX setup
     * so it is not strictly necessary to emulate MSIX here. This becomes
     * helpful when frequently accessed MMIO registers are located in
     * subpages adjacent to the MSIX table but the MSIX data containing page
     * cannot be mapped because of a host page size bigger than the MSIX table
     * alignment.
     */
    if (object_property_get_bool(OBJECT(qdev_get_machine()),
                                 "vfio-no-msix-emulation", NULL)) {
        memory_region_set_enabled(&vdev->pdev.msix_table_mmio, false);
    }

1599 1600 1601
    return 0;
}

1602
static void vfio_teardown_msi(VFIOPCIDevice *vdev)
1603 1604 1605 1606
{
    msi_uninit(&vdev->pdev);

    if (vdev->msix) {
E
Eric Auger 已提交
1607
        msix_uninit(&vdev->pdev,
1608 1609
                    vdev->bars[vdev->msix->table_bar].mr,
                    vdev->bars[vdev->msix->pba_bar].mr);
A
Alex Williamson 已提交
1610
        g_free(vdev->msix->pending);
1611 1612 1613 1614 1615 1616
    }
}

/*
 * Resource setup
 */
1617
static void vfio_mmap_set_enabled(VFIOPCIDevice *vdev, bool enabled)
1618 1619 1620 1621
{
    int i;

    for (i = 0; i < PCI_ROM_SLOT; i++) {
1622
        vfio_region_mmaps_set_enabled(&vdev->bars[i].region, enabled);
1623 1624 1625
    }
}

1626
static void vfio_bar_prepare(VFIOPCIDevice *vdev, int nr)
1627 1628 1629 1630 1631 1632 1633
{
    VFIOBAR *bar = &vdev->bars[nr];

    uint32_t pci_bar;
    int ret;

    /* Skip both unimplemented BARs and the upper half of 64bit BARS. */
1634
    if (!bar->region.size) {
1635 1636 1637 1638
        return;
    }

    /* Determine what type of BAR this is for registration */
1639
    ret = pread(vdev->vbasedev.fd, &pci_bar, sizeof(pci_bar),
1640 1641
                vdev->config_offset + PCI_BASE_ADDRESS_0 + (4 * nr));
    if (ret != sizeof(pci_bar)) {
1642
        error_report("vfio: Failed to read BAR %d (%m)", nr);
1643 1644 1645 1646
        return;
    }

    pci_bar = le32_to_cpu(pci_bar);
A
Alex Williamson 已提交
1647 1648
    bar->ioport = (pci_bar & PCI_BASE_ADDRESS_SPACE_IO);
    bar->mem64 = bar->ioport ? 0 : (pci_bar & PCI_BASE_ADDRESS_MEM_TYPE_64);
1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666
    bar->type = pci_bar & (bar->ioport ? ~PCI_BASE_ADDRESS_IO_MASK :
                                         ~PCI_BASE_ADDRESS_MEM_MASK);
    bar->size = bar->region.size;
}

static void vfio_bars_prepare(VFIOPCIDevice *vdev)
{
    int i;

    for (i = 0; i < PCI_ROM_SLOT; i++) {
        vfio_bar_prepare(vdev, i);
    }
}

static void vfio_bar_register(VFIOPCIDevice *vdev, int nr)
{
    VFIOBAR *bar = &vdev->bars[nr];
    char *name;
1667

1668 1669
    if (!bar->size) {
        return;
1670
    }
1671

1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686
    bar->mr = g_new0(MemoryRegion, 1);
    name = g_strdup_printf("%s base BAR %d", vdev->vbasedev.name, nr);
    memory_region_init_io(bar->mr, OBJECT(vdev), NULL, NULL, name, bar->size);
    g_free(name);

    if (bar->region.size) {
        memory_region_add_subregion(bar->mr, 0, bar->region.mem);

        if (vfio_region_mmap(&bar->region)) {
            error_report("Failed to mmap %s BAR %d. Performance may be slow",
                         vdev->vbasedev.name, nr);
        }
    }

    pci_register_bar(&vdev->pdev, nr, bar->type, bar->mr);
1687 1688
}

1689
static void vfio_bars_register(VFIOPCIDevice *vdev)
1690 1691 1692 1693
{
    int i;

    for (i = 0; i < PCI_ROM_SLOT; i++) {
1694
        vfio_bar_register(vdev, i);
1695 1696 1697
    }
}

1698
static void vfio_bars_exit(VFIOPCIDevice *vdev)
1699 1700 1701 1702
{
    int i;

    for (i = 0; i < PCI_ROM_SLOT; i++) {
1703 1704
        VFIOBAR *bar = &vdev->bars[i];

1705
        vfio_bar_quirk_exit(vdev, i);
1706 1707 1708 1709
        vfio_region_exit(&bar->region);
        if (bar->region.size) {
            memory_region_del_subregion(bar->mr, bar->region.mem);
        }
1710
    }
1711

1712
    if (vdev->vga) {
1713
        pci_unregister_vga(&vdev->pdev);
1714
        vfio_vga_quirk_exit(vdev);
1715
    }
1716 1717
}

1718
static void vfio_bars_finalize(VFIOPCIDevice *vdev)
1719 1720 1721 1722
{
    int i;

    for (i = 0; i < PCI_ROM_SLOT; i++) {
1723 1724
        VFIOBAR *bar = &vdev->bars[i];

1725
        vfio_bar_quirk_finalize(vdev, i);
1726 1727 1728 1729 1730
        vfio_region_finalize(&bar->region);
        if (bar->size) {
            object_unparent(OBJECT(bar->mr));
            g_free(bar->mr);
        }
1731 1732
    }

1733 1734 1735 1736 1737 1738
    if (vdev->vga) {
        vfio_vga_quirk_finalize(vdev);
        for (i = 0; i < ARRAY_SIZE(vdev->vga->region); i++) {
            object_unparent(OBJECT(&vdev->vga->region[i].mem));
        }
        g_free(vdev->vga);
1739 1740 1741
    }
}

1742 1743 1744 1745 1746
/*
 * General setup
 */
static uint8_t vfio_std_cap_max_size(PCIDevice *pdev, uint8_t pos)
{
1747 1748
    uint8_t tmp;
    uint16_t next = PCI_CONFIG_SPACE_SIZE;
1749 1750

    for (tmp = pdev->config[PCI_CAPABILITY_LIST]; tmp;
1751
         tmp = pdev->config[tmp + PCI_CAP_LIST_NEXT]) {
1752 1753 1754 1755 1756 1757 1758 1759
        if (tmp > pos && tmp < next) {
            next = tmp;
        }
    }

    return next - pos;
}

1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774

static uint16_t vfio_ext_cap_max_size(const uint8_t *config, uint16_t pos)
{
    uint16_t tmp, next = PCIE_CONFIG_SPACE_SIZE;

    for (tmp = PCI_CONFIG_SPACE_SIZE; tmp;
        tmp = PCI_EXT_CAP_NEXT(pci_get_long(config + tmp))) {
        if (tmp > pos && tmp < next) {
            next = tmp;
        }
    }

    return next - pos;
}

1775 1776 1777 1778 1779
static void vfio_set_word_bits(uint8_t *buf, uint16_t val, uint16_t mask)
{
    pci_set_word(buf, (pci_get_word(buf) & ~mask) | val);
}

1780
static void vfio_add_emulated_word(VFIOPCIDevice *vdev, int pos,
1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792
                                   uint16_t val, uint16_t mask)
{
    vfio_set_word_bits(vdev->pdev.config + pos, val, mask);
    vfio_set_word_bits(vdev->pdev.wmask + pos, ~mask, mask);
    vfio_set_word_bits(vdev->emulated_config_bits + pos, mask, mask);
}

static void vfio_set_long_bits(uint8_t *buf, uint32_t val, uint32_t mask)
{
    pci_set_long(buf, (pci_get_long(buf) & ~mask) | val);
}

1793
static void vfio_add_emulated_long(VFIOPCIDevice *vdev, int pos,
1794 1795 1796 1797 1798 1799 1800
                                   uint32_t val, uint32_t mask)
{
    vfio_set_long_bits(vdev->pdev.config + pos, val, mask);
    vfio_set_long_bits(vdev->pdev.wmask + pos, ~mask, mask);
    vfio_set_long_bits(vdev->emulated_config_bits + pos, mask, mask);
}

1801 1802
static int vfio_setup_pcie_cap(VFIOPCIDevice *vdev, int pos, uint8_t size,
                               Error **errp)
1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813
{
    uint16_t flags;
    uint8_t type;

    flags = pci_get_word(vdev->pdev.config + pos + PCI_CAP_FLAGS);
    type = (flags & PCI_EXP_FLAGS_TYPE) >> 4;

    if (type != PCI_EXP_TYPE_ENDPOINT &&
        type != PCI_EXP_TYPE_LEG_END &&
        type != PCI_EXP_TYPE_RC_END) {

1814 1815
        error_setg(errp, "assignment of PCIe type 0x%x "
                   "devices is not currently supported", type);
1816 1817 1818
        return -EINVAL;
    }

1819 1820
    if (!pci_bus_is_express(pci_get_bus(&vdev->pdev))) {
        PCIBus *bus = pci_get_bus(&vdev->pdev);
1821 1822
        PCIDevice *bridge;

1823
        /*
1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841
         * Traditionally PCI device assignment exposes the PCIe capability
         * as-is on non-express buses.  The reason being that some drivers
         * simply assume that it's there, for example tg3.  However when
         * we're running on a native PCIe machine type, like Q35, we need
         * to hide the PCIe capability.  The reason for this is twofold;
         * first Windows guests get a Code 10 error when the PCIe capability
         * is exposed in this configuration.  Therefore express devices won't
         * work at all unless they're attached to express buses in the VM.
         * Second, a native PCIe machine introduces the possibility of fine
         * granularity IOMMUs supporting both translation and isolation.
         * Guest code to discover the IOMMU visibility of a device, such as
         * IOMMU grouping code on Linux, is very aware of device types and
         * valid transitions between bus types.  An express device on a non-
         * express bus is not a valid combination on bare metal systems.
         *
         * Drivers that require a PCIe capability to make the device
         * functional are simply going to need to have their devices placed
         * on a PCIe bus in the VM.
1842
         */
1843 1844
        while (!pci_bus_is_root(bus)) {
            bridge = pci_bridge_get_device(bus);
1845
            bus = pci_get_bus(bridge);
1846 1847 1848 1849 1850 1851
        }

        if (pci_bus_is_express(bus)) {
            return 0;
        }

1852
    } else if (pci_bus_is_root(pci_get_bus(&vdev->pdev))) {
1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899
        /*
         * On a Root Complex bus Endpoints become Root Complex Integrated
         * Endpoints, which changes the type and clears the LNK & LNK2 fields.
         */
        if (type == PCI_EXP_TYPE_ENDPOINT) {
            vfio_add_emulated_word(vdev, pos + PCI_CAP_FLAGS,
                                   PCI_EXP_TYPE_RC_END << 4,
                                   PCI_EXP_FLAGS_TYPE);

            /* Link Capabilities, Status, and Control goes away */
            if (size > PCI_EXP_LNKCTL) {
                vfio_add_emulated_long(vdev, pos + PCI_EXP_LNKCAP, 0, ~0);
                vfio_add_emulated_word(vdev, pos + PCI_EXP_LNKCTL, 0, ~0);
                vfio_add_emulated_word(vdev, pos + PCI_EXP_LNKSTA, 0, ~0);

#ifndef PCI_EXP_LNKCAP2
#define PCI_EXP_LNKCAP2 44
#endif
#ifndef PCI_EXP_LNKSTA2
#define PCI_EXP_LNKSTA2 50
#endif
                /* Link 2 Capabilities, Status, and Control goes away */
                if (size > PCI_EXP_LNKCAP2) {
                    vfio_add_emulated_long(vdev, pos + PCI_EXP_LNKCAP2, 0, ~0);
                    vfio_add_emulated_word(vdev, pos + PCI_EXP_LNKCTL2, 0, ~0);
                    vfio_add_emulated_word(vdev, pos + PCI_EXP_LNKSTA2, 0, ~0);
                }
            }

        } else if (type == PCI_EXP_TYPE_LEG_END) {
            /*
             * Legacy endpoints don't belong on the root complex.  Windows
             * seems to be happier with devices if we skip the capability.
             */
            return 0;
        }

    } else {
        /*
         * Convert Root Complex Integrated Endpoints to regular endpoints.
         * These devices don't support LNK/LNK2 capabilities, so make them up.
         */
        if (type == PCI_EXP_TYPE_RC_END) {
            vfio_add_emulated_word(vdev, pos + PCI_CAP_FLAGS,
                                   PCI_EXP_TYPE_ENDPOINT << 4,
                                   PCI_EXP_FLAGS_TYPE);
            vfio_add_emulated_long(vdev, pos + PCI_EXP_LNKCAP,
1900 1901
                           QEMU_PCI_EXP_LNKCAP_MLW(QEMU_PCI_EXP_LNK_X1) |
                           QEMU_PCI_EXP_LNKCAP_MLS(QEMU_PCI_EXP_LNK_2_5GT), ~0);
1902 1903 1904 1905
            vfio_add_emulated_word(vdev, pos + PCI_EXP_LNKCTL, 0, ~0);
        }
    }

1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917
    /*
     * Intel 82599 SR-IOV VFs report an invalid PCIe capability version 0
     * (Niantic errate #35) causing Windows to error with a Code 10 for the
     * device on Q35.  Fixup any such devices to report version 1.  If we
     * were to remove the capability entirely the guest would lose extended
     * config space.
     */
    if ((flags & PCI_EXP_FLAGS_VERS) == 0) {
        vfio_add_emulated_word(vdev, pos + PCI_CAP_FLAGS,
                               1, PCI_EXP_FLAGS_VERS);
    }

1918 1919 1920 1921
    pos = pci_add_capability(&vdev->pdev, PCI_CAP_ID_EXP, pos, size,
                             errp);
    if (pos < 0) {
        return pos;
1922 1923
    }

1924 1925
    vdev->pdev.exp.exp_cap = pos;

1926 1927 1928
    return pos;
}

1929
static void vfio_check_pcie_flr(VFIOPCIDevice *vdev, uint8_t pos)
1930 1931 1932 1933
{
    uint32_t cap = pci_get_long(vdev->pdev.config + pos + PCI_EXP_DEVCAP);

    if (cap & PCI_EXP_DEVCAP_FLR) {
1934
        trace_vfio_check_pcie_flr(vdev->vbasedev.name);
1935 1936 1937 1938
        vdev->has_flr = true;
    }
}

1939
static void vfio_check_pm_reset(VFIOPCIDevice *vdev, uint8_t pos)
1940 1941 1942 1943
{
    uint16_t csr = pci_get_word(vdev->pdev.config + pos + PCI_PM_CTRL);

    if (!(csr & PCI_PM_CTRL_NO_SOFT_RESET)) {
1944
        trace_vfio_check_pm_reset(vdev->vbasedev.name);
1945 1946 1947 1948
        vdev->has_pm_reset = true;
    }
}

1949
static void vfio_check_af_flr(VFIOPCIDevice *vdev, uint8_t pos)
1950 1951 1952 1953
{
    uint8_t cap = pci_get_byte(vdev->pdev.config + pos + PCI_AF_CAP);

    if ((cap & PCI_AF_CAP_TP) && (cap & PCI_AF_CAP_FLR)) {
1954
        trace_vfio_check_af_flr(vdev->vbasedev.name);
1955 1956 1957 1958
        vdev->has_flr = true;
    }
}

1959
static int vfio_add_std_cap(VFIOPCIDevice *vdev, uint8_t pos, Error **errp)
1960 1961 1962 1963 1964 1965
{
    PCIDevice *pdev = &vdev->pdev;
    uint8_t cap_id, next, size;
    int ret;

    cap_id = pdev->config[pos];
1966
    next = pdev->config[pos + PCI_CAP_LIST_NEXT];
1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979

    /*
     * If it becomes important to configure capabilities to their actual
     * size, use this as the default when it's something we don't recognize.
     * Since QEMU doesn't actually handle many of the config accesses,
     * exact size doesn't seem worthwhile.
     */
    size = vfio_std_cap_max_size(pdev, pos);

    /*
     * pci_add_capability always inserts the new capability at the head
     * of the chain.  Therefore to end up with a chain that matches the
     * physical device, we insert from the end by making this recursive.
1980
     * This is also why we pre-calculate size above as cached config space
1981 1982 1983
     * will be changed as we unwind the stack.
     */
    if (next) {
1984
        ret = vfio_add_std_cap(vdev, next, errp);
1985
        if (ret) {
A
Alex Williamson 已提交
1986
            return ret;
1987 1988
        }
    } else {
1989 1990 1991 1992
        /* Begin the rebuild, use QEMU emulated list bits */
        pdev->config[PCI_CAPABILITY_LIST] = 0;
        vdev->emulated_config_bits[PCI_CAPABILITY_LIST] = 0xff;
        vdev->emulated_config_bits[PCI_STATUS] |= PCI_STATUS_CAP_LIST;
1993 1994 1995 1996 1997

        ret = vfio_add_virt_caps(vdev, errp);
        if (ret) {
            return ret;
        }
1998 1999
    }

2000 2001 2002
    /* Scale down size, esp in case virt caps were added above */
    size = MIN(size, vfio_std_cap_max_size(pdev, pos));

2003
    /* Use emulated next pointer to allow dropping caps */
2004
    pci_set_byte(vdev->emulated_config_bits + pos + PCI_CAP_LIST_NEXT, 0xff);
2005

2006 2007
    switch (cap_id) {
    case PCI_CAP_ID_MSI:
2008
        ret = vfio_msi_setup(vdev, pos, errp);
2009
        break;
2010
    case PCI_CAP_ID_EXP:
2011
        vfio_check_pcie_flr(vdev, pos);
2012
        ret = vfio_setup_pcie_cap(vdev, pos, size, errp);
2013
        break;
2014
    case PCI_CAP_ID_MSIX:
2015
        ret = vfio_msix_setup(vdev, pos, errp);
2016
        break;
2017
    case PCI_CAP_ID_PM:
2018
        vfio_check_pm_reset(vdev, pos);
2019
        vdev->pm_cap = pos;
2020
        ret = pci_add_capability(pdev, cap_id, pos, size, errp);
2021 2022 2023
        break;
    case PCI_CAP_ID_AF:
        vfio_check_af_flr(vdev, pos);
2024
        ret = pci_add_capability(pdev, cap_id, pos, size, errp);
2025
        break;
2026
    default:
2027
        ret = pci_add_capability(pdev, cap_id, pos, size, errp);
2028 2029
        break;
    }
A
Alex Williamson 已提交
2030

2031
    if (ret < 0) {
2032 2033 2034
        error_prepend(errp,
                      "failed to add PCI capability 0x%x[0x%x]@0x%x: ",
                      cap_id, size, pos);
2035 2036 2037 2038 2039 2040
        return ret;
    }

    return 0;
}

2041
static void vfio_add_ext_cap(VFIOPCIDevice *vdev)
2042 2043 2044 2045 2046 2047 2048
{
    PCIDevice *pdev = &vdev->pdev;
    uint32_t header;
    uint16_t cap_id, next, size;
    uint8_t cap_ver;
    uint8_t *config;

2049
    /* Only add extended caps if we have them and the guest can see them */
2050
    if (!pci_is_express(pdev) || !pci_bus_is_express(pci_get_bus(pdev)) ||
2051
        !pci_get_long(pdev->config + PCI_CONFIG_SPACE_SIZE)) {
2052
        return;
2053 2054
    }

2055 2056 2057 2058 2059 2060 2061 2062
    /*
     * pcie_add_capability always inserts the new capability at the tail
     * of the chain.  Therefore to end up with a chain that matches the
     * physical device, we cache the config space to avoid overwriting
     * the original config space when we parse the extended capabilities.
     */
    config = g_memdup(pdev->config, vdev->config_size);

2063 2064 2065
    /*
     * Extended capabilities are chained with each pointing to the next, so we
     * can drop anything other than the head of the chain simply by modifying
2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085
     * the previous next pointer.  Seed the head of the chain here such that
     * we can simply skip any capabilities we want to drop below, regardless
     * of their position in the chain.  If this stub capability still exists
     * after we add the capabilities we want to expose, update the capability
     * ID to zero.  Note that we cannot seed with the capability header being
     * zero as this conflicts with definition of an absent capability chain
     * and prevents capabilities beyond the head of the list from being added.
     * By replacing the dummy capability ID with zero after walking the device
     * chain, we also transparently mark extended capabilities as absent if
     * no capabilities were added.  Note that the PCIe spec defines an absence
     * of extended capabilities to be determined by a value of zero for the
     * capability ID, version, AND next pointer.  A non-zero next pointer
     * should be sufficient to indicate additional capabilities are present,
     * which will occur if we call pcie_add_capability() below.  The entire
     * first dword is emulated to support this.
     *
     * NB. The kernel side does similar masking, so be prepared that our
     * view of the device may also contain a capability ID zero in the head
     * of the chain.  Skip it for the same reason that we cannot seed the
     * chain with a zero capability.
2086 2087 2088 2089 2090 2091
     */
    pci_set_long(pdev->config + PCI_CONFIG_SPACE_SIZE,
                 PCI_EXT_CAP(0xFFFF, 0, 0));
    pci_set_long(pdev->wmask + PCI_CONFIG_SPACE_SIZE, 0);
    pci_set_long(vdev->emulated_config_bits + PCI_CONFIG_SPACE_SIZE, ~0);

2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108
    for (next = PCI_CONFIG_SPACE_SIZE; next;
         next = PCI_EXT_CAP_NEXT(pci_get_long(config + next))) {
        header = pci_get_long(config + next);
        cap_id = PCI_EXT_CAP_ID(header);
        cap_ver = PCI_EXT_CAP_VER(header);

        /*
         * If it becomes important to configure extended capabilities to their
         * actual size, use this as the default when it's something we don't
         * recognize. Since QEMU doesn't actually handle many of the config
         * accesses, exact size doesn't seem worthwhile.
         */
        size = vfio_ext_cap_max_size(config, next);

        /* Use emulated next pointer to allow dropping extended caps */
        pci_long_test_and_set_mask(vdev->emulated_config_bits + next,
                                   PCI_EXT_CAP_NEXT_MASK);
2109 2110

        switch (cap_id) {
2111
        case 0: /* kernel masked capability */
2112
        case PCI_EXT_CAP_ID_SRIOV: /* Read-only VF BARs confuse OVMF */
A
Alex Williamson 已提交
2113
        case PCI_EXT_CAP_ID_ARI: /* XXX Needs next function virtualization */
2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124
            trace_vfio_add_ext_cap_dropped(vdev->vbasedev.name, cap_id, next);
            break;
        default:
            pcie_add_capability(pdev, cap_id, cap_ver, next, size);
        }

    }

    /* Cleanup chain head ID if necessary */
    if (pci_get_word(pdev->config + PCI_CONFIG_SPACE_SIZE) == 0xFFFF) {
        pci_set_word(pdev->config + PCI_CONFIG_SPACE_SIZE, 0);
2125 2126 2127
    }

    g_free(config);
2128
    return;
2129 2130
}

2131
static int vfio_add_capabilities(VFIOPCIDevice *vdev, Error **errp)
2132 2133
{
    PCIDevice *pdev = &vdev->pdev;
2134
    int ret;
2135 2136 2137 2138 2139 2140

    if (!(pdev->config[PCI_STATUS] & PCI_STATUS_CAP_LIST) ||
        !pdev->config[PCI_CAPABILITY_LIST]) {
        return 0; /* Nothing to add */
    }

2141
    ret = vfio_add_std_cap(vdev, pdev->config[PCI_CAPABILITY_LIST], errp);
2142 2143 2144 2145
    if (ret) {
        return ret;
    }

2146 2147
    vfio_add_ext_cap(vdev);
    return 0;
2148 2149
}

2150
static void vfio_pci_pre_reset(VFIOPCIDevice *vdev)
2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170
{
    PCIDevice *pdev = &vdev->pdev;
    uint16_t cmd;

    vfio_disable_interrupts(vdev);

    /* Make sure the device is in D0 */
    if (vdev->pm_cap) {
        uint16_t pmcsr;
        uint8_t state;

        pmcsr = vfio_pci_read_config(pdev, vdev->pm_cap + PCI_PM_CTRL, 2);
        state = pmcsr & PCI_PM_CTRL_STATE_MASK;
        if (state) {
            pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
            vfio_pci_write_config(pdev, vdev->pm_cap + PCI_PM_CTRL, pmcsr, 2);
            /* vfio handles the necessary delay here */
            pmcsr = vfio_pci_read_config(pdev, vdev->pm_cap + PCI_PM_CTRL, 2);
            state = pmcsr & PCI_PM_CTRL_STATE_MASK;
            if (state) {
2171
                error_report("vfio: Unable to power on device, stuck in D%d",
2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182 2183 2184 2185 2186
                             state);
            }
        }
    }

    /*
     * Stop any ongoing DMA by disconecting I/O, MMIO, and bus master.
     * Also put INTx Disable in known state.
     */
    cmd = vfio_pci_read_config(pdev, PCI_COMMAND, 2);
    cmd &= ~(PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER |
             PCI_COMMAND_INTX_DISABLE);
    vfio_pci_write_config(pdev, PCI_COMMAND, cmd, 2);
}

2187
static void vfio_pci_post_reset(VFIOPCIDevice *vdev)
2188
{
2189
    Error *err = NULL;
2190
    int nr;
2191 2192 2193

    vfio_intx_enable(vdev, &err);
    if (err) {
2194
        error_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
2195
    }
2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206

    for (nr = 0; nr < PCI_NUM_REGIONS - 1; ++nr) {
        off_t addr = vdev->config_offset + PCI_BASE_ADDRESS_0 + (4 * nr);
        uint32_t val = 0;
        uint32_t len = sizeof(val);

        if (pwrite(vdev->vbasedev.fd, &val, len, addr) != len) {
            error_report("%s(%s) reset bar %d failed: %m", __func__,
                         vdev->vbasedev.name, nr);
        }
    }
2207 2208

    vfio_quirk_reset(vdev);
2209 2210
}

2211
static bool vfio_pci_host_match(PCIHostDeviceAddress *addr, const char *name)
2212
{
2213 2214 2215 2216 2217 2218
    char tmp[13];

    sprintf(tmp, "%04x:%02x:%02x.%1x", addr->domain,
            addr->bus, addr->slot, addr->function);

    return (strcmp(tmp, name) == 0);
2219 2220
}

2221
static int vfio_pci_hot_reset(VFIOPCIDevice *vdev, bool single)
2222 2223 2224 2225 2226 2227 2228 2229 2230
{
    VFIOGroup *group;
    struct vfio_pci_hot_reset_info *info;
    struct vfio_pci_dependent_device *devices;
    struct vfio_pci_hot_reset *reset;
    int32_t *fds;
    int ret, i, count;
    bool multi = false;

2231
    trace_vfio_pci_hot_reset(vdev->vbasedev.name, single ? "one" : "multi");
2232

C
Cao jin 已提交
2233 2234 2235
    if (!single) {
        vfio_pci_pre_reset(vdev);
    }
2236
    vdev->vbasedev.needs_reset = false;
2237 2238 2239 2240

    info = g_malloc0(sizeof(*info));
    info->argsz = sizeof(*info);

2241
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_GET_PCI_HOT_RESET_INFO, info);
2242 2243 2244
    if (ret && errno != ENOSPC) {
        ret = -errno;
        if (!vdev->has_pm_reset) {
2245 2246
            error_report("vfio: Cannot reset device %s, "
                         "no available reset mechanism.", vdev->vbasedev.name);
2247 2248 2249 2250 2251 2252 2253 2254 2255
        }
        goto out_single;
    }

    count = info->count;
    info = g_realloc(info, sizeof(*info) + (count * sizeof(*devices)));
    info->argsz = sizeof(*info) + (count * sizeof(*devices));
    devices = &info->devices[0];

2256
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_GET_PCI_HOT_RESET_INFO, info);
2257 2258 2259 2260 2261 2262
    if (ret) {
        ret = -errno;
        error_report("vfio: hot reset info failed: %m");
        goto out_single;
    }

2263
    trace_vfio_pci_hot_reset_has_dep_devices(vdev->vbasedev.name);
2264 2265 2266 2267

    /* Verify that we have all the groups required */
    for (i = 0; i < info->count; i++) {
        PCIHostDeviceAddress host;
2268
        VFIOPCIDevice *tmp;
2269
        VFIODevice *vbasedev_iter;
2270 2271 2272 2273 2274 2275

        host.domain = devices[i].segment;
        host.bus = devices[i].bus;
        host.slot = PCI_SLOT(devices[i].devfn);
        host.function = PCI_FUNC(devices[i].devfn);

E
Eric Auger 已提交
2276
        trace_vfio_pci_hot_reset_dep_devices(host.domain,
2277 2278
                host.bus, host.slot, host.function, devices[i].group_id);

2279
        if (vfio_pci_host_match(&host, vdev->vbasedev.name)) {
2280 2281 2282
            continue;
        }

2283
        QLIST_FOREACH(group, &vfio_group_list, next) {
2284 2285 2286 2287 2288 2289 2290
            if (group->groupid == devices[i].group_id) {
                break;
            }
        }

        if (!group) {
            if (!vdev->has_pm_reset) {
2291
                error_report("vfio: Cannot reset device %s, "
2292
                             "depends on group %d which is not owned.",
2293
                             vdev->vbasedev.name, devices[i].group_id);
2294 2295 2296 2297 2298 2299
            }
            ret = -EPERM;
            goto out;
        }

        /* Prep dependent devices for reset and clear our marker. */
2300
        QLIST_FOREACH(vbasedev_iter, &group->device_list, next) {
2301 2302
            if (!vbasedev_iter->dev->realized ||
                vbasedev_iter->type != VFIO_DEVICE_TYPE_PCI) {
2303 2304 2305
                continue;
            }
            tmp = container_of(vbasedev_iter, VFIOPCIDevice, vbasedev);
2306
            if (vfio_pci_host_match(&host, tmp->vbasedev.name)) {
2307 2308 2309 2310 2311
                if (single) {
                    ret = -EINVAL;
                    goto out_single;
                }
                vfio_pci_pre_reset(tmp);
2312
                tmp->vbasedev.needs_reset = false;
2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325
                multi = true;
                break;
            }
        }
    }

    if (!single && !multi) {
        ret = -EINVAL;
        goto out_single;
    }

    /* Determine how many group fds need to be passed */
    count = 0;
2326
    QLIST_FOREACH(group, &vfio_group_list, next) {
2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339
        for (i = 0; i < info->count; i++) {
            if (group->groupid == devices[i].group_id) {
                count++;
                break;
            }
        }
    }

    reset = g_malloc0(sizeof(*reset) + (count * sizeof(*fds)));
    reset->argsz = sizeof(*reset) + (count * sizeof(*fds));
    fds = &reset->group_fds[0];

    /* Fill in group fds */
2340
    QLIST_FOREACH(group, &vfio_group_list, next) {
2341 2342 2343 2344 2345 2346 2347 2348 2349
        for (i = 0; i < info->count; i++) {
            if (group->groupid == devices[i].group_id) {
                fds[reset->count++] = group->fd;
                break;
            }
        }
    }

    /* Bus reset! */
2350
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_PCI_HOT_RESET, reset);
2351 2352
    g_free(reset);

2353
    trace_vfio_pci_hot_reset_result(vdev->vbasedev.name,
E
Eric Auger 已提交
2354
                                    ret ? "%m" : "Success");
2355 2356 2357 2358 2359

out:
    /* Re-enable INTx on affected devices */
    for (i = 0; i < info->count; i++) {
        PCIHostDeviceAddress host;
2360
        VFIOPCIDevice *tmp;
2361
        VFIODevice *vbasedev_iter;
2362 2363 2364 2365 2366 2367

        host.domain = devices[i].segment;
        host.bus = devices[i].bus;
        host.slot = PCI_SLOT(devices[i].devfn);
        host.function = PCI_FUNC(devices[i].devfn);

2368
        if (vfio_pci_host_match(&host, vdev->vbasedev.name)) {
2369 2370 2371
            continue;
        }

2372
        QLIST_FOREACH(group, &vfio_group_list, next) {
2373 2374 2375 2376 2377 2378 2379 2380 2381
            if (group->groupid == devices[i].group_id) {
                break;
            }
        }

        if (!group) {
            break;
        }

2382
        QLIST_FOREACH(vbasedev_iter, &group->device_list, next) {
2383 2384
            if (!vbasedev_iter->dev->realized ||
                vbasedev_iter->type != VFIO_DEVICE_TYPE_PCI) {
2385 2386 2387
                continue;
            }
            tmp = container_of(vbasedev_iter, VFIOPCIDevice, vbasedev);
2388
            if (vfio_pci_host_match(&host, tmp->vbasedev.name)) {
2389 2390 2391 2392 2393 2394
                vfio_pci_post_reset(tmp);
                break;
            }
        }
    }
out_single:
C
Cao jin 已提交
2395 2396 2397
    if (!single) {
        vfio_pci_post_reset(vdev);
    }
2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417
    g_free(info);

    return ret;
}

/*
 * We want to differentiate hot reset of mulitple in-use devices vs hot reset
 * of a single in-use device.  VFIO_DEVICE_RESET will already handle the case
 * of doing hot resets when there is only a single device per bus.  The in-use
 * here refers to how many VFIODevices are affected.  A hot reset that affects
 * multiple devices, but only a single in-use device, means that we can call
 * it from our bus ->reset() callback since the extent is effectively a single
 * device.  This allows us to make use of it in the hotplug path.  When there
 * are multiple in-use devices, we can only trigger the hot reset during a
 * system reset and thus from our reset handler.  We separate _one vs _multi
 * here so that we don't overlap and do a double reset on the system reset
 * path where both our reset handler and ->reset() callback are used.  Calling
 * _one() will only do a hot reset for the one in-use devices case, calling
 * _multi() will do nothing if a _one() would have been sufficient.
 */
2418
static int vfio_pci_hot_reset_one(VFIOPCIDevice *vdev)
2419 2420 2421 2422
{
    return vfio_pci_hot_reset(vdev, true);
}

2423
static int vfio_pci_hot_reset_multi(VFIODevice *vbasedev)
2424
{
2425
    VFIOPCIDevice *vdev = container_of(vbasedev, VFIOPCIDevice, vbasedev);
2426 2427 2428
    return vfio_pci_hot_reset(vdev, false);
}

2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439
static void vfio_pci_compute_needs_reset(VFIODevice *vbasedev)
{
    VFIOPCIDevice *vdev = container_of(vbasedev, VFIOPCIDevice, vbasedev);
    if (!vbasedev->reset_works || (!vdev->has_flr && vdev->has_pm_reset)) {
        vbasedev->needs_reset = true;
    }
}

static VFIODeviceOps vfio_pci_ops = {
    .vfio_compute_needs_reset = vfio_pci_compute_needs_reset,
    .vfio_hot_reset_multi = vfio_pci_hot_reset_multi,
2440
    .vfio_eoi = vfio_intx_eoi,
2441 2442
};

2443
int vfio_populate_vga(VFIOPCIDevice *vdev, Error **errp)
A
Alex Williamson 已提交
2444 2445 2446 2447 2448
{
    VFIODevice *vbasedev = &vdev->vbasedev;
    struct vfio_region_info *reg_info;
    int ret;

2449 2450
    ret = vfio_get_region_info(vbasedev, VFIO_PCI_VGA_REGION_INDEX, &reg_info);
    if (ret) {
2451 2452 2453
        error_setg_errno(errp, -ret,
                         "failed getting region info for VGA region index %d",
                         VFIO_PCI_VGA_REGION_INDEX);
2454 2455
        return ret;
    }
A
Alex Williamson 已提交
2456

2457 2458 2459
    if (!(reg_info->flags & VFIO_REGION_INFO_FLAG_READ) ||
        !(reg_info->flags & VFIO_REGION_INFO_FLAG_WRITE) ||
        reg_info->size < 0xbffff + 1) {
2460 2461 2462
        error_setg(errp, "unexpected VGA info, flags 0x%lx, size 0x%lx",
                   (unsigned long)reg_info->flags,
                   (unsigned long)reg_info->size);
2463 2464 2465
        g_free(reg_info);
        return -EINVAL;
    }
A
Alex Williamson 已提交
2466

2467
    vdev->vga = g_new0(VFIOVGA, 1);
A
Alex Williamson 已提交
2468

2469 2470
    vdev->vga->fd_offset = reg_info->offset;
    vdev->vga->fd = vdev->vbasedev.fd;
A
Alex Williamson 已提交
2471

2472
    g_free(reg_info);
A
Alex Williamson 已提交
2473

2474 2475 2476
    vdev->vga->region[QEMU_PCI_VGA_MEM].offset = QEMU_PCI_VGA_MEM_BASE;
    vdev->vga->region[QEMU_PCI_VGA_MEM].nr = QEMU_PCI_VGA_MEM;
    QLIST_INIT(&vdev->vga->region[QEMU_PCI_VGA_MEM].quirks);
A
Alex Williamson 已提交
2477

2478 2479 2480 2481 2482 2483
    memory_region_init_io(&vdev->vga->region[QEMU_PCI_VGA_MEM].mem,
                          OBJECT(vdev), &vfio_vga_ops,
                          &vdev->vga->region[QEMU_PCI_VGA_MEM],
                          "vfio-vga-mmio@0xa0000",
                          QEMU_PCI_VGA_MEM_SIZE);

2484 2485 2486
    vdev->vga->region[QEMU_PCI_VGA_IO_LO].offset = QEMU_PCI_VGA_IO_LO_BASE;
    vdev->vga->region[QEMU_PCI_VGA_IO_LO].nr = QEMU_PCI_VGA_IO_LO;
    QLIST_INIT(&vdev->vga->region[QEMU_PCI_VGA_IO_LO].quirks);
A
Alex Williamson 已提交
2487

2488 2489 2490 2491 2492 2493
    memory_region_init_io(&vdev->vga->region[QEMU_PCI_VGA_IO_LO].mem,
                          OBJECT(vdev), &vfio_vga_ops,
                          &vdev->vga->region[QEMU_PCI_VGA_IO_LO],
                          "vfio-vga-io@0x3b0",
                          QEMU_PCI_VGA_IO_LO_SIZE);

2494 2495 2496
    vdev->vga->region[QEMU_PCI_VGA_IO_HI].offset = QEMU_PCI_VGA_IO_HI_BASE;
    vdev->vga->region[QEMU_PCI_VGA_IO_HI].nr = QEMU_PCI_VGA_IO_HI;
    QLIST_INIT(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].quirks);
A
Alex Williamson 已提交
2497

2498 2499 2500 2501 2502 2503 2504 2505 2506 2507
    memory_region_init_io(&vdev->vga->region[QEMU_PCI_VGA_IO_HI].mem,
                          OBJECT(vdev), &vfio_vga_ops,
                          &vdev->vga->region[QEMU_PCI_VGA_IO_HI],
                          "vfio-vga-io@0x3c0",
                          QEMU_PCI_VGA_IO_HI_SIZE);

    pci_register_vga(&vdev->pdev, &vdev->vga->region[QEMU_PCI_VGA_MEM].mem,
                     &vdev->vga->region[QEMU_PCI_VGA_IO_LO].mem,
                     &vdev->vga->region[QEMU_PCI_VGA_IO_HI].mem);

A
Alex Williamson 已提交
2508 2509 2510
    return 0;
}

2511
static void vfio_populate_device(VFIOPCIDevice *vdev, Error **errp)
2512
{
2513
    VFIODevice *vbasedev = &vdev->vbasedev;
2514
    struct vfio_region_info *reg_info;
2515
    struct vfio_irq_info irq_info = { .argsz = sizeof(irq_info) };
E
Eric Auger 已提交
2516
    int i, ret = -1;
2517 2518

    /* Sanity check device */
E
Eric Auger 已提交
2519
    if (!(vbasedev->flags & VFIO_DEVICE_FLAGS_PCI)) {
2520
        error_setg(errp, "this isn't a PCI device");
2521
        return;
2522 2523
    }

E
Eric Auger 已提交
2524
    if (vbasedev->num_regions < VFIO_PCI_CONFIG_REGION_INDEX + 1) {
2525 2526
        error_setg(errp, "unexpected number of io regions %u",
                   vbasedev->num_regions);
2527
        return;
2528 2529
    }

E
Eric Auger 已提交
2530
    if (vbasedev->num_irqs < VFIO_PCI_MSIX_IRQ_INDEX + 1) {
2531
        error_setg(errp, "unexpected number of irqs %u", vbasedev->num_irqs);
2532
        return;
2533 2534 2535
    }

    for (i = VFIO_PCI_BAR0_REGION_INDEX; i < VFIO_PCI_ROM_REGION_INDEX; i++) {
2536 2537 2538 2539 2540 2541
        char *name = g_strdup_printf("%s BAR %d", vbasedev->name, i);

        ret = vfio_region_setup(OBJECT(vdev), vbasedev,
                                &vdev->bars[i].region, i, name);
        g_free(name);

2542
        if (ret) {
2543
            error_setg_errno(errp, -ret, "failed to get region %d info", i);
2544
            return;
2545 2546
        }

2547
        QLIST_INIT(&vdev->bars[i].quirks);
2548
    }
2549

2550 2551
    ret = vfio_get_region_info(vbasedev,
                               VFIO_PCI_CONFIG_REGION_INDEX, &reg_info);
2552
    if (ret) {
2553
        error_setg_errno(errp, -ret, "failed to get config info");
2554
        return;
2555 2556
    }

E
Eric Auger 已提交
2557
    trace_vfio_populate_device_config(vdev->vbasedev.name,
2558 2559 2560
                                      (unsigned long)reg_info->size,
                                      (unsigned long)reg_info->offset,
                                      (unsigned long)reg_info->flags);
2561

2562
    vdev->config_size = reg_info->size;
2563 2564 2565
    if (vdev->config_size == PCI_CONFIG_SPACE_SIZE) {
        vdev->pdev.cap_present &= ~QEMU_PCI_CAP_EXPRESS;
    }
2566 2567 2568
    vdev->config_offset = reg_info->offset;

    g_free(reg_info);
2569

A
Alex Williamson 已提交
2570
    if (vdev->features & VFIO_FEATURE_ENABLE_VGA) {
2571
        ret = vfio_populate_vga(vdev, errp);
2572
        if (ret) {
2573
            error_append_hint(errp, "device does not support "
2574
                              "requested feature x-vga\n");
2575
            return;
2576 2577
        }
    }
2578

2579 2580
    irq_info.index = VFIO_PCI_ERR_IRQ_INDEX;

2581
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_GET_IRQ_INFO, &irq_info);
2582 2583
    if (ret) {
        /* This can fail for an old kernel or legacy PCI dev */
E
Eric Auger 已提交
2584
        trace_vfio_populate_device_get_irq_info_failure();
2585 2586 2587
    } else if (irq_info.count == 1) {
        vdev->pci_aer = true;
    } else {
2588 2589 2590
        warn_report(VFIO_MSG_PREFIX
                    "Could not enable error recovery for the device",
                    vbasedev->name);
2591
    }
E
Eric Auger 已提交
2592 2593
}

2594
static void vfio_put_device(VFIOPCIDevice *vdev)
2595
{
2596
    g_free(vdev->vbasedev.name);
2597 2598
    g_free(vdev->msix);

E
Eric Auger 已提交
2599
    vfio_put_base_device(&vdev->vbasedev);
2600 2601
}

2602 2603
static void vfio_err_notifier_handler(void *opaque)
{
2604
    VFIOPCIDevice *vdev = opaque;
2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618

    if (!event_notifier_test_and_clear(&vdev->err_notifier)) {
        return;
    }

    /*
     * TBD. Retrieve the error details and decide what action
     * needs to be taken. One of the actions could be to pass
     * the error to the guest and have the guest driver recover
     * from the error. This requires that PCIe capabilities be
     * exposed to the guest. For now, we just terminate the
     * guest to contain the error.
     */

2619
    error_report("%s(%s) Unrecoverable error detected. Please collect any data possible and then kill the guest", __func__, vdev->vbasedev.name);
2620

P
Paolo Bonzini 已提交
2621
    vm_stop(RUN_STATE_INTERNAL_ERROR);
2622 2623 2624 2625 2626 2627 2628 2629
}

/*
 * Registers error notifier for devices supporting error recovery.
 * If we encounter a failure in this function, we report an error
 * and continue after disabling error recovery support for the
 * device.
 */
2630
static void vfio_register_err_notifier(VFIOPCIDevice *vdev)
2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641
{
    int ret;
    int argsz;
    struct vfio_irq_set *irq_set;
    int32_t *pfd;

    if (!vdev->pci_aer) {
        return;
    }

    if (event_notifier_init(&vdev->err_notifier, 0)) {
A
Alex Williamson 已提交
2642
        error_report("vfio: Unable to init event notifier for error detection");
2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660
        vdev->pci_aer = false;
        return;
    }

    argsz = sizeof(*irq_set) + sizeof(*pfd);

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD |
                     VFIO_IRQ_SET_ACTION_TRIGGER;
    irq_set->index = VFIO_PCI_ERR_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = 1;
    pfd = (int32_t *)&irq_set->data;

    *pfd = event_notifier_get_fd(&vdev->err_notifier);
    qemu_set_fd_handler(*pfd, vfio_err_notifier_handler, NULL, vdev);

2661
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
2662
    if (ret) {
A
Alex Williamson 已提交
2663
        error_report("vfio: Failed to set up error notification");
2664 2665 2666 2667 2668 2669 2670
        qemu_set_fd_handler(*pfd, NULL, NULL, vdev);
        event_notifier_cleanup(&vdev->err_notifier);
        vdev->pci_aer = false;
    }
    g_free(irq_set);
}

2671
static void vfio_unregister_err_notifier(VFIOPCIDevice *vdev)
2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693
{
    int argsz;
    struct vfio_irq_set *irq_set;
    int32_t *pfd;
    int ret;

    if (!vdev->pci_aer) {
        return;
    }

    argsz = sizeof(*irq_set) + sizeof(*pfd);

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD |
                     VFIO_IRQ_SET_ACTION_TRIGGER;
    irq_set->index = VFIO_PCI_ERR_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = 1;
    pfd = (int32_t *)&irq_set->data;
    *pfd = -1;

2694
    ret = ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set);
2695
    if (ret) {
A
Alex Williamson 已提交
2696
        error_report("vfio: Failed to de-assign error fd: %m");
2697 2698 2699 2700 2701 2702 2703
    }
    g_free(irq_set);
    qemu_set_fd_handler(event_notifier_get_fd(&vdev->err_notifier),
                        NULL, NULL, vdev);
    event_notifier_cleanup(&vdev->err_notifier);
}

2704 2705 2706
static void vfio_req_notifier_handler(void *opaque)
{
    VFIOPCIDevice *vdev = opaque;
2707
    Error *err = NULL;
2708 2709 2710 2711 2712

    if (!event_notifier_test_and_clear(&vdev->req_notifier)) {
        return;
    }

2713 2714
    qdev_unplug(&vdev->pdev.qdev, &err);
    if (err) {
2715
        warn_reportf_err(err, VFIO_MSG_PREFIX, vdev->vbasedev.name);
2716
    }
2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798
}

static void vfio_register_req_notifier(VFIOPCIDevice *vdev)
{
    struct vfio_irq_info irq_info = { .argsz = sizeof(irq_info),
                                      .index = VFIO_PCI_REQ_IRQ_INDEX };
    int argsz;
    struct vfio_irq_set *irq_set;
    int32_t *pfd;

    if (!(vdev->features & VFIO_FEATURE_ENABLE_REQ)) {
        return;
    }

    if (ioctl(vdev->vbasedev.fd,
              VFIO_DEVICE_GET_IRQ_INFO, &irq_info) < 0 || irq_info.count < 1) {
        return;
    }

    if (event_notifier_init(&vdev->req_notifier, 0)) {
        error_report("vfio: Unable to init event notifier for device request");
        return;
    }

    argsz = sizeof(*irq_set) + sizeof(*pfd);

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD |
                     VFIO_IRQ_SET_ACTION_TRIGGER;
    irq_set->index = VFIO_PCI_REQ_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = 1;
    pfd = (int32_t *)&irq_set->data;

    *pfd = event_notifier_get_fd(&vdev->req_notifier);
    qemu_set_fd_handler(*pfd, vfio_req_notifier_handler, NULL, vdev);

    if (ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set)) {
        error_report("vfio: Failed to set up device request notification");
        qemu_set_fd_handler(*pfd, NULL, NULL, vdev);
        event_notifier_cleanup(&vdev->req_notifier);
    } else {
        vdev->req_enabled = true;
    }

    g_free(irq_set);
}

static void vfio_unregister_req_notifier(VFIOPCIDevice *vdev)
{
    int argsz;
    struct vfio_irq_set *irq_set;
    int32_t *pfd;

    if (!vdev->req_enabled) {
        return;
    }

    argsz = sizeof(*irq_set) + sizeof(*pfd);

    irq_set = g_malloc0(argsz);
    irq_set->argsz = argsz;
    irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD |
                     VFIO_IRQ_SET_ACTION_TRIGGER;
    irq_set->index = VFIO_PCI_REQ_IRQ_INDEX;
    irq_set->start = 0;
    irq_set->count = 1;
    pfd = (int32_t *)&irq_set->data;
    *pfd = -1;

    if (ioctl(vdev->vbasedev.fd, VFIO_DEVICE_SET_IRQS, irq_set)) {
        error_report("vfio: Failed to de-assign device request fd: %m");
    }
    g_free(irq_set);
    qemu_set_fd_handler(event_notifier_get_fd(&vdev->req_notifier),
                        NULL, NULL, vdev);
    event_notifier_cleanup(&vdev->req_notifier);

    vdev->req_enabled = false;
}

E
Eric Auger 已提交
2799
static void vfio_realize(PCIDevice *pdev, Error **errp)
2800
{
2801
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
2802
    VFIODevice *vbasedev_iter;
2803
    VFIOGroup *group;
2804
    char *tmp, *subsys, group_path[PATH_MAX], *group_name;
2805
    Error *err = NULL;
2806 2807 2808
    ssize_t len;
    struct stat st;
    int groupid;
2809
    int i, ret;
2810
    bool is_mdev;
2811

2812
    if (!vdev->vbasedev.sysfsdev) {
E
Eric Auger 已提交
2813 2814 2815
        if (!(~vdev->host.domain || ~vdev->host.bus ||
              ~vdev->host.slot || ~vdev->host.function)) {
            error_setg(errp, "No provided host device");
2816 2817
            error_append_hint(errp, "Use -device vfio-pci,host=DDDD:BB:DD.F "
                              "or -device vfio-pci,sysfsdev=PATH_TO_DEVICE\n");
E
Eric Auger 已提交
2818 2819
            return;
        }
2820 2821 2822 2823 2824 2825 2826
        vdev->vbasedev.sysfsdev =
            g_strdup_printf("/sys/bus/pci/devices/%04x:%02x:%02x.%01x",
                            vdev->host.domain, vdev->host.bus,
                            vdev->host.slot, vdev->host.function);
    }

    if (stat(vdev->vbasedev.sysfsdev, &st) < 0) {
E
Eric Auger 已提交
2827
        error_setg_errno(errp, errno, "no such host device");
2828
        error_prepend(errp, VFIO_MSG_PREFIX, vdev->vbasedev.sysfsdev);
E
Eric Auger 已提交
2829
        return;
2830 2831
    }

2832
    vdev->vbasedev.name = g_path_get_basename(vdev->vbasedev.sysfsdev);
2833
    vdev->vbasedev.ops = &vfio_pci_ops;
2834
    vdev->vbasedev.type = VFIO_DEVICE_TYPE_PCI;
2835
    vdev->vbasedev.dev = &vdev->pdev.qdev;
2836

2837 2838 2839
    tmp = g_strdup_printf("%s/iommu_group", vdev->vbasedev.sysfsdev);
    len = readlink(tmp, group_path, sizeof(group_path));
    g_free(tmp);
2840

2841
    if (len <= 0 || len >= sizeof(group_path)) {
E
Eric Auger 已提交
2842 2843
        error_setg_errno(errp, len < 0 ? errno : ENAMETOOLONG,
                         "no iommu_group found");
2844
        goto error;
2845 2846
    }

2847
    group_path[len] = 0;
2848

2849
    group_name = basename(group_path);
2850
    if (sscanf(group_name, "%d", &groupid) != 1) {
E
Eric Auger 已提交
2851
        error_setg_errno(errp, errno, "failed to read %s", group_path);
2852
        goto error;
2853 2854
    }

E
Eric Auger 已提交
2855
    trace_vfio_realize(vdev->vbasedev.name, groupid);
2856

E
Eric Auger 已提交
2857
    group = vfio_get_group(groupid, pci_device_iommu_address_space(pdev), errp);
2858
    if (!group) {
2859
        goto error;
2860 2861
    }

2862 2863
    QLIST_FOREACH(vbasedev_iter, &group->device_list, next) {
        if (strcmp(vbasedev_iter->name, vdev->vbasedev.name) == 0) {
E
Eric Auger 已提交
2864
            error_setg(errp, "device is already attached");
2865
            vfio_put_group(group);
2866
            goto error;
2867 2868 2869
        }
    }

2870 2871 2872 2873 2874 2875 2876 2877 2878
    /*
     * Mediated devices *might* operate compatibly with memory ballooning, but
     * we cannot know for certain, it depends on whether the mdev vendor driver
     * stays in sync with the active working set of the guest driver.  Prevent
     * the x-balloon-allowed option unless this is minimally an mdev device.
     */
    tmp = g_strdup_printf("%s/subsystem", vdev->vbasedev.sysfsdev);
    subsys = realpath(tmp, NULL);
    g_free(tmp);
2879
    is_mdev = subsys && (strcmp(subsys, "/sys/bus/mdev") == 0);
2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890
    free(subsys);

    trace_vfio_mdev(vdev->vbasedev.name, is_mdev);

    if (vdev->vbasedev.balloon_allowed && !is_mdev) {
        error_setg(errp, "x-balloon-allowed only potentially compatible "
                   "with mdev devices");
        vfio_put_group(group);
        goto error;
    }

E
Eric Auger 已提交
2891
    ret = vfio_get_device(group, vdev->vbasedev.name, &vdev->vbasedev, errp);
2892 2893
    if (ret) {
        vfio_put_group(group);
2894
        goto error;
2895 2896
    }

2897 2898 2899
    vfio_populate_device(vdev, &err);
    if (err) {
        error_propagate(errp, err);
2900
        goto error;
2901 2902
    }

2903
    /* Get a copy of config space */
2904
    ret = pread(vdev->vbasedev.fd, vdev->pdev.config,
2905 2906 2907 2908
                MIN(pci_config_size(&vdev->pdev), vdev->config_size),
                vdev->config_offset);
    if (ret < (int)MIN(pci_config_size(&vdev->pdev), vdev->config_size)) {
        ret = ret < 0 ? -errno : -EFAULT;
E
Eric Auger 已提交
2909
        error_setg_errno(errp, -ret, "failed to read device config space");
2910
        goto error;
2911 2912
    }

2913 2914 2915 2916 2917
    /* vfio emulates a lot for us, but some bits need extra love */
    vdev->emulated_config_bits = g_malloc0(vdev->config_size);

    /* QEMU can choose to expose the ROM or not */
    memset(vdev->emulated_config_bits + PCI_ROM_ADDRESS, 0xff, 4);
A
Alex Williamson 已提交
2918 2919
    /* QEMU can also add or extend BARs */
    memset(vdev->emulated_config_bits + PCI_BASE_ADDRESS_0, 0xff, 6 * 4);
2920

A
Alex Williamson 已提交
2921 2922 2923 2924 2925 2926 2927
    /*
     * The PCI spec reserves vendor ID 0xffff as an invalid value.  The
     * device ID is managed by the vendor and need only be a 16-bit value.
     * Allow any 16-bit value for subsystem so they can be hidden or changed.
     */
    if (vdev->vendor_id != PCI_ANY_ID) {
        if (vdev->vendor_id >= 0xffff) {
E
Eric Auger 已提交
2928
            error_setg(errp, "invalid PCI vendor ID provided");
2929
            goto error;
A
Alex Williamson 已提交
2930 2931 2932 2933 2934 2935 2936 2937 2938
        }
        vfio_add_emulated_word(vdev, PCI_VENDOR_ID, vdev->vendor_id, ~0);
        trace_vfio_pci_emulated_vendor_id(vdev->vbasedev.name, vdev->vendor_id);
    } else {
        vdev->vendor_id = pci_get_word(pdev->config + PCI_VENDOR_ID);
    }

    if (vdev->device_id != PCI_ANY_ID) {
        if (vdev->device_id > 0xffff) {
E
Eric Auger 已提交
2939
            error_setg(errp, "invalid PCI device ID provided");
2940
            goto error;
A
Alex Williamson 已提交
2941 2942 2943 2944 2945 2946 2947 2948 2949
        }
        vfio_add_emulated_word(vdev, PCI_DEVICE_ID, vdev->device_id, ~0);
        trace_vfio_pci_emulated_device_id(vdev->vbasedev.name, vdev->device_id);
    } else {
        vdev->device_id = pci_get_word(pdev->config + PCI_DEVICE_ID);
    }

    if (vdev->sub_vendor_id != PCI_ANY_ID) {
        if (vdev->sub_vendor_id > 0xffff) {
E
Eric Auger 已提交
2950
            error_setg(errp, "invalid PCI subsystem vendor ID provided");
2951
            goto error;
A
Alex Williamson 已提交
2952 2953 2954 2955 2956 2957 2958 2959 2960
        }
        vfio_add_emulated_word(vdev, PCI_SUBSYSTEM_VENDOR_ID,
                               vdev->sub_vendor_id, ~0);
        trace_vfio_pci_emulated_sub_vendor_id(vdev->vbasedev.name,
                                              vdev->sub_vendor_id);
    }

    if (vdev->sub_device_id != PCI_ANY_ID) {
        if (vdev->sub_device_id > 0xffff) {
E
Eric Auger 已提交
2961
            error_setg(errp, "invalid PCI subsystem device ID provided");
2962
            goto error;
A
Alex Williamson 已提交
2963 2964 2965 2966 2967
        }
        vfio_add_emulated_word(vdev, PCI_SUBSYSTEM_ID, vdev->sub_device_id, ~0);
        trace_vfio_pci_emulated_sub_device_id(vdev->vbasedev.name,
                                              vdev->sub_device_id);
    }
2968

2969 2970 2971 2972
    /* QEMU can change multi-function devices to single function, or reverse */
    vdev->emulated_config_bits[PCI_HEADER_TYPE] =
                                              PCI_HEADER_TYPE_MULTI_FUNCTION;

A
Alex Williamson 已提交
2973 2974 2975 2976 2977 2978 2979
    /* Restore or clear multifunction, this is always controlled by QEMU */
    if (vdev->pdev.cap_present & QEMU_PCI_CAP_MULTIFUNCTION) {
        vdev->pdev.config[PCI_HEADER_TYPE] |= PCI_HEADER_TYPE_MULTI_FUNCTION;
    } else {
        vdev->pdev.config[PCI_HEADER_TYPE] &= ~PCI_HEADER_TYPE_MULTI_FUNCTION;
    }

2980 2981 2982 2983 2984 2985 2986 2987
    /*
     * Clear host resource mapping info.  If we choose not to register a
     * BAR, such as might be the case with the option ROM, we can get
     * confusing, unwritable, residual addresses from the host here.
     */
    memset(&vdev->pdev.config[PCI_BASE_ADDRESS_0], 0, 24);
    memset(&vdev->pdev.config[PCI_ROM_ADDRESS], 0, 4);

2988
    vfio_pci_size_rom(vdev);
2989

2990 2991
    vfio_bars_prepare(vdev);

2992 2993 2994
    vfio_msix_early_setup(vdev, &err);
    if (err) {
        error_propagate(errp, err);
2995
        goto error;
2996 2997
    }

2998
    vfio_bars_register(vdev);
2999

E
Eric Auger 已提交
3000
    ret = vfio_add_capabilities(vdev, errp);
3001 3002 3003 3004
    if (ret) {
        goto out_teardown;
    }

3005 3006 3007 3008
    if (vdev->vga) {
        vfio_vga_quirk_setup(vdev);
    }

3009 3010 3011 3012
    for (i = 0; i < PCI_ROM_SLOT; i++) {
        vfio_bar_quirk_setup(vdev, i);
    }

3013 3014 3015 3016 3017
    if (!vdev->igd_opregion &&
        vdev->features & VFIO_FEATURE_ENABLE_IGD_OPREGION) {
        struct vfio_region_info *opregion;

        if (vdev->pdev.qdev.hotplugged) {
E
Eric Auger 已提交
3018
            error_setg(errp,
3019 3020
                       "cannot support IGD OpRegion feature on hotplugged "
                       "device");
3021 3022 3023 3024 3025 3026 3027
            goto out_teardown;
        }

        ret = vfio_get_dev_region_info(&vdev->vbasedev,
                        VFIO_REGION_TYPE_PCI_VENDOR_TYPE | PCI_VENDOR_ID_INTEL,
                        VFIO_REGION_SUBTYPE_INTEL_IGD_OPREGION, &opregion);
        if (ret) {
E
Eric Auger 已提交
3028
            error_setg_errno(errp, -ret,
3029
                             "does not support requested IGD OpRegion feature");
3030 3031 3032
            goto out_teardown;
        }

E
Eric Auger 已提交
3033
        ret = vfio_pci_igd_opregion_init(vdev, opregion, errp);
3034 3035 3036 3037 3038 3039
        g_free(opregion);
        if (ret) {
            goto out_teardown;
        }
    }

3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050
    /* QEMU emulates all of MSI & MSIX */
    if (pdev->cap_present & QEMU_PCI_CAP_MSIX) {
        memset(vdev->emulated_config_bits + pdev->msix_cap, 0xff,
               MSIX_CAP_LENGTH);
    }

    if (pdev->cap_present & QEMU_PCI_CAP_MSI) {
        memset(vdev->emulated_config_bits + pdev->msi_cap, 0xff,
               vdev->msi_cap_size);
    }

3051
    if (vfio_pci_read_config(&vdev->pdev, PCI_INTERRUPT_PIN, 1)) {
3052
        vdev->intx.mmap_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL,
3053
                                                  vfio_intx_mmap_enable, vdev);
3054
        pci_device_set_intx_routing_notifier(&vdev->pdev, vfio_intx_update);
E
Eric Auger 已提交
3055
        ret = vfio_intx_enable(vdev, errp);
3056 3057 3058 3059 3060
        if (ret) {
            goto out_teardown;
        }
    }

G
Gerd Hoffmann 已提交
3061 3062 3063 3064 3065 3066
    if (vdev->display != ON_OFF_AUTO_OFF) {
        ret = vfio_display_probe(vdev, errp);
        if (ret) {
            goto out_teardown;
        }
    }
G
Gerd Hoffmann 已提交
3067 3068 3069 3070
    if (vdev->enable_ramfb && vdev->dpy == NULL) {
        error_setg(errp, "ramfb=on requires display=on");
        goto out_teardown;
    }
G
Gerd Hoffmann 已提交
3071

3072
    vfio_register_err_notifier(vdev);
3073
    vfio_register_req_notifier(vdev);
3074
    vfio_setup_resetfn_quirk(vdev);
A
Alex Williamson 已提交
3075

E
Eric Auger 已提交
3076
    return;
3077 3078 3079 3080

out_teardown:
    pci_device_set_intx_routing_notifier(&vdev->pdev, NULL);
    vfio_teardown_msi(vdev);
3081
    vfio_bars_exit(vdev);
3082
error:
3083
    error_prepend(errp, VFIO_MSG_PREFIX, vdev->vbasedev.name);
3084 3085 3086 3087
}

static void vfio_instance_finalize(Object *obj)
{
3088
    VFIOPCIDevice *vdev = PCI_VFIO(obj);
3089 3090
    VFIOGroup *group = vdev->vbasedev.group;

G
Gerd Hoffmann 已提交
3091
    vfio_display_finalize(vdev);
3092
    vfio_bars_finalize(vdev);
3093
    g_free(vdev->emulated_config_bits);
3094
    g_free(vdev->rom);
3095 3096 3097 3098 3099 3100 3101
    /*
     * XXX Leaking igd_opregion is not an oversight, we can't remove the
     * fw_cfg entry therefore leaking this allocation seems like the safest
     * option.
     *
     * g_free(vdev->igd_opregion);
     */
3102 3103 3104 3105 3106 3107
    vfio_put_device(vdev);
    vfio_put_group(group);
}

static void vfio_exitfn(PCIDevice *pdev)
{
3108
    VFIOPCIDevice *vdev = PCI_VFIO(pdev);
3109

3110
    vfio_unregister_req_notifier(vdev);
3111
    vfio_unregister_err_notifier(vdev);
3112 3113
    pci_device_set_intx_routing_notifier(&vdev->pdev, NULL);
    vfio_disable_interrupts(vdev);
3114
    if (vdev->intx.mmap_timer) {
3115
        timer_free(vdev->intx.mmap_timer);
3116
    }
3117
    vfio_teardown_msi(vdev);
3118
    vfio_bars_exit(vdev);
3119 3120 3121 3122
}

static void vfio_pci_reset(DeviceState *dev)
{
3123
    VFIOPCIDevice *vdev = PCI_VFIO(dev);
3124

3125
    trace_vfio_pci_reset(vdev->vbasedev.name);
A
Alex Williamson 已提交
3126

3127
    vfio_pci_pre_reset(vdev);
3128

T
Tina Zhang 已提交
3129 3130 3131 3132
    if (vdev->display != ON_OFF_AUTO_OFF) {
        vfio_display_reset(vdev);
    }

3133 3134 3135 3136
    if (vdev->resetfn && !vdev->resetfn(vdev)) {
        goto post_reset;
    }

3137 3138
    if (vdev->vbasedev.reset_works &&
        (vdev->has_flr || !vdev->has_pm_reset) &&
3139
        !ioctl(vdev->vbasedev.fd, VFIO_DEVICE_RESET)) {
3140
        trace_vfio_pci_reset_flr(vdev->vbasedev.name);
3141
        goto post_reset;
3142 3143
    }

3144 3145 3146 3147
    /* See if we can do our own bus reset */
    if (!vfio_pci_hot_reset_one(vdev)) {
        goto post_reset;
    }
A
Alex Williamson 已提交
3148

3149
    /* If nothing else works and the device supports PM reset, use it */
3150
    if (vdev->vbasedev.reset_works && vdev->has_pm_reset &&
3151
        !ioctl(vdev->vbasedev.fd, VFIO_DEVICE_RESET)) {
3152
        trace_vfio_pci_reset_pm(vdev->vbasedev.name);
3153
        goto post_reset;
3154
    }
A
Alex Williamson 已提交
3155

3156 3157
post_reset:
    vfio_pci_post_reset(vdev);
3158 3159
}

3160 3161 3162
static void vfio_instance_init(Object *obj)
{
    PCIDevice *pci_dev = PCI_DEVICE(obj);
3163
    VFIOPCIDevice *vdev = PCI_VFIO(obj);
3164 3165 3166 3167

    device_add_bootindex_property(obj, &vdev->bootindex,
                                  "bootindex", NULL,
                                  &pci_dev->qdev, NULL);
E
Eric Auger 已提交
3168 3169 3170 3171
    vdev->host.domain = ~0U;
    vdev->host.bus = ~0U;
    vdev->host.slot = ~0U;
    vdev->host.function = ~0U;
3172 3173

    vdev->nv_gpudirect_clique = 0xFF;
3174 3175 3176 3177

    /* QEMU_PCI_CAP_EXPRESS initialization does not depend on QEMU command
     * line, therefore, no need to wait to realize like other devices */
    pci_dev->cap_present |= QEMU_PCI_CAP_EXPRESS;
3178 3179
}

3180
static Property vfio_pci_dev_properties[] = {
3181
    DEFINE_PROP_PCI_HOST_DEVADDR("host", VFIOPCIDevice, host),
3182
    DEFINE_PROP_STRING("sysfsdev", VFIOPCIDevice, vbasedev.sysfsdev),
G
Gerd Hoffmann 已提交
3183
    DEFINE_PROP_ON_OFF_AUTO("display", VFIOPCIDevice,
3184
                            display, ON_OFF_AUTO_OFF),
3185
    DEFINE_PROP_UINT32("x-intx-mmap-timeout-ms", VFIOPCIDevice,
3186
                       intx.mmap_timeout, 1100),
3187
    DEFINE_PROP_BIT("x-vga", VFIOPCIDevice, features,
3188
                    VFIO_FEATURE_ENABLE_VGA_BIT, false),
3189 3190
    DEFINE_PROP_BIT("x-req", VFIOPCIDevice, features,
                    VFIO_FEATURE_ENABLE_REQ_BIT, true),
3191 3192
    DEFINE_PROP_BIT("x-igd-opregion", VFIOPCIDevice, features,
                    VFIO_FEATURE_ENABLE_IGD_OPREGION_BIT, false),
3193
    DEFINE_PROP_BOOL("x-no-mmap", VFIOPCIDevice, vbasedev.no_mmap, false),
3194 3195
    DEFINE_PROP_BOOL("x-balloon-allowed", VFIOPCIDevice,
                     vbasedev.balloon_allowed, false),
3196 3197 3198
    DEFINE_PROP_BOOL("x-no-kvm-intx", VFIOPCIDevice, no_kvm_intx, false),
    DEFINE_PROP_BOOL("x-no-kvm-msi", VFIOPCIDevice, no_kvm_msi, false),
    DEFINE_PROP_BOOL("x-no-kvm-msix", VFIOPCIDevice, no_kvm_msix, false),
3199 3200
    DEFINE_PROP_BOOL("x-no-geforce-quirks", VFIOPCIDevice,
                     no_geforce_quirks, false),
3201 3202
    DEFINE_PROP_BOOL("x-no-kvm-ioeventfd", VFIOPCIDevice, no_kvm_ioeventfd,
                     false),
3203 3204
    DEFINE_PROP_BOOL("x-no-vfio-ioeventfd", VFIOPCIDevice, no_vfio_ioeventfd,
                     false),
A
Alex Williamson 已提交
3205 3206 3207 3208 3209 3210
    DEFINE_PROP_UINT32("x-pci-vendor-id", VFIOPCIDevice, vendor_id, PCI_ANY_ID),
    DEFINE_PROP_UINT32("x-pci-device-id", VFIOPCIDevice, device_id, PCI_ANY_ID),
    DEFINE_PROP_UINT32("x-pci-sub-vendor-id", VFIOPCIDevice,
                       sub_vendor_id, PCI_ANY_ID),
    DEFINE_PROP_UINT32("x-pci-sub-device-id", VFIOPCIDevice,
                       sub_device_id, PCI_ANY_ID),
3211
    DEFINE_PROP_UINT32("x-igd-gms", VFIOPCIDevice, igd_gms, 0),
3212 3213 3214
    DEFINE_PROP_UNSIGNED_NODEFAULT("x-nv-gpudirect-clique", VFIOPCIDevice,
                                   nv_gpudirect_clique,
                                   qdev_prop_nv_gpudirect_clique, uint8_t),
3215 3216
    DEFINE_PROP_OFF_AUTO_PCIBAR("x-msix-relocation", VFIOPCIDevice, msix_relo,
                                OFF_AUTOPCIBAR_OFF),
3217 3218
    /*
     * TODO - support passed fds... is this necessary?
3219 3220
     * DEFINE_PROP_STRING("vfiofd", VFIOPCIDevice, vfiofd_name),
     * DEFINE_PROP_STRING("vfiogroupfd, VFIOPCIDevice, vfiogroupfd_name),
3221 3222 3223 3224
     */
    DEFINE_PROP_END_OF_LIST(),
};

A
Alex Williamson 已提交
3225 3226 3227 3228
static const VMStateDescription vfio_pci_vmstate = {
    .name = "vfio-pci",
    .unmigratable = 1,
};
3229 3230 3231 3232 3233 3234 3235 3236

static void vfio_pci_dev_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    PCIDeviceClass *pdc = PCI_DEVICE_CLASS(klass);

    dc->reset = vfio_pci_reset;
    dc->props = vfio_pci_dev_properties;
A
Alex Williamson 已提交
3237 3238
    dc->vmsd = &vfio_pci_vmstate;
    dc->desc = "VFIO-based PCI device assignment";
3239
    set_bit(DEVICE_CATEGORY_MISC, dc->categories);
E
Eric Auger 已提交
3240
    pdc->realize = vfio_realize;
3241 3242 3243 3244 3245 3246
    pdc->exit = vfio_exitfn;
    pdc->config_read = vfio_pci_read_config;
    pdc->config_write = vfio_pci_write_config;
}

static const TypeInfo vfio_pci_dev_info = {
3247
    .name = TYPE_VFIO_PCI,
3248
    .parent = TYPE_PCI_DEVICE,
3249
    .instance_size = sizeof(VFIOPCIDevice),
3250
    .class_init = vfio_pci_dev_class_init,
3251
    .instance_init = vfio_instance_init,
3252
    .instance_finalize = vfio_instance_finalize,
3253 3254 3255 3256 3257
    .interfaces = (InterfaceInfo[]) {
        { INTERFACE_PCIE_DEVICE },
        { INTERFACE_CONVENTIONAL_PCI_DEVICE },
        { }
    },
3258 3259
};

G
Gerd Hoffmann 已提交
3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279
static Property vfio_pci_dev_nohotplug_properties[] = {
    DEFINE_PROP_BOOL("ramfb", VFIOPCIDevice, enable_ramfb, false),
    DEFINE_PROP_END_OF_LIST(),
};

static void vfio_pci_nohotplug_dev_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);

    dc->props = vfio_pci_dev_nohotplug_properties;
    dc->hotpluggable = false;
}

static const TypeInfo vfio_pci_nohotplug_dev_info = {
    .name = "vfio-pci-nohotplug",
    .parent = "vfio-pci",
    .instance_size = sizeof(VFIOPCIDevice),
    .class_init = vfio_pci_nohotplug_dev_class_init,
};

3280 3281 3282
static void register_vfio_pci_dev_type(void)
{
    type_register_static(&vfio_pci_dev_info);
G
Gerd Hoffmann 已提交
3283
    type_register_static(&vfio_pci_nohotplug_dev_info);
3284 3285 3286
}

type_init(register_vfio_pci_dev_type)