136f5dc91SSasha Levin #include "kvm/virtio-pci.h" 236f5dc91SSasha Levin 336f5dc91SSasha Levin #include "kvm/ioport.h" 436f5dc91SSasha Levin #include "kvm/kvm.h" 54123ca55SMarc Zyngier #include "kvm/kvm-cpu.h" 636f5dc91SSasha Levin #include "kvm/virtio-pci-dev.h" 736f5dc91SSasha Levin #include "kvm/irq.h" 836f5dc91SSasha Levin #include "kvm/virtio.h" 91599d724SSasha Levin #include "kvm/ioeventfd.h" 102e7380dbSMarc Zyngier #include "kvm/util.h" 1136f5dc91SSasha Levin 1243c81c74SSasha Levin #include <sys/ioctl.h> 1336f5dc91SSasha Levin #include <linux/virtio_pci.h> 14aa73be70SMatt Evans #include <linux/byteorder.h> 155a8e4f25SAlexandru Elisei #include <assert.h> 1636f5dc91SSasha Levin #include <string.h> 1736f5dc91SSasha Levin 182e7380dbSMarc Zyngier #define ALIGN_UP(x, s) ALIGN((x) + (s) - 1, (s)) 192e7380dbSMarc Zyngier #define VIRTIO_NR_MSIX (VIRTIO_PCI_MAX_VQ + VIRTIO_PCI_MAX_CONFIG) 202e7380dbSMarc Zyngier #define VIRTIO_MSIX_TABLE_SIZE (VIRTIO_NR_MSIX * 16) 212e7380dbSMarc Zyngier #define VIRTIO_MSIX_PBA_SIZE (ALIGN_UP(VIRTIO_MSIX_TABLE_SIZE, 64) / 8) 222e7380dbSMarc Zyngier #define VIRTIO_MSIX_BAR_SIZE (1UL << fls_long(VIRTIO_MSIX_TABLE_SIZE + \ 232e7380dbSMarc Zyngier VIRTIO_MSIX_PBA_SIZE)) 242e7380dbSMarc Zyngier 25e539f3e4SAlexandru Elisei static u16 virtio_pci__port_addr(struct virtio_pci *vpci) 26e539f3e4SAlexandru Elisei { 27e539f3e4SAlexandru Elisei return pci__bar_address(&vpci->pci_hdr, 0); 28e539f3e4SAlexandru Elisei } 29e539f3e4SAlexandru Elisei 30e539f3e4SAlexandru Elisei static u32 virtio_pci__mmio_addr(struct virtio_pci *vpci) 31e539f3e4SAlexandru Elisei { 32e539f3e4SAlexandru Elisei return pci__bar_address(&vpci->pci_hdr, 1); 33e539f3e4SAlexandru Elisei } 34e539f3e4SAlexandru Elisei 35e539f3e4SAlexandru Elisei static u32 virtio_pci__msix_io_addr(struct virtio_pci *vpci) 36e539f3e4SAlexandru Elisei { 37e539f3e4SAlexandru Elisei return pci__bar_address(&vpci->pci_hdr, 2); 38e539f3e4SAlexandru Elisei } 39e539f3e4SAlexandru Elisei 40f44af23eSJean-Philippe Brucker static int virtio_pci__add_msix_route(struct virtio_pci *vpci, u32 vec) 41f44af23eSJean-Philippe Brucker { 42f44af23eSJean-Philippe Brucker int gsi; 43f44af23eSJean-Philippe Brucker struct msi_msg *msg; 44f44af23eSJean-Philippe Brucker 45f44af23eSJean-Philippe Brucker if (vec == VIRTIO_MSI_NO_VECTOR) 46f44af23eSJean-Philippe Brucker return -EINVAL; 47f44af23eSJean-Philippe Brucker 48f44af23eSJean-Philippe Brucker msg = &vpci->msix_table[vec].msg; 49f44af23eSJean-Philippe Brucker gsi = irq__add_msix_route(vpci->kvm, msg, vpci->dev_hdr.dev_num << 3); 50f44af23eSJean-Philippe Brucker /* 51f44af23eSJean-Philippe Brucker * We don't need IRQ routing if we can use 52f44af23eSJean-Philippe Brucker * MSI injection via the KVM_SIGNAL_MSI ioctl. 53f44af23eSJean-Philippe Brucker */ 54f44af23eSJean-Philippe Brucker if (gsi == -ENXIO && vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 55f44af23eSJean-Philippe Brucker return gsi; 56f44af23eSJean-Philippe Brucker 57f44af23eSJean-Philippe Brucker if (gsi < 0) 58f44af23eSJean-Philippe Brucker die("failed to configure MSIs"); 59f44af23eSJean-Philippe Brucker 60f44af23eSJean-Philippe Brucker return gsi; 61f44af23eSJean-Philippe Brucker } 62f44af23eSJean-Philippe Brucker 63c6590f78SJean-Philippe Brucker static void virtio_pci__del_msix_route(struct virtio_pci *vpci, u32 gsi) 64c6590f78SJean-Philippe Brucker { 65c6590f78SJean-Philippe Brucker struct msi_msg msg = { 0 }; 66c6590f78SJean-Philippe Brucker 67c6590f78SJean-Philippe Brucker irq__update_msix_route(vpci->kvm, gsi, &msg); 68c6590f78SJean-Philippe Brucker } 69c6590f78SJean-Philippe Brucker 701599d724SSasha Levin static void virtio_pci__ioevent_callback(struct kvm *kvm, void *param) 711599d724SSasha Levin { 721599d724SSasha Levin struct virtio_pci_ioevent_param *ioeventfd = param; 7302eca50cSAsias He struct virtio_pci *vpci = ioeventfd->vdev->virtio; 741599d724SSasha Levin 7502eca50cSAsias He ioeventfd->vdev->ops->notify_vq(kvm, vpci->dev, ioeventfd->vq); 761599d724SSasha Levin } 771599d724SSasha Levin 7802eca50cSAsias He static int virtio_pci__init_ioeventfd(struct kvm *kvm, struct virtio_device *vdev, u32 vq) 791599d724SSasha Levin { 801599d724SSasha Levin struct ioevent ioevent; 8102eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 82e539f3e4SAlexandru Elisei u32 mmio_addr = virtio_pci__mmio_addr(vpci); 83e539f3e4SAlexandru Elisei u16 port_addr = virtio_pci__port_addr(vpci); 840e1882a4SJean-Philippe Brucker int r, flags = 0; 850e1882a4SJean-Philippe Brucker int fd; 861599d724SSasha Levin 871599d724SSasha Levin vpci->ioeventfds[vq] = (struct virtio_pci_ioevent_param) { 8802eca50cSAsias He .vdev = vdev, 891599d724SSasha Levin .vq = vq, 901599d724SSasha Levin }; 911599d724SSasha Levin 921599d724SSasha Levin ioevent = (struct ioevent) { 931599d724SSasha Levin .fn = virtio_pci__ioevent_callback, 941599d724SSasha Levin .fn_ptr = &vpci->ioeventfds[vq], 951599d724SSasha Levin .datamatch = vq, 961599d724SSasha Levin .fn_kvm = kvm, 971599d724SSasha Levin }; 981599d724SSasha Levin 99627d6874SAsias He /* 100a463650cSWill Deacon * Vhost will poll the eventfd in host kernel side, otherwise we 101a463650cSWill Deacon * need to poll in userspace. 102627d6874SAsias He */ 103a463650cSWill Deacon if (!vdev->use_vhost) 104a463650cSWill Deacon flags |= IOEVENTFD_FLAG_USER_POLL; 105a463650cSWill Deacon 106a463650cSWill Deacon /* ioport */ 107e539f3e4SAlexandru Elisei ioevent.io_addr = port_addr + VIRTIO_PCI_QUEUE_NOTIFY; 108a463650cSWill Deacon ioevent.io_len = sizeof(u16); 1090e1882a4SJean-Philippe Brucker ioevent.fd = fd = eventfd(0, 0); 11071ca0facSAndre Przywara r = ioeventfd__add_event(&ioevent, flags | IOEVENTFD_FLAG_PIO); 111ea6eeb1cSSasha Levin if (r) 112ea6eeb1cSSasha Levin return r; 1131599d724SSasha Levin 114a463650cSWill Deacon /* mmio */ 115e539f3e4SAlexandru Elisei ioevent.io_addr = mmio_addr + VIRTIO_PCI_QUEUE_NOTIFY; 116fe50bacbSAndreas Herrmann ioevent.io_len = sizeof(u16); 1170e1882a4SJean-Philippe Brucker ioevent.fd = eventfd(0, 0); 118a463650cSWill Deacon r = ioeventfd__add_event(&ioevent, flags); 119a463650cSWill Deacon if (r) 120a463650cSWill Deacon goto free_ioport_evt; 121263b80e8SSasha Levin 122a463650cSWill Deacon if (vdev->ops->notify_vq_eventfd) 1230e1882a4SJean-Philippe Brucker vdev->ops->notify_vq_eventfd(kvm, vpci->dev, vq, fd); 1241599d724SSasha Levin return 0; 125a463650cSWill Deacon 126a463650cSWill Deacon free_ioport_evt: 127e539f3e4SAlexandru Elisei ioeventfd__del_event(port_addr + VIRTIO_PCI_QUEUE_NOTIFY, vq); 128a463650cSWill Deacon return r; 1291599d724SSasha Levin } 1301599d724SSasha Levin 131*d0607293SJean-Philippe Brucker static int virtio_pci_init_vq(struct kvm *kvm, struct virtio_device *vdev, 132*d0607293SJean-Philippe Brucker int vq) 133*d0607293SJean-Philippe Brucker { 134*d0607293SJean-Philippe Brucker int ret; 135*d0607293SJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 136*d0607293SJean-Philippe Brucker 137*d0607293SJean-Philippe Brucker ret = virtio_pci__init_ioeventfd(kvm, vdev, vq); 138*d0607293SJean-Philippe Brucker if (ret) { 139*d0607293SJean-Philippe Brucker pr_err("couldn't add ioeventfd for vq %d: %d", vq, ret); 140*d0607293SJean-Philippe Brucker return ret; 141*d0607293SJean-Philippe Brucker } 142*d0607293SJean-Philippe Brucker return vdev->ops->init_vq(kvm, vpci->dev, vq); 143*d0607293SJean-Philippe Brucker } 144*d0607293SJean-Philippe Brucker 145ad346c2eSJean-Philippe Brucker static void virtio_pci_exit_vq(struct kvm *kvm, struct virtio_device *vdev, 146ad346c2eSJean-Philippe Brucker int vq) 147ad346c2eSJean-Philippe Brucker { 148ad346c2eSJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 149e539f3e4SAlexandru Elisei u32 mmio_addr = virtio_pci__mmio_addr(vpci); 150e539f3e4SAlexandru Elisei u16 port_addr = virtio_pci__port_addr(vpci); 151ad346c2eSJean-Philippe Brucker 152c6590f78SJean-Philippe Brucker virtio_pci__del_msix_route(vpci, vpci->gsis[vq]); 153c6590f78SJean-Philippe Brucker vpci->gsis[vq] = 0; 154c6590f78SJean-Philippe Brucker vpci->vq_vector[vq] = VIRTIO_MSI_NO_VECTOR; 155e539f3e4SAlexandru Elisei ioeventfd__del_event(mmio_addr + VIRTIO_PCI_QUEUE_NOTIFY, vq); 156e539f3e4SAlexandru Elisei ioeventfd__del_event(port_addr + VIRTIO_PCI_QUEUE_NOTIFY, vq); 157ad346c2eSJean-Philippe Brucker virtio_exit_vq(kvm, vdev, vpci->dev, vq); 158ad346c2eSJean-Philippe Brucker } 159ad346c2eSJean-Philippe Brucker 16006f48103SSasha Levin static inline bool virtio_pci__msix_enabled(struct virtio_pci *vpci) 16106f48103SSasha Levin { 162aa73be70SMatt Evans return vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_ENABLE); 16306f48103SSasha Levin } 16406f48103SSasha Levin 165e09b599aSJulien Thierry static bool virtio_pci__specific_data_in(struct kvm *kvm, struct virtio_device *vdev, 16606e1e6feSMartin Radev void *data, u32 size, unsigned long offset) 16736f5dc91SSasha Levin { 16836f5dc91SSasha Levin u32 config_offset; 16902eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 17006f48103SSasha Levin int type = virtio__get_dev_specific_field(offset - 20, 17106f48103SSasha Levin virtio_pci__msix_enabled(vpci), 1721382aba0SSasha Levin &config_offset); 17336f5dc91SSasha Levin if (type == VIRTIO_PCI_O_MSIX) { 17436f5dc91SSasha Levin switch (offset) { 17536f5dc91SSasha Levin case VIRTIO_MSI_CONFIG_VECTOR: 17636f5dc91SSasha Levin ioport__write16(data, vpci->config_vector); 17736f5dc91SSasha Levin break; 17836f5dc91SSasha Levin case VIRTIO_MSI_QUEUE_VECTOR: 17936f5dc91SSasha Levin ioport__write16(data, vpci->vq_vector[vpci->queue_selector]); 18036f5dc91SSasha Levin break; 18136f5dc91SSasha Levin }; 18236f5dc91SSasha Levin 18336f5dc91SSasha Levin return true; 18436f5dc91SSasha Levin } else if (type == VIRTIO_PCI_O_CONFIG) { 18515e6c4e7SJean-Philippe Brucker return virtio_access_config(kvm, vdev, vpci->dev, config_offset, 18615e6c4e7SJean-Philippe Brucker data, size, false); 18736f5dc91SSasha Levin } 18836f5dc91SSasha Levin 18936f5dc91SSasha Levin return false; 19036f5dc91SSasha Levin } 19136f5dc91SSasha Levin 192e09b599aSJulien Thierry static bool virtio_pci__data_in(struct kvm_cpu *vcpu, struct virtio_device *vdev, 19306e1e6feSMartin Radev unsigned long offset, void *data, u32 size) 19436f5dc91SSasha Levin { 19536f5dc91SSasha Levin bool ret = true; 19636f5dc91SSasha Levin struct virtio_pci *vpci; 19753fbb17bSJean-Philippe Brucker struct virt_queue *vq; 1984123ca55SMarc Zyngier struct kvm *kvm; 19936f5dc91SSasha Levin u32 val; 20036f5dc91SSasha Levin 2014123ca55SMarc Zyngier kvm = vcpu->kvm; 20202eca50cSAsias He vpci = vdev->virtio; 20336f5dc91SSasha Levin 20436f5dc91SSasha Levin switch (offset) { 20536f5dc91SSasha Levin case VIRTIO_PCI_HOST_FEATURES: 20602eca50cSAsias He val = vdev->ops->get_host_features(kvm, vpci->dev); 20736f5dc91SSasha Levin ioport__write32(data, val); 20836f5dc91SSasha Levin break; 20936f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_PFN: 21053fbb17bSJean-Philippe Brucker vq = vdev->ops->get_vq(kvm, vpci->dev, vpci->queue_selector); 211609ee906SJean-Philippe Brucker ioport__write32(data, vq->vring_addr.pfn); 21236f5dc91SSasha Levin break; 21336f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_NUM: 21402eca50cSAsias He val = vdev->ops->get_size_vq(kvm, vpci->dev, vpci->queue_selector); 215657ee18bSMatt Evans ioport__write16(data, val); 21636f5dc91SSasha Levin break; 21736f5dc91SSasha Levin case VIRTIO_PCI_STATUS: 21836f5dc91SSasha Levin ioport__write8(data, vpci->status); 21936f5dc91SSasha Levin break; 22036f5dc91SSasha Levin case VIRTIO_PCI_ISR: 22136f5dc91SSasha Levin ioport__write8(data, vpci->isr); 222e9922aafSAndre Przywara kvm__irq_line(kvm, vpci->legacy_irq_line, VIRTIO_IRQ_LOW); 22336f5dc91SSasha Levin vpci->isr = VIRTIO_IRQ_LOW; 22436f5dc91SSasha Levin break; 22536f5dc91SSasha Levin default: 226e09b599aSJulien Thierry ret = virtio_pci__specific_data_in(kvm, vdev, data, size, offset); 22736f5dc91SSasha Levin break; 22836f5dc91SSasha Levin }; 22936f5dc91SSasha Levin 23036f5dc91SSasha Levin return ret; 23136f5dc91SSasha Levin } 23236f5dc91SSasha Levin 2336518065aSAndre Przywara static void update_msix_map(struct virtio_pci *vpci, 2346518065aSAndre Przywara struct msix_table *msix_entry, u32 vecnum) 2356518065aSAndre Przywara { 2366518065aSAndre Przywara u32 gsi, i; 2376518065aSAndre Przywara 2386518065aSAndre Przywara /* Find the GSI number used for that vector */ 2396518065aSAndre Przywara if (vecnum == vpci->config_vector) { 2406518065aSAndre Przywara gsi = vpci->config_gsi; 2416518065aSAndre Przywara } else { 2426518065aSAndre Przywara for (i = 0; i < VIRTIO_PCI_MAX_VQ; i++) 2436518065aSAndre Przywara if (vpci->vq_vector[i] == vecnum) 2446518065aSAndre Przywara break; 2456518065aSAndre Przywara if (i == VIRTIO_PCI_MAX_VQ) 2466518065aSAndre Przywara return; 2476518065aSAndre Przywara gsi = vpci->gsis[i]; 2486518065aSAndre Przywara } 2496518065aSAndre Przywara 2506518065aSAndre Przywara if (gsi == 0) 2516518065aSAndre Przywara return; 2526518065aSAndre Przywara 2536518065aSAndre Przywara msix_entry = &msix_entry[vecnum]; 2546518065aSAndre Przywara irq__update_msix_route(vpci->kvm, gsi, &msix_entry->msg); 2556518065aSAndre Przywara } 2566518065aSAndre Przywara 257e09b599aSJulien Thierry static bool virtio_pci__specific_data_out(struct kvm *kvm, struct virtio_device *vdev, 25806e1e6feSMartin Radev void *data, u32 size, unsigned long offset) 25936f5dc91SSasha Levin { 26002eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 2618ccc8549SAndre Przywara u32 config_offset, vec; 2628ccc8549SAndre Przywara int gsi; 26306f48103SSasha Levin int type = virtio__get_dev_specific_field(offset - 20, virtio_pci__msix_enabled(vpci), 2641382aba0SSasha Levin &config_offset); 26536f5dc91SSasha Levin if (type == VIRTIO_PCI_O_MSIX) { 26636f5dc91SSasha Levin switch (offset) { 26736f5dc91SSasha Levin case VIRTIO_MSI_CONFIG_VECTOR: 26836f5dc91SSasha Levin vec = vpci->config_vector = ioport__read16(data); 26936f5dc91SSasha Levin 270f44af23eSJean-Philippe Brucker gsi = virtio_pci__add_msix_route(vpci, vec); 271f44af23eSJean-Philippe Brucker if (gsi < 0) 272928ab7acSAndre Przywara break; 273928ab7acSAndre Przywara 27436f5dc91SSasha Levin vpci->config_gsi = gsi; 27536f5dc91SSasha Levin break; 2763a60be06SSasha Levin case VIRTIO_MSI_QUEUE_VECTOR: 2778ccc8549SAndre Przywara vec = ioport__read16(data); 2788ccc8549SAndre Przywara vpci->vq_vector[vpci->queue_selector] = vec; 27936f5dc91SSasha Levin 280f44af23eSJean-Philippe Brucker gsi = virtio_pci__add_msix_route(vpci, vec); 281f44af23eSJean-Philippe Brucker if (gsi < 0) 282f8327b05SSasha Levin break; 283f8327b05SSasha Levin 28436f5dc91SSasha Levin vpci->gsis[vpci->queue_selector] = gsi; 28502eca50cSAsias He if (vdev->ops->notify_vq_gsi) 28602eca50cSAsias He vdev->ops->notify_vq_gsi(kvm, vpci->dev, 2878ccc8549SAndre Przywara vpci->queue_selector, 2888ccc8549SAndre Przywara gsi); 28936f5dc91SSasha Levin break; 29036f5dc91SSasha Levin }; 29136f5dc91SSasha Levin 29236f5dc91SSasha Levin return true; 29336f5dc91SSasha Levin } else if (type == VIRTIO_PCI_O_CONFIG) { 29415e6c4e7SJean-Philippe Brucker return virtio_access_config(kvm, vdev, vpci->dev, config_offset, 29515e6c4e7SJean-Philippe Brucker data, size, true); 29636f5dc91SSasha Levin } 29736f5dc91SSasha Levin 29836f5dc91SSasha Levin return false; 29936f5dc91SSasha Levin } 30036f5dc91SSasha Levin 301e09b599aSJulien Thierry static bool virtio_pci__data_out(struct kvm_cpu *vcpu, struct virtio_device *vdev, 30206e1e6feSMartin Radev unsigned long offset, void *data, u32 size) 30336f5dc91SSasha Levin { 30436f5dc91SSasha Levin bool ret = true; 30536f5dc91SSasha Levin struct virtio_pci *vpci; 306609ee906SJean-Philippe Brucker struct virt_queue *vq; 3074123ca55SMarc Zyngier struct kvm *kvm; 30836f5dc91SSasha Levin u32 val; 30931e0eaccSMartin Radev unsigned int vq_count; 31036f5dc91SSasha Levin 3114123ca55SMarc Zyngier kvm = vcpu->kvm; 31202eca50cSAsias He vpci = vdev->virtio; 31331e0eaccSMartin Radev vq_count = vdev->ops->get_vq_count(kvm, vpci->dev); 31436f5dc91SSasha Levin 31536f5dc91SSasha Levin switch (offset) { 31636f5dc91SSasha Levin case VIRTIO_PCI_GUEST_FEATURES: 31736f5dc91SSasha Levin val = ioport__read32(data); 31856a16c90SJean-Philippe Brucker virtio_set_guest_features(kvm, vdev, vpci->dev, val); 31936f5dc91SSasha Levin break; 32036f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_PFN: 32136f5dc91SSasha Levin val = ioport__read32(data); 322ad346c2eSJean-Philippe Brucker if (val) { 323609ee906SJean-Philippe Brucker vq = vdev->ops->get_vq(kvm, vpci->dev, 324609ee906SJean-Philippe Brucker vpci->queue_selector); 325609ee906SJean-Philippe Brucker vq->vring_addr = (struct vring_addr) { 326609ee906SJean-Philippe Brucker .legacy = true, 327609ee906SJean-Philippe Brucker .pfn = val, 328609ee906SJean-Philippe Brucker .align = VIRTIO_PCI_VRING_ALIGN, 329609ee906SJean-Philippe Brucker .pgsize = 1 << VIRTIO_PCI_QUEUE_ADDR_SHIFT, 330609ee906SJean-Philippe Brucker }; 331*d0607293SJean-Philippe Brucker virtio_pci_init_vq(kvm, vdev, vpci->queue_selector); 332ad346c2eSJean-Philippe Brucker } else { 333ad346c2eSJean-Philippe Brucker virtio_pci_exit_vq(kvm, vdev, vpci->queue_selector); 334ad346c2eSJean-Philippe Brucker } 33536f5dc91SSasha Levin break; 33636f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_SEL: 33731e0eaccSMartin Radev val = ioport__read16(data); 33831e0eaccSMartin Radev if (val >= vq_count) { 33931e0eaccSMartin Radev WARN_ONCE(1, "QUEUE_SEL value (%u) is larger than VQ count (%u)\n", 34031e0eaccSMartin Radev val, vq_count); 34131e0eaccSMartin Radev return false; 34231e0eaccSMartin Radev } 34331e0eaccSMartin Radev vpci->queue_selector = val; 34436f5dc91SSasha Levin break; 34536f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_NOTIFY: 34636f5dc91SSasha Levin val = ioport__read16(data); 34731e0eaccSMartin Radev if (val >= vq_count) { 34831e0eaccSMartin Radev WARN_ONCE(1, "QUEUE_SEL value (%u) is larger than VQ count (%u)\n", 34931e0eaccSMartin Radev val, vq_count); 35031e0eaccSMartin Radev return false; 35131e0eaccSMartin Radev } 35202eca50cSAsias He vdev->ops->notify_vq(kvm, vpci->dev, val); 35336f5dc91SSasha Levin break; 35436f5dc91SSasha Levin case VIRTIO_PCI_STATUS: 35536f5dc91SSasha Levin vpci->status = ioport__read8(data); 3564123ca55SMarc Zyngier if (!vpci->status) /* Sample endianness on reset */ 3574123ca55SMarc Zyngier vdev->endian = kvm_cpu__get_endianness(vcpu); 35895242e44SJean-Philippe Brucker virtio_notify_status(kvm, vdev, vpci->dev, vpci->status); 35936f5dc91SSasha Levin break; 36036f5dc91SSasha Levin default: 361e09b599aSJulien Thierry ret = virtio_pci__specific_data_out(kvm, vdev, data, size, offset); 36236f5dc91SSasha Levin break; 36336f5dc91SSasha Levin }; 36436f5dc91SSasha Levin 36536f5dc91SSasha Levin return ret; 36636f5dc91SSasha Levin } 36736f5dc91SSasha Levin 3689b735910SMarc Zyngier static void virtio_pci__msix_mmio_callback(struct kvm_cpu *vcpu, 3699b735910SMarc Zyngier u64 addr, u8 *data, u32 len, 370a463650cSWill Deacon u8 is_write, void *ptr) 37136f5dc91SSasha Levin { 372e09b599aSJulien Thierry struct virtio_device *vdev = ptr; 373e09b599aSJulien Thierry struct virtio_pci *vpci = vdev->virtio; 3746518065aSAndre Przywara struct msix_table *table; 375e539f3e4SAlexandru Elisei u32 msix_io_addr = virtio_pci__msix_io_addr(vpci); 3762e7380dbSMarc Zyngier u32 pba_offset; 3776518065aSAndre Przywara int vecnum; 3786518065aSAndre Przywara size_t offset; 37936f5dc91SSasha Levin 3802e7380dbSMarc Zyngier BUILD_BUG_ON(VIRTIO_NR_MSIX > (sizeof(vpci->msix_pba) * 8)); 3812e7380dbSMarc Zyngier 3822e7380dbSMarc Zyngier pba_offset = vpci->pci_hdr.msix.pba_offset & ~PCI_MSIX_TABLE_BIR; 3832e7380dbSMarc Zyngier if (addr >= msix_io_addr + pba_offset) { 3842e7380dbSMarc Zyngier /* Read access to PBA */ 3856518065aSAndre Przywara if (is_write) 3866518065aSAndre Przywara return; 3872e7380dbSMarc Zyngier offset = addr - (msix_io_addr + pba_offset); 3882e7380dbSMarc Zyngier if ((offset + len) > sizeof (vpci->msix_pba)) 3892e7380dbSMarc Zyngier return; 3902e7380dbSMarc Zyngier memcpy(data, (void *)&vpci->msix_pba + offset, len); 3912e7380dbSMarc Zyngier return; 3922e7380dbSMarc Zyngier } 3932e7380dbSMarc Zyngier 3946518065aSAndre Przywara table = vpci->msix_table; 395e539f3e4SAlexandru Elisei offset = addr - msix_io_addr; 3962e7380dbSMarc Zyngier 3976518065aSAndre Przywara vecnum = offset / sizeof(struct msix_table); 3986518065aSAndre Przywara offset = offset % sizeof(struct msix_table); 3996518065aSAndre Przywara 4006518065aSAndre Przywara if (!is_write) { 4016518065aSAndre Przywara memcpy(data, (void *)&table[vecnum] + offset, len); 4026518065aSAndre Przywara return; 40336f5dc91SSasha Levin } 40436f5dc91SSasha Levin 4056518065aSAndre Przywara memcpy((void *)&table[vecnum] + offset, data, len); 4066518065aSAndre Przywara 4076518065aSAndre Przywara /* Did we just update the address or payload? */ 4086518065aSAndre Przywara if (offset < offsetof(struct msix_table, ctrl)) 4096518065aSAndre Przywara update_msix_map(vpci, table, vecnum); 41006f48103SSasha Levin } 41106f48103SSasha Levin 412714ab9e6SAndre Przywara static void virtio_pci__signal_msi(struct kvm *kvm, struct virtio_pci *vpci, 413714ab9e6SAndre Przywara int vec) 41443c81c74SSasha Levin { 41543c81c74SSasha Levin struct kvm_msi msi = { 41643c81c74SSasha Levin .address_lo = vpci->msix_table[vec].msg.address_lo, 41743c81c74SSasha Levin .address_hi = vpci->msix_table[vec].msg.address_hi, 41843c81c74SSasha Levin .data = vpci->msix_table[vec].msg.data, 41943c81c74SSasha Levin }; 42043c81c74SSasha Levin 421714ab9e6SAndre Przywara if (kvm->msix_needs_devid) { 422714ab9e6SAndre Przywara msi.flags = KVM_MSI_VALID_DEVID; 423714ab9e6SAndre Przywara msi.devid = vpci->dev_hdr.dev_num << 3; 424714ab9e6SAndre Przywara } 425714ab9e6SAndre Przywara 426f6108d72SJean-Philippe Brucker irq__signal_msi(kvm, &msi); 42743c81c74SSasha Levin } 42843c81c74SSasha Levin 42902eca50cSAsias He int virtio_pci__signal_vq(struct kvm *kvm, struct virtio_device *vdev, u32 vq) 43036f5dc91SSasha Levin { 43102eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 43206f48103SSasha Levin int tbl = vpci->vq_vector[vq]; 43336f5dc91SSasha Levin 434f8327b05SSasha Levin if (virtio_pci__msix_enabled(vpci) && tbl != VIRTIO_MSI_NO_VECTOR) { 435aa73be70SMatt Evans if (vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_MASKALL) || 436aa73be70SMatt Evans vpci->msix_table[tbl].ctrl & cpu_to_le16(PCI_MSIX_ENTRY_CTRL_MASKBIT)) { 43706f48103SSasha Levin 43806f48103SSasha Levin vpci->msix_pba |= 1 << tbl; 43906f48103SSasha Levin return 0; 44006f48103SSasha Levin } 44106f48103SSasha Levin 44243c81c74SSasha Levin if (vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 44343c81c74SSasha Levin virtio_pci__signal_msi(kvm, vpci, vpci->vq_vector[vq]); 44443c81c74SSasha Levin else 44506f48103SSasha Levin kvm__irq_trigger(kvm, vpci->gsis[vq]); 44606f48103SSasha Levin } else { 447a36eca7bSSasha Levin vpci->isr = VIRTIO_IRQ_HIGH; 4482108c86dSMarc Zyngier kvm__irq_line(kvm, vpci->legacy_irq_line, VIRTIO_IRQ_HIGH); 44906f48103SSasha Levin } 45036f5dc91SSasha Levin return 0; 45136f5dc91SSasha Levin } 45236f5dc91SSasha Levin 45302eca50cSAsias He int virtio_pci__signal_config(struct kvm *kvm, struct virtio_device *vdev) 45436f5dc91SSasha Levin { 45502eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 45606f48103SSasha Levin int tbl = vpci->config_vector; 45706f48103SSasha Levin 458f8327b05SSasha Levin if (virtio_pci__msix_enabled(vpci) && tbl != VIRTIO_MSI_NO_VECTOR) { 459aa73be70SMatt Evans if (vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_MASKALL) || 460aa73be70SMatt Evans vpci->msix_table[tbl].ctrl & cpu_to_le16(PCI_MSIX_ENTRY_CTRL_MASKBIT)) { 46106f48103SSasha Levin 46206f48103SSasha Levin vpci->msix_pba |= 1 << tbl; 46306f48103SSasha Levin return 0; 46406f48103SSasha Levin } 46506f48103SSasha Levin 46643c81c74SSasha Levin if (vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 467f8327b05SSasha Levin virtio_pci__signal_msi(kvm, vpci, tbl); 46843c81c74SSasha Levin else 46906f48103SSasha Levin kvm__irq_trigger(kvm, vpci->config_gsi); 47006f48103SSasha Levin } else { 47106f48103SSasha Levin vpci->isr = VIRTIO_PCI_ISR_CONFIG; 472e9922aafSAndre Przywara kvm__irq_trigger(kvm, vpci->legacy_irq_line); 47306f48103SSasha Levin } 47436f5dc91SSasha Levin 47536f5dc91SSasha Levin return 0; 47636f5dc91SSasha Levin } 47736f5dc91SSasha Levin 4789b735910SMarc Zyngier static void virtio_pci__io_mmio_callback(struct kvm_cpu *vcpu, 4799b735910SMarc Zyngier u64 addr, u8 *data, u32 len, 480a463650cSWill Deacon u8 is_write, void *ptr) 481a463650cSWill Deacon { 482e09b599aSJulien Thierry struct virtio_device *vdev = ptr; 483e09b599aSJulien Thierry struct virtio_pci *vpci = vdev->virtio; 484205eaa79SAndre Przywara u32 ioport_addr = virtio_pci__port_addr(vpci); 485205eaa79SAndre Przywara u32 base_addr; 486205eaa79SAndre Przywara 487205eaa79SAndre Przywara if (addr >= ioport_addr && 488205eaa79SAndre Przywara addr < ioport_addr + pci__bar_size(&vpci->pci_hdr, 0)) 489205eaa79SAndre Przywara base_addr = ioport_addr; 490205eaa79SAndre Przywara else 491205eaa79SAndre Przywara base_addr = virtio_pci__mmio_addr(vpci); 492a463650cSWill Deacon 493e09b599aSJulien Thierry if (!is_write) 494205eaa79SAndre Przywara virtio_pci__data_in(vcpu, vdev, addr - base_addr, data, len); 495e09b599aSJulien Thierry else 496205eaa79SAndre Przywara virtio_pci__data_out(vcpu, vdev, addr - base_addr, data, len); 497a463650cSWill Deacon } 498a463650cSWill Deacon 4995a8e4f25SAlexandru Elisei static int virtio_pci__bar_activate(struct kvm *kvm, 5005a8e4f25SAlexandru Elisei struct pci_device_header *pci_hdr, 5015a8e4f25SAlexandru Elisei int bar_num, void *data) 5025a8e4f25SAlexandru Elisei { 5035a8e4f25SAlexandru Elisei struct virtio_device *vdev = data; 5045a8e4f25SAlexandru Elisei u32 bar_addr, bar_size; 5055a8e4f25SAlexandru Elisei int r = -EINVAL; 5065a8e4f25SAlexandru Elisei 5075a8e4f25SAlexandru Elisei assert(bar_num <= 2); 5085a8e4f25SAlexandru Elisei 5095a8e4f25SAlexandru Elisei bar_addr = pci__bar_address(pci_hdr, bar_num); 5105a8e4f25SAlexandru Elisei bar_size = pci__bar_size(pci_hdr, bar_num); 5115a8e4f25SAlexandru Elisei 5125a8e4f25SAlexandru Elisei switch (bar_num) { 5135a8e4f25SAlexandru Elisei case 0: 514205eaa79SAndre Przywara r = kvm__register_pio(kvm, bar_addr, bar_size, 515205eaa79SAndre Przywara virtio_pci__io_mmio_callback, vdev); 5165a8e4f25SAlexandru Elisei break; 5175a8e4f25SAlexandru Elisei case 1: 5185a8e4f25SAlexandru Elisei r = kvm__register_mmio(kvm, bar_addr, bar_size, false, 5195a8e4f25SAlexandru Elisei virtio_pci__io_mmio_callback, vdev); 5205a8e4f25SAlexandru Elisei break; 5215a8e4f25SAlexandru Elisei case 2: 5225a8e4f25SAlexandru Elisei r = kvm__register_mmio(kvm, bar_addr, bar_size, false, 5235a8e4f25SAlexandru Elisei virtio_pci__msix_mmio_callback, vdev); 5245a8e4f25SAlexandru Elisei break; 5255a8e4f25SAlexandru Elisei } 5265a8e4f25SAlexandru Elisei 5275a8e4f25SAlexandru Elisei return r; 5285a8e4f25SAlexandru Elisei } 5295a8e4f25SAlexandru Elisei 5305a8e4f25SAlexandru Elisei static int virtio_pci__bar_deactivate(struct kvm *kvm, 5315a8e4f25SAlexandru Elisei struct pci_device_header *pci_hdr, 5325a8e4f25SAlexandru Elisei int bar_num, void *data) 5335a8e4f25SAlexandru Elisei { 5345a8e4f25SAlexandru Elisei u32 bar_addr; 5355a8e4f25SAlexandru Elisei bool success; 5365a8e4f25SAlexandru Elisei int r = -EINVAL; 5375a8e4f25SAlexandru Elisei 5385a8e4f25SAlexandru Elisei assert(bar_num <= 2); 5395a8e4f25SAlexandru Elisei 5405a8e4f25SAlexandru Elisei bar_addr = pci__bar_address(pci_hdr, bar_num); 5415a8e4f25SAlexandru Elisei 5425a8e4f25SAlexandru Elisei switch (bar_num) { 5435a8e4f25SAlexandru Elisei case 0: 544205eaa79SAndre Przywara r = kvm__deregister_pio(kvm, bar_addr); 5455a8e4f25SAlexandru Elisei break; 5465a8e4f25SAlexandru Elisei case 1: 5475a8e4f25SAlexandru Elisei case 2: 5485a8e4f25SAlexandru Elisei success = kvm__deregister_mmio(kvm, bar_addr); 5495a8e4f25SAlexandru Elisei /* kvm__deregister_mmio fails when the region is not found. */ 5505a8e4f25SAlexandru Elisei r = (success ? 0 : -ENOENT); 5515a8e4f25SAlexandru Elisei break; 5525a8e4f25SAlexandru Elisei } 5535a8e4f25SAlexandru Elisei 5545a8e4f25SAlexandru Elisei return r; 5555a8e4f25SAlexandru Elisei } 5565a8e4f25SAlexandru Elisei 55702eca50cSAsias He int virtio_pci__init(struct kvm *kvm, void *dev, struct virtio_device *vdev, 558507e02d8SAsias He int device_id, int subsys_id, int class) 55936f5dc91SSasha Levin { 56002eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 561e539f3e4SAlexandru Elisei u32 mmio_addr, msix_io_block; 562e539f3e4SAlexandru Elisei u16 port_addr; 5637af40b91SSasha Levin int r; 56436f5dc91SSasha Levin 565a463650cSWill Deacon vpci->kvm = kvm; 56636f5dc91SSasha Levin vpci->dev = dev; 56736f5dc91SSasha Levin 568ce2fc8f5SAlexandru Elisei BUILD_BUG_ON(!is_power_of_two(PCI_IO_SIZE)); 569ce2fc8f5SAlexandru Elisei 570e539f3e4SAlexandru Elisei port_addr = pci_get_io_port_block(PCI_IO_SIZE); 571e539f3e4SAlexandru Elisei mmio_addr = pci_get_mmio_block(PCI_IO_SIZE); 5722e7380dbSMarc Zyngier msix_io_block = pci_get_mmio_block(VIRTIO_MSIX_BAR_SIZE); 573a463650cSWill Deacon 57436f5dc91SSasha Levin vpci->pci_hdr = (struct pci_device_header) { 575aa73be70SMatt Evans .vendor_id = cpu_to_le16(PCI_VENDOR_ID_REDHAT_QUMRANET), 576aa73be70SMatt Evans .device_id = cpu_to_le16(device_id), 577ec7dd52fSSasha Levin .command = PCI_COMMAND_IO | PCI_COMMAND_MEMORY, 57836f5dc91SSasha Levin .header_type = PCI_HEADER_TYPE_NORMAL, 57936f5dc91SSasha Levin .revision_id = 0, 580aa73be70SMatt Evans .class[0] = class & 0xff, 581aa73be70SMatt Evans .class[1] = (class >> 8) & 0xff, 582aa73be70SMatt Evans .class[2] = (class >> 16) & 0xff, 583aa73be70SMatt Evans .subsys_vendor_id = cpu_to_le16(PCI_SUBSYSTEM_VENDOR_ID_REDHAT_QUMRANET), 584aa73be70SMatt Evans .subsys_id = cpu_to_le16(subsys_id), 585e539f3e4SAlexandru Elisei .bar[0] = cpu_to_le32(port_addr 5869c26dab4SSasha Levin | PCI_BASE_ADDRESS_SPACE_IO), 587e539f3e4SAlexandru Elisei .bar[1] = cpu_to_le32(mmio_addr 588a508ea95SJean-Philippe Brucker | PCI_BASE_ADDRESS_SPACE_MEMORY), 589e539f3e4SAlexandru Elisei .bar[2] = cpu_to_le32(msix_io_block 590b4dab816SSasha Levin | PCI_BASE_ADDRESS_SPACE_MEMORY), 591aa73be70SMatt Evans .status = cpu_to_le16(PCI_STATUS_CAP_LIST), 59236f5dc91SSasha Levin .capabilities = (void *)&vpci->pci_hdr.msix - (void *)&vpci->pci_hdr, 59348843d10SJulien Thierry .bar_size[0] = cpu_to_le32(PCI_IO_SIZE), 59448843d10SJulien Thierry .bar_size[1] = cpu_to_le32(PCI_IO_SIZE), 5952e7380dbSMarc Zyngier .bar_size[2] = cpu_to_le32(VIRTIO_MSIX_BAR_SIZE), 59636f5dc91SSasha Levin }; 59736f5dc91SSasha Levin 5985a8e4f25SAlexandru Elisei r = pci__register_bar_regions(kvm, &vpci->pci_hdr, 5995a8e4f25SAlexandru Elisei virtio_pci__bar_activate, 6005a8e4f25SAlexandru Elisei virtio_pci__bar_deactivate, vdev); 6015a8e4f25SAlexandru Elisei if (r < 0) 6025a8e4f25SAlexandru Elisei return r; 6035a8e4f25SAlexandru Elisei 60421ff329dSWill Deacon vpci->dev_hdr = (struct device_header) { 60521ff329dSWill Deacon .bus_type = DEVICE_BUS_PCI, 60621ff329dSWill Deacon .data = &vpci->pci_hdr, 60721ff329dSWill Deacon }; 60821ff329dSWill Deacon 60936f5dc91SSasha Levin vpci->pci_hdr.msix.cap = PCI_CAP_ID_MSIX; 61036f5dc91SSasha Levin vpci->pci_hdr.msix.next = 0; 61114bba8a0SAsias He /* 6122e7380dbSMarc Zyngier * We at most have VIRTIO_NR_MSIX entries (VIRTIO_PCI_MAX_VQ 6132e7380dbSMarc Zyngier * entries for virt queue, VIRTIO_PCI_MAX_CONFIG entries for 6142e7380dbSMarc Zyngier * config). 61514bba8a0SAsias He * 61614bba8a0SAsias He * To quote the PCI spec: 61714bba8a0SAsias He * 61814bba8a0SAsias He * System software reads this field to determine the 61914bba8a0SAsias He * MSI-X Table Size N, which is encoded as N-1. 62014bba8a0SAsias He * For example, a returned value of "00000000011" 62114bba8a0SAsias He * indicates a table size of 4. 62214bba8a0SAsias He */ 6232e7380dbSMarc Zyngier vpci->pci_hdr.msix.ctrl = cpu_to_le16(VIRTIO_NR_MSIX - 1); 62406f48103SSasha Levin 625a463650cSWill Deacon /* Both table and PBA are mapped to the same BAR (2) */ 626a463650cSWill Deacon vpci->pci_hdr.msix.table_offset = cpu_to_le32(2); 6272e7380dbSMarc Zyngier vpci->pci_hdr.msix.pba_offset = cpu_to_le32(2 | VIRTIO_MSIX_TABLE_SIZE); 62836f5dc91SSasha Levin vpci->config_vector = 0; 62936f5dc91SSasha Levin 630f6108d72SJean-Philippe Brucker if (irq__can_signal_msi(kvm)) 63143c81c74SSasha Levin vpci->features |= VIRTIO_PCI_F_SIGNAL_MSI; 63243c81c74SSasha Levin 633c0c45eedSAndre Przywara vpci->legacy_irq_line = pci__assign_irq(&vpci->pci_hdr); 634c0c45eedSAndre Przywara 63521ff329dSWill Deacon r = device__register(&vpci->dev_hdr); 636495fbd4eSSasha Levin if (r < 0) 6375a8e4f25SAlexandru Elisei return r; 638495fbd4eSSasha Levin 639495fbd4eSSasha Levin return 0; 640495fbd4eSSasha Levin } 641495fbd4eSSasha Levin 642eb34a8c2SJean-Philippe Brucker int virtio_pci__reset(struct kvm *kvm, struct virtio_device *vdev) 643eb34a8c2SJean-Philippe Brucker { 64431e0eaccSMartin Radev unsigned int vq; 645eb34a8c2SJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 646eb34a8c2SJean-Philippe Brucker 647c6590f78SJean-Philippe Brucker virtio_pci__del_msix_route(vpci, vpci->config_gsi); 648c6590f78SJean-Philippe Brucker vpci->config_gsi = 0; 649c6590f78SJean-Philippe Brucker vpci->config_vector = VIRTIO_MSI_NO_VECTOR; 650c6590f78SJean-Philippe Brucker 651eb34a8c2SJean-Philippe Brucker for (vq = 0; vq < vdev->ops->get_vq_count(kvm, vpci->dev); vq++) 652eb34a8c2SJean-Philippe Brucker virtio_pci_exit_vq(kvm, vdev, vq); 653eb34a8c2SJean-Philippe Brucker 654eb34a8c2SJean-Philippe Brucker return 0; 655eb34a8c2SJean-Philippe Brucker } 656eb34a8c2SJean-Philippe Brucker 65702eca50cSAsias He int virtio_pci__exit(struct kvm *kvm, struct virtio_device *vdev) 658495fbd4eSSasha Levin { 65902eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 660495fbd4eSSasha Levin 661eb34a8c2SJean-Philippe Brucker virtio_pci__reset(kvm, vdev); 662e539f3e4SAlexandru Elisei kvm__deregister_mmio(kvm, virtio_pci__mmio_addr(vpci)); 663e539f3e4SAlexandru Elisei kvm__deregister_mmio(kvm, virtio_pci__msix_io_addr(vpci)); 664205eaa79SAndre Przywara kvm__deregister_pio(kvm, virtio_pci__port_addr(vpci)); 665495fbd4eSSasha Levin 66636f5dc91SSasha Levin return 0; 66736f5dc91SSasha Levin } 668