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); 84*21c9bc74SJean-Philippe Brucker off_t offset = vpci->doorbell_offset; 850e1882a4SJean-Philippe Brucker int r, flags = 0; 860e1882a4SJean-Philippe Brucker int fd; 871599d724SSasha Levin 881599d724SSasha Levin vpci->ioeventfds[vq] = (struct virtio_pci_ioevent_param) { 8902eca50cSAsias He .vdev = vdev, 901599d724SSasha Levin .vq = vq, 911599d724SSasha Levin }; 921599d724SSasha Levin 931599d724SSasha Levin ioevent = (struct ioevent) { 941599d724SSasha Levin .fn = virtio_pci__ioevent_callback, 951599d724SSasha Levin .fn_ptr = &vpci->ioeventfds[vq], 961599d724SSasha Levin .datamatch = vq, 971599d724SSasha Levin .fn_kvm = kvm, 981599d724SSasha Levin }; 991599d724SSasha Levin 100627d6874SAsias He /* 101a463650cSWill Deacon * Vhost will poll the eventfd in host kernel side, otherwise we 102a463650cSWill Deacon * need to poll in userspace. 103627d6874SAsias He */ 104a463650cSWill Deacon if (!vdev->use_vhost) 105a463650cSWill Deacon flags |= IOEVENTFD_FLAG_USER_POLL; 106a463650cSWill Deacon 107a463650cSWill Deacon /* ioport */ 108*21c9bc74SJean-Philippe Brucker ioevent.io_addr = port_addr + offset; 109a463650cSWill Deacon ioevent.io_len = sizeof(u16); 1100e1882a4SJean-Philippe Brucker ioevent.fd = fd = eventfd(0, 0); 11171ca0facSAndre Przywara r = ioeventfd__add_event(&ioevent, flags | IOEVENTFD_FLAG_PIO); 112ea6eeb1cSSasha Levin if (r) 113ea6eeb1cSSasha Levin return r; 1141599d724SSasha Levin 115a463650cSWill Deacon /* mmio */ 116*21c9bc74SJean-Philippe Brucker ioevent.io_addr = mmio_addr + offset; 117fe50bacbSAndreas Herrmann ioevent.io_len = sizeof(u16); 1180e1882a4SJean-Philippe Brucker ioevent.fd = eventfd(0, 0); 119a463650cSWill Deacon r = ioeventfd__add_event(&ioevent, flags); 120a463650cSWill Deacon if (r) 121a463650cSWill Deacon goto free_ioport_evt; 122263b80e8SSasha Levin 123a463650cSWill Deacon if (vdev->ops->notify_vq_eventfd) 1240e1882a4SJean-Philippe Brucker vdev->ops->notify_vq_eventfd(kvm, vpci->dev, vq, fd); 1251599d724SSasha Levin return 0; 126a463650cSWill Deacon 127a463650cSWill Deacon free_ioport_evt: 128*21c9bc74SJean-Philippe Brucker ioeventfd__del_event(port_addr + offset, vq); 129a463650cSWill Deacon return r; 1301599d724SSasha Levin } 1311599d724SSasha Levin 132d0607293SJean-Philippe Brucker static int virtio_pci_init_vq(struct kvm *kvm, struct virtio_device *vdev, 133d0607293SJean-Philippe Brucker int vq) 134d0607293SJean-Philippe Brucker { 135d0607293SJean-Philippe Brucker int ret; 136d0607293SJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 137d0607293SJean-Philippe Brucker 138d0607293SJean-Philippe Brucker ret = virtio_pci__init_ioeventfd(kvm, vdev, vq); 139d0607293SJean-Philippe Brucker if (ret) { 140d0607293SJean-Philippe Brucker pr_err("couldn't add ioeventfd for vq %d: %d", vq, ret); 141d0607293SJean-Philippe Brucker return ret; 142d0607293SJean-Philippe Brucker } 143d0607293SJean-Philippe Brucker return vdev->ops->init_vq(kvm, vpci->dev, vq); 144d0607293SJean-Philippe Brucker } 145d0607293SJean-Philippe Brucker 146ad346c2eSJean-Philippe Brucker static void virtio_pci_exit_vq(struct kvm *kvm, struct virtio_device *vdev, 147ad346c2eSJean-Philippe Brucker int vq) 148ad346c2eSJean-Philippe Brucker { 149ad346c2eSJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 150e539f3e4SAlexandru Elisei u32 mmio_addr = virtio_pci__mmio_addr(vpci); 151e539f3e4SAlexandru Elisei u16 port_addr = virtio_pci__port_addr(vpci); 152*21c9bc74SJean-Philippe Brucker off_t offset = vpci->doorbell_offset; 153ad346c2eSJean-Philippe Brucker 154c6590f78SJean-Philippe Brucker virtio_pci__del_msix_route(vpci, vpci->gsis[vq]); 155c6590f78SJean-Philippe Brucker vpci->gsis[vq] = 0; 156c6590f78SJean-Philippe Brucker vpci->vq_vector[vq] = VIRTIO_MSI_NO_VECTOR; 157*21c9bc74SJean-Philippe Brucker ioeventfd__del_event(mmio_addr + offset, vq); 158*21c9bc74SJean-Philippe Brucker ioeventfd__del_event(port_addr + offset, vq); 159ad346c2eSJean-Philippe Brucker virtio_exit_vq(kvm, vdev, vpci->dev, vq); 160ad346c2eSJean-Philippe Brucker } 161ad346c2eSJean-Philippe Brucker 16206f48103SSasha Levin static inline bool virtio_pci__msix_enabled(struct virtio_pci *vpci) 16306f48103SSasha Levin { 164aa73be70SMatt Evans return vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_ENABLE); 16506f48103SSasha Levin } 16606f48103SSasha Levin 167e09b599aSJulien Thierry static bool virtio_pci__specific_data_in(struct kvm *kvm, struct virtio_device *vdev, 16806e1e6feSMartin Radev void *data, u32 size, unsigned long offset) 16936f5dc91SSasha Levin { 17036f5dc91SSasha Levin u32 config_offset; 17102eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 17206f48103SSasha Levin int type = virtio__get_dev_specific_field(offset - 20, 17306f48103SSasha Levin virtio_pci__msix_enabled(vpci), 1741382aba0SSasha Levin &config_offset); 17536f5dc91SSasha Levin if (type == VIRTIO_PCI_O_MSIX) { 17636f5dc91SSasha Levin switch (offset) { 17736f5dc91SSasha Levin case VIRTIO_MSI_CONFIG_VECTOR: 17836f5dc91SSasha Levin ioport__write16(data, vpci->config_vector); 17936f5dc91SSasha Levin break; 18036f5dc91SSasha Levin case VIRTIO_MSI_QUEUE_VECTOR: 18136f5dc91SSasha Levin ioport__write16(data, vpci->vq_vector[vpci->queue_selector]); 18236f5dc91SSasha Levin break; 18336f5dc91SSasha Levin }; 18436f5dc91SSasha Levin 18536f5dc91SSasha Levin return true; 18636f5dc91SSasha Levin } else if (type == VIRTIO_PCI_O_CONFIG) { 18715e6c4e7SJean-Philippe Brucker return virtio_access_config(kvm, vdev, vpci->dev, config_offset, 18815e6c4e7SJean-Philippe Brucker data, size, false); 18936f5dc91SSasha Levin } 19036f5dc91SSasha Levin 19136f5dc91SSasha Levin return false; 19236f5dc91SSasha Levin } 19336f5dc91SSasha Levin 194e09b599aSJulien Thierry static bool virtio_pci__data_in(struct kvm_cpu *vcpu, struct virtio_device *vdev, 19506e1e6feSMartin Radev unsigned long offset, void *data, u32 size) 19636f5dc91SSasha Levin { 19736f5dc91SSasha Levin bool ret = true; 19836f5dc91SSasha Levin struct virtio_pci *vpci; 19953fbb17bSJean-Philippe Brucker struct virt_queue *vq; 2004123ca55SMarc Zyngier struct kvm *kvm; 20136f5dc91SSasha Levin u32 val; 20236f5dc91SSasha Levin 2034123ca55SMarc Zyngier kvm = vcpu->kvm; 20402eca50cSAsias He vpci = vdev->virtio; 20536f5dc91SSasha Levin 20636f5dc91SSasha Levin switch (offset) { 20736f5dc91SSasha Levin case VIRTIO_PCI_HOST_FEATURES: 20802eca50cSAsias He val = vdev->ops->get_host_features(kvm, vpci->dev); 20936f5dc91SSasha Levin ioport__write32(data, val); 21036f5dc91SSasha Levin break; 21136f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_PFN: 21253fbb17bSJean-Philippe Brucker vq = vdev->ops->get_vq(kvm, vpci->dev, vpci->queue_selector); 213609ee906SJean-Philippe Brucker ioport__write32(data, vq->vring_addr.pfn); 21436f5dc91SSasha Levin break; 21536f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_NUM: 21602eca50cSAsias He val = vdev->ops->get_size_vq(kvm, vpci->dev, vpci->queue_selector); 217657ee18bSMatt Evans ioport__write16(data, val); 21836f5dc91SSasha Levin break; 21936f5dc91SSasha Levin case VIRTIO_PCI_STATUS: 22036f5dc91SSasha Levin ioport__write8(data, vpci->status); 22136f5dc91SSasha Levin break; 22236f5dc91SSasha Levin case VIRTIO_PCI_ISR: 22336f5dc91SSasha Levin ioport__write8(data, vpci->isr); 224e9922aafSAndre Przywara kvm__irq_line(kvm, vpci->legacy_irq_line, VIRTIO_IRQ_LOW); 22536f5dc91SSasha Levin vpci->isr = VIRTIO_IRQ_LOW; 22636f5dc91SSasha Levin break; 22736f5dc91SSasha Levin default: 228e09b599aSJulien Thierry ret = virtio_pci__specific_data_in(kvm, vdev, data, size, offset); 22936f5dc91SSasha Levin break; 23036f5dc91SSasha Levin }; 23136f5dc91SSasha Levin 23236f5dc91SSasha Levin return ret; 23336f5dc91SSasha Levin } 23436f5dc91SSasha Levin 2356518065aSAndre Przywara static void update_msix_map(struct virtio_pci *vpci, 2366518065aSAndre Przywara struct msix_table *msix_entry, u32 vecnum) 2376518065aSAndre Przywara { 2386518065aSAndre Przywara u32 gsi, i; 2396518065aSAndre Przywara 2406518065aSAndre Przywara /* Find the GSI number used for that vector */ 2416518065aSAndre Przywara if (vecnum == vpci->config_vector) { 2426518065aSAndre Przywara gsi = vpci->config_gsi; 2436518065aSAndre Przywara } else { 2446518065aSAndre Przywara for (i = 0; i < VIRTIO_PCI_MAX_VQ; i++) 2456518065aSAndre Przywara if (vpci->vq_vector[i] == vecnum) 2466518065aSAndre Przywara break; 2476518065aSAndre Przywara if (i == VIRTIO_PCI_MAX_VQ) 2486518065aSAndre Przywara return; 2496518065aSAndre Przywara gsi = vpci->gsis[i]; 2506518065aSAndre Przywara } 2516518065aSAndre Przywara 2526518065aSAndre Przywara if (gsi == 0) 2536518065aSAndre Przywara return; 2546518065aSAndre Przywara 2556518065aSAndre Przywara msix_entry = &msix_entry[vecnum]; 2566518065aSAndre Przywara irq__update_msix_route(vpci->kvm, gsi, &msix_entry->msg); 2576518065aSAndre Przywara } 2586518065aSAndre Przywara 259e09b599aSJulien Thierry static bool virtio_pci__specific_data_out(struct kvm *kvm, struct virtio_device *vdev, 26006e1e6feSMartin Radev void *data, u32 size, unsigned long offset) 26136f5dc91SSasha Levin { 26202eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 2638ccc8549SAndre Przywara u32 config_offset, vec; 2648ccc8549SAndre Przywara int gsi; 26506f48103SSasha Levin int type = virtio__get_dev_specific_field(offset - 20, virtio_pci__msix_enabled(vpci), 2661382aba0SSasha Levin &config_offset); 26736f5dc91SSasha Levin if (type == VIRTIO_PCI_O_MSIX) { 26836f5dc91SSasha Levin switch (offset) { 26936f5dc91SSasha Levin case VIRTIO_MSI_CONFIG_VECTOR: 27036f5dc91SSasha Levin vec = vpci->config_vector = ioport__read16(data); 27136f5dc91SSasha Levin 272f44af23eSJean-Philippe Brucker gsi = virtio_pci__add_msix_route(vpci, vec); 273f44af23eSJean-Philippe Brucker if (gsi < 0) 274928ab7acSAndre Przywara break; 275928ab7acSAndre Przywara 27636f5dc91SSasha Levin vpci->config_gsi = gsi; 27736f5dc91SSasha Levin break; 2783a60be06SSasha Levin case VIRTIO_MSI_QUEUE_VECTOR: 2798ccc8549SAndre Przywara vec = ioport__read16(data); 2808ccc8549SAndre Przywara vpci->vq_vector[vpci->queue_selector] = vec; 28136f5dc91SSasha Levin 282f44af23eSJean-Philippe Brucker gsi = virtio_pci__add_msix_route(vpci, vec); 283f44af23eSJean-Philippe Brucker if (gsi < 0) 284f8327b05SSasha Levin break; 285f8327b05SSasha Levin 28636f5dc91SSasha Levin vpci->gsis[vpci->queue_selector] = gsi; 28702eca50cSAsias He if (vdev->ops->notify_vq_gsi) 28802eca50cSAsias He vdev->ops->notify_vq_gsi(kvm, vpci->dev, 2898ccc8549SAndre Przywara vpci->queue_selector, 2908ccc8549SAndre Przywara gsi); 29136f5dc91SSasha Levin break; 29236f5dc91SSasha Levin }; 29336f5dc91SSasha Levin 29436f5dc91SSasha Levin return true; 29536f5dc91SSasha Levin } else if (type == VIRTIO_PCI_O_CONFIG) { 29615e6c4e7SJean-Philippe Brucker return virtio_access_config(kvm, vdev, vpci->dev, config_offset, 29715e6c4e7SJean-Philippe Brucker data, size, true); 29836f5dc91SSasha Levin } 29936f5dc91SSasha Levin 30036f5dc91SSasha Levin return false; 30136f5dc91SSasha Levin } 30236f5dc91SSasha Levin 303e09b599aSJulien Thierry static bool virtio_pci__data_out(struct kvm_cpu *vcpu, struct virtio_device *vdev, 30406e1e6feSMartin Radev unsigned long offset, void *data, u32 size) 30536f5dc91SSasha Levin { 30636f5dc91SSasha Levin bool ret = true; 30736f5dc91SSasha Levin struct virtio_pci *vpci; 308609ee906SJean-Philippe Brucker struct virt_queue *vq; 3094123ca55SMarc Zyngier struct kvm *kvm; 31036f5dc91SSasha Levin u32 val; 31131e0eaccSMartin Radev unsigned int vq_count; 31236f5dc91SSasha Levin 3134123ca55SMarc Zyngier kvm = vcpu->kvm; 31402eca50cSAsias He vpci = vdev->virtio; 31531e0eaccSMartin Radev vq_count = vdev->ops->get_vq_count(kvm, vpci->dev); 31636f5dc91SSasha Levin 31736f5dc91SSasha Levin switch (offset) { 31836f5dc91SSasha Levin case VIRTIO_PCI_GUEST_FEATURES: 31936f5dc91SSasha Levin val = ioport__read32(data); 32056a16c90SJean-Philippe Brucker virtio_set_guest_features(kvm, vdev, vpci->dev, val); 32136f5dc91SSasha Levin break; 32236f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_PFN: 32336f5dc91SSasha Levin val = ioport__read32(data); 324ad346c2eSJean-Philippe Brucker if (val) { 325609ee906SJean-Philippe Brucker vq = vdev->ops->get_vq(kvm, vpci->dev, 326609ee906SJean-Philippe Brucker vpci->queue_selector); 327609ee906SJean-Philippe Brucker vq->vring_addr = (struct vring_addr) { 328609ee906SJean-Philippe Brucker .legacy = true, 329609ee906SJean-Philippe Brucker .pfn = val, 330609ee906SJean-Philippe Brucker .align = VIRTIO_PCI_VRING_ALIGN, 331609ee906SJean-Philippe Brucker .pgsize = 1 << VIRTIO_PCI_QUEUE_ADDR_SHIFT, 332609ee906SJean-Philippe Brucker }; 333d0607293SJean-Philippe Brucker virtio_pci_init_vq(kvm, vdev, vpci->queue_selector); 334ad346c2eSJean-Philippe Brucker } else { 335ad346c2eSJean-Philippe Brucker virtio_pci_exit_vq(kvm, vdev, vpci->queue_selector); 336ad346c2eSJean-Philippe Brucker } 33736f5dc91SSasha Levin break; 33836f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_SEL: 33931e0eaccSMartin Radev val = ioport__read16(data); 34031e0eaccSMartin Radev if (val >= vq_count) { 34131e0eaccSMartin Radev WARN_ONCE(1, "QUEUE_SEL value (%u) is larger than VQ count (%u)\n", 34231e0eaccSMartin Radev val, vq_count); 34331e0eaccSMartin Radev return false; 34431e0eaccSMartin Radev } 34531e0eaccSMartin Radev vpci->queue_selector = val; 34636f5dc91SSasha Levin break; 34736f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_NOTIFY: 34836f5dc91SSasha Levin val = ioport__read16(data); 34931e0eaccSMartin Radev if (val >= vq_count) { 35031e0eaccSMartin Radev WARN_ONCE(1, "QUEUE_SEL value (%u) is larger than VQ count (%u)\n", 35131e0eaccSMartin Radev val, vq_count); 35231e0eaccSMartin Radev return false; 35331e0eaccSMartin Radev } 35402eca50cSAsias He vdev->ops->notify_vq(kvm, vpci->dev, val); 35536f5dc91SSasha Levin break; 35636f5dc91SSasha Levin case VIRTIO_PCI_STATUS: 35736f5dc91SSasha Levin vpci->status = ioport__read8(data); 3584123ca55SMarc Zyngier if (!vpci->status) /* Sample endianness on reset */ 3594123ca55SMarc Zyngier vdev->endian = kvm_cpu__get_endianness(vcpu); 36095242e44SJean-Philippe Brucker virtio_notify_status(kvm, vdev, vpci->dev, vpci->status); 36136f5dc91SSasha Levin break; 36236f5dc91SSasha Levin default: 363e09b599aSJulien Thierry ret = virtio_pci__specific_data_out(kvm, vdev, data, size, offset); 36436f5dc91SSasha Levin break; 36536f5dc91SSasha Levin }; 36636f5dc91SSasha Levin 36736f5dc91SSasha Levin return ret; 36836f5dc91SSasha Levin } 36936f5dc91SSasha Levin 3709b735910SMarc Zyngier static void virtio_pci__msix_mmio_callback(struct kvm_cpu *vcpu, 3719b735910SMarc Zyngier u64 addr, u8 *data, u32 len, 372a463650cSWill Deacon u8 is_write, void *ptr) 37336f5dc91SSasha Levin { 374e09b599aSJulien Thierry struct virtio_device *vdev = ptr; 375e09b599aSJulien Thierry struct virtio_pci *vpci = vdev->virtio; 3766518065aSAndre Przywara struct msix_table *table; 377e539f3e4SAlexandru Elisei u32 msix_io_addr = virtio_pci__msix_io_addr(vpci); 3782e7380dbSMarc Zyngier u32 pba_offset; 3796518065aSAndre Przywara int vecnum; 3806518065aSAndre Przywara size_t offset; 38136f5dc91SSasha Levin 3822e7380dbSMarc Zyngier BUILD_BUG_ON(VIRTIO_NR_MSIX > (sizeof(vpci->msix_pba) * 8)); 3832e7380dbSMarc Zyngier 3842e7380dbSMarc Zyngier pba_offset = vpci->pci_hdr.msix.pba_offset & ~PCI_MSIX_TABLE_BIR; 3852e7380dbSMarc Zyngier if (addr >= msix_io_addr + pba_offset) { 3862e7380dbSMarc Zyngier /* Read access to PBA */ 3876518065aSAndre Przywara if (is_write) 3886518065aSAndre Przywara return; 3892e7380dbSMarc Zyngier offset = addr - (msix_io_addr + pba_offset); 3902e7380dbSMarc Zyngier if ((offset + len) > sizeof (vpci->msix_pba)) 3912e7380dbSMarc Zyngier return; 3922e7380dbSMarc Zyngier memcpy(data, (void *)&vpci->msix_pba + offset, len); 3932e7380dbSMarc Zyngier return; 3942e7380dbSMarc Zyngier } 3952e7380dbSMarc Zyngier 3966518065aSAndre Przywara table = vpci->msix_table; 397e539f3e4SAlexandru Elisei offset = addr - msix_io_addr; 3982e7380dbSMarc Zyngier 3996518065aSAndre Przywara vecnum = offset / sizeof(struct msix_table); 4006518065aSAndre Przywara offset = offset % sizeof(struct msix_table); 4016518065aSAndre Przywara 4026518065aSAndre Przywara if (!is_write) { 4036518065aSAndre Przywara memcpy(data, (void *)&table[vecnum] + offset, len); 4046518065aSAndre Przywara return; 40536f5dc91SSasha Levin } 40636f5dc91SSasha Levin 4076518065aSAndre Przywara memcpy((void *)&table[vecnum] + offset, data, len); 4086518065aSAndre Przywara 4096518065aSAndre Przywara /* Did we just update the address or payload? */ 4106518065aSAndre Przywara if (offset < offsetof(struct msix_table, ctrl)) 4116518065aSAndre Przywara update_msix_map(vpci, table, vecnum); 41206f48103SSasha Levin } 41306f48103SSasha Levin 414714ab9e6SAndre Przywara static void virtio_pci__signal_msi(struct kvm *kvm, struct virtio_pci *vpci, 415714ab9e6SAndre Przywara int vec) 41643c81c74SSasha Levin { 41743c81c74SSasha Levin struct kvm_msi msi = { 41843c81c74SSasha Levin .address_lo = vpci->msix_table[vec].msg.address_lo, 41943c81c74SSasha Levin .address_hi = vpci->msix_table[vec].msg.address_hi, 42043c81c74SSasha Levin .data = vpci->msix_table[vec].msg.data, 42143c81c74SSasha Levin }; 42243c81c74SSasha Levin 423714ab9e6SAndre Przywara if (kvm->msix_needs_devid) { 424714ab9e6SAndre Przywara msi.flags = KVM_MSI_VALID_DEVID; 425714ab9e6SAndre Przywara msi.devid = vpci->dev_hdr.dev_num << 3; 426714ab9e6SAndre Przywara } 427714ab9e6SAndre Przywara 428f6108d72SJean-Philippe Brucker irq__signal_msi(kvm, &msi); 42943c81c74SSasha Levin } 43043c81c74SSasha Levin 43102eca50cSAsias He int virtio_pci__signal_vq(struct kvm *kvm, struct virtio_device *vdev, u32 vq) 43236f5dc91SSasha Levin { 43302eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 43406f48103SSasha Levin int tbl = vpci->vq_vector[vq]; 43536f5dc91SSasha Levin 436f8327b05SSasha Levin if (virtio_pci__msix_enabled(vpci) && tbl != VIRTIO_MSI_NO_VECTOR) { 437aa73be70SMatt Evans if (vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_MASKALL) || 438aa73be70SMatt Evans vpci->msix_table[tbl].ctrl & cpu_to_le16(PCI_MSIX_ENTRY_CTRL_MASKBIT)) { 43906f48103SSasha Levin 44006f48103SSasha Levin vpci->msix_pba |= 1 << tbl; 44106f48103SSasha Levin return 0; 44206f48103SSasha Levin } 44306f48103SSasha Levin 44443c81c74SSasha Levin if (vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 44543c81c74SSasha Levin virtio_pci__signal_msi(kvm, vpci, vpci->vq_vector[vq]); 44643c81c74SSasha Levin else 44706f48103SSasha Levin kvm__irq_trigger(kvm, vpci->gsis[vq]); 44806f48103SSasha Levin } else { 449a36eca7bSSasha Levin vpci->isr = VIRTIO_IRQ_HIGH; 4502108c86dSMarc Zyngier kvm__irq_line(kvm, vpci->legacy_irq_line, VIRTIO_IRQ_HIGH); 45106f48103SSasha Levin } 45236f5dc91SSasha Levin return 0; 45336f5dc91SSasha Levin } 45436f5dc91SSasha Levin 45502eca50cSAsias He int virtio_pci__signal_config(struct kvm *kvm, struct virtio_device *vdev) 45636f5dc91SSasha Levin { 45702eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 45806f48103SSasha Levin int tbl = vpci->config_vector; 45906f48103SSasha Levin 460f8327b05SSasha Levin if (virtio_pci__msix_enabled(vpci) && tbl != VIRTIO_MSI_NO_VECTOR) { 461aa73be70SMatt Evans if (vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_MASKALL) || 462aa73be70SMatt Evans vpci->msix_table[tbl].ctrl & cpu_to_le16(PCI_MSIX_ENTRY_CTRL_MASKBIT)) { 46306f48103SSasha Levin 46406f48103SSasha Levin vpci->msix_pba |= 1 << tbl; 46506f48103SSasha Levin return 0; 46606f48103SSasha Levin } 46706f48103SSasha Levin 46843c81c74SSasha Levin if (vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 469f8327b05SSasha Levin virtio_pci__signal_msi(kvm, vpci, tbl); 47043c81c74SSasha Levin else 47106f48103SSasha Levin kvm__irq_trigger(kvm, vpci->config_gsi); 47206f48103SSasha Levin } else { 47306f48103SSasha Levin vpci->isr = VIRTIO_PCI_ISR_CONFIG; 474e9922aafSAndre Przywara kvm__irq_trigger(kvm, vpci->legacy_irq_line); 47506f48103SSasha Levin } 47636f5dc91SSasha Levin 47736f5dc91SSasha Levin return 0; 47836f5dc91SSasha Levin } 47936f5dc91SSasha Levin 4809b735910SMarc Zyngier static void virtio_pci__io_mmio_callback(struct kvm_cpu *vcpu, 4819b735910SMarc Zyngier u64 addr, u8 *data, u32 len, 482a463650cSWill Deacon u8 is_write, void *ptr) 483a463650cSWill Deacon { 484e09b599aSJulien Thierry struct virtio_device *vdev = ptr; 485e09b599aSJulien Thierry struct virtio_pci *vpci = vdev->virtio; 486205eaa79SAndre Przywara u32 ioport_addr = virtio_pci__port_addr(vpci); 487205eaa79SAndre Przywara u32 base_addr; 488205eaa79SAndre Przywara 489205eaa79SAndre Przywara if (addr >= ioport_addr && 490205eaa79SAndre Przywara addr < ioport_addr + pci__bar_size(&vpci->pci_hdr, 0)) 491205eaa79SAndre Przywara base_addr = ioport_addr; 492205eaa79SAndre Przywara else 493205eaa79SAndre Przywara base_addr = virtio_pci__mmio_addr(vpci); 494a463650cSWill Deacon 495e09b599aSJulien Thierry if (!is_write) 496205eaa79SAndre Przywara virtio_pci__data_in(vcpu, vdev, addr - base_addr, data, len); 497e09b599aSJulien Thierry else 498205eaa79SAndre Przywara virtio_pci__data_out(vcpu, vdev, addr - base_addr, data, len); 499a463650cSWill Deacon } 500a463650cSWill Deacon 5015a8e4f25SAlexandru Elisei static int virtio_pci__bar_activate(struct kvm *kvm, 5025a8e4f25SAlexandru Elisei struct pci_device_header *pci_hdr, 5035a8e4f25SAlexandru Elisei int bar_num, void *data) 5045a8e4f25SAlexandru Elisei { 5055a8e4f25SAlexandru Elisei struct virtio_device *vdev = data; 5065a8e4f25SAlexandru Elisei u32 bar_addr, bar_size; 5075a8e4f25SAlexandru Elisei int r = -EINVAL; 5085a8e4f25SAlexandru Elisei 5095a8e4f25SAlexandru Elisei assert(bar_num <= 2); 5105a8e4f25SAlexandru Elisei 5115a8e4f25SAlexandru Elisei bar_addr = pci__bar_address(pci_hdr, bar_num); 5125a8e4f25SAlexandru Elisei bar_size = pci__bar_size(pci_hdr, bar_num); 5135a8e4f25SAlexandru Elisei 5145a8e4f25SAlexandru Elisei switch (bar_num) { 5155a8e4f25SAlexandru Elisei case 0: 516205eaa79SAndre Przywara r = kvm__register_pio(kvm, bar_addr, bar_size, 517205eaa79SAndre Przywara virtio_pci__io_mmio_callback, vdev); 5185a8e4f25SAlexandru Elisei break; 5195a8e4f25SAlexandru Elisei case 1: 5205a8e4f25SAlexandru Elisei r = kvm__register_mmio(kvm, bar_addr, bar_size, false, 5215a8e4f25SAlexandru Elisei virtio_pci__io_mmio_callback, vdev); 5225a8e4f25SAlexandru Elisei break; 5235a8e4f25SAlexandru Elisei case 2: 5245a8e4f25SAlexandru Elisei r = kvm__register_mmio(kvm, bar_addr, bar_size, false, 5255a8e4f25SAlexandru Elisei virtio_pci__msix_mmio_callback, vdev); 5265a8e4f25SAlexandru Elisei break; 5275a8e4f25SAlexandru Elisei } 5285a8e4f25SAlexandru Elisei 5295a8e4f25SAlexandru Elisei return r; 5305a8e4f25SAlexandru Elisei } 5315a8e4f25SAlexandru Elisei 5325a8e4f25SAlexandru Elisei static int virtio_pci__bar_deactivate(struct kvm *kvm, 5335a8e4f25SAlexandru Elisei struct pci_device_header *pci_hdr, 5345a8e4f25SAlexandru Elisei int bar_num, void *data) 5355a8e4f25SAlexandru Elisei { 5365a8e4f25SAlexandru Elisei u32 bar_addr; 5375a8e4f25SAlexandru Elisei bool success; 5385a8e4f25SAlexandru Elisei int r = -EINVAL; 5395a8e4f25SAlexandru Elisei 5405a8e4f25SAlexandru Elisei assert(bar_num <= 2); 5415a8e4f25SAlexandru Elisei 5425a8e4f25SAlexandru Elisei bar_addr = pci__bar_address(pci_hdr, bar_num); 5435a8e4f25SAlexandru Elisei 5445a8e4f25SAlexandru Elisei switch (bar_num) { 5455a8e4f25SAlexandru Elisei case 0: 546205eaa79SAndre Przywara r = kvm__deregister_pio(kvm, bar_addr); 5475a8e4f25SAlexandru Elisei break; 5485a8e4f25SAlexandru Elisei case 1: 5495a8e4f25SAlexandru Elisei case 2: 5505a8e4f25SAlexandru Elisei success = kvm__deregister_mmio(kvm, bar_addr); 5515a8e4f25SAlexandru Elisei /* kvm__deregister_mmio fails when the region is not found. */ 5525a8e4f25SAlexandru Elisei r = (success ? 0 : -ENOENT); 5535a8e4f25SAlexandru Elisei break; 5545a8e4f25SAlexandru Elisei } 5555a8e4f25SAlexandru Elisei 5565a8e4f25SAlexandru Elisei return r; 5575a8e4f25SAlexandru Elisei } 5585a8e4f25SAlexandru Elisei 55902eca50cSAsias He int virtio_pci__init(struct kvm *kvm, void *dev, struct virtio_device *vdev, 560507e02d8SAsias He int device_id, int subsys_id, int class) 56136f5dc91SSasha Levin { 56202eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 563e539f3e4SAlexandru Elisei u32 mmio_addr, msix_io_block; 564e539f3e4SAlexandru Elisei u16 port_addr; 5657af40b91SSasha Levin int r; 56636f5dc91SSasha Levin 567a463650cSWill Deacon vpci->kvm = kvm; 56836f5dc91SSasha Levin vpci->dev = dev; 56936f5dc91SSasha Levin 570ce2fc8f5SAlexandru Elisei BUILD_BUG_ON(!is_power_of_two(PCI_IO_SIZE)); 571ce2fc8f5SAlexandru Elisei 572e539f3e4SAlexandru Elisei port_addr = pci_get_io_port_block(PCI_IO_SIZE); 573e539f3e4SAlexandru Elisei mmio_addr = pci_get_mmio_block(PCI_IO_SIZE); 5742e7380dbSMarc Zyngier msix_io_block = pci_get_mmio_block(VIRTIO_MSIX_BAR_SIZE); 575a463650cSWill Deacon 576*21c9bc74SJean-Philippe Brucker vpci->doorbell_offset = VIRTIO_PCI_QUEUE_NOTIFY; 577*21c9bc74SJean-Philippe Brucker 57836f5dc91SSasha Levin vpci->pci_hdr = (struct pci_device_header) { 579aa73be70SMatt Evans .vendor_id = cpu_to_le16(PCI_VENDOR_ID_REDHAT_QUMRANET), 580aa73be70SMatt Evans .device_id = cpu_to_le16(device_id), 581ec7dd52fSSasha Levin .command = PCI_COMMAND_IO | PCI_COMMAND_MEMORY, 58236f5dc91SSasha Levin .header_type = PCI_HEADER_TYPE_NORMAL, 58336f5dc91SSasha Levin .revision_id = 0, 584aa73be70SMatt Evans .class[0] = class & 0xff, 585aa73be70SMatt Evans .class[1] = (class >> 8) & 0xff, 586aa73be70SMatt Evans .class[2] = (class >> 16) & 0xff, 587aa73be70SMatt Evans .subsys_vendor_id = cpu_to_le16(PCI_SUBSYSTEM_VENDOR_ID_REDHAT_QUMRANET), 588aa73be70SMatt Evans .subsys_id = cpu_to_le16(subsys_id), 589e539f3e4SAlexandru Elisei .bar[0] = cpu_to_le32(port_addr 5909c26dab4SSasha Levin | PCI_BASE_ADDRESS_SPACE_IO), 591e539f3e4SAlexandru Elisei .bar[1] = cpu_to_le32(mmio_addr 592a508ea95SJean-Philippe Brucker | PCI_BASE_ADDRESS_SPACE_MEMORY), 593e539f3e4SAlexandru Elisei .bar[2] = cpu_to_le32(msix_io_block 594b4dab816SSasha Levin | PCI_BASE_ADDRESS_SPACE_MEMORY), 595aa73be70SMatt Evans .status = cpu_to_le16(PCI_STATUS_CAP_LIST), 59636f5dc91SSasha Levin .capabilities = (void *)&vpci->pci_hdr.msix - (void *)&vpci->pci_hdr, 59748843d10SJulien Thierry .bar_size[0] = cpu_to_le32(PCI_IO_SIZE), 59848843d10SJulien Thierry .bar_size[1] = cpu_to_le32(PCI_IO_SIZE), 5992e7380dbSMarc Zyngier .bar_size[2] = cpu_to_le32(VIRTIO_MSIX_BAR_SIZE), 60036f5dc91SSasha Levin }; 60136f5dc91SSasha Levin 6025a8e4f25SAlexandru Elisei r = pci__register_bar_regions(kvm, &vpci->pci_hdr, 6035a8e4f25SAlexandru Elisei virtio_pci__bar_activate, 6045a8e4f25SAlexandru Elisei virtio_pci__bar_deactivate, vdev); 6055a8e4f25SAlexandru Elisei if (r < 0) 6065a8e4f25SAlexandru Elisei return r; 6075a8e4f25SAlexandru Elisei 60821ff329dSWill Deacon vpci->dev_hdr = (struct device_header) { 60921ff329dSWill Deacon .bus_type = DEVICE_BUS_PCI, 61021ff329dSWill Deacon .data = &vpci->pci_hdr, 61121ff329dSWill Deacon }; 61221ff329dSWill Deacon 61336f5dc91SSasha Levin vpci->pci_hdr.msix.cap = PCI_CAP_ID_MSIX; 61436f5dc91SSasha Levin vpci->pci_hdr.msix.next = 0; 61514bba8a0SAsias He /* 6162e7380dbSMarc Zyngier * We at most have VIRTIO_NR_MSIX entries (VIRTIO_PCI_MAX_VQ 6172e7380dbSMarc Zyngier * entries for virt queue, VIRTIO_PCI_MAX_CONFIG entries for 6182e7380dbSMarc Zyngier * config). 61914bba8a0SAsias He * 62014bba8a0SAsias He * To quote the PCI spec: 62114bba8a0SAsias He * 62214bba8a0SAsias He * System software reads this field to determine the 62314bba8a0SAsias He * MSI-X Table Size N, which is encoded as N-1. 62414bba8a0SAsias He * For example, a returned value of "00000000011" 62514bba8a0SAsias He * indicates a table size of 4. 62614bba8a0SAsias He */ 6272e7380dbSMarc Zyngier vpci->pci_hdr.msix.ctrl = cpu_to_le16(VIRTIO_NR_MSIX - 1); 62806f48103SSasha Levin 629a463650cSWill Deacon /* Both table and PBA are mapped to the same BAR (2) */ 630a463650cSWill Deacon vpci->pci_hdr.msix.table_offset = cpu_to_le32(2); 6312e7380dbSMarc Zyngier vpci->pci_hdr.msix.pba_offset = cpu_to_le32(2 | VIRTIO_MSIX_TABLE_SIZE); 63236f5dc91SSasha Levin vpci->config_vector = 0; 63336f5dc91SSasha Levin 634f6108d72SJean-Philippe Brucker if (irq__can_signal_msi(kvm)) 63543c81c74SSasha Levin vpci->features |= VIRTIO_PCI_F_SIGNAL_MSI; 63643c81c74SSasha Levin 637c0c45eedSAndre Przywara vpci->legacy_irq_line = pci__assign_irq(&vpci->pci_hdr); 638c0c45eedSAndre Przywara 63921ff329dSWill Deacon r = device__register(&vpci->dev_hdr); 640495fbd4eSSasha Levin if (r < 0) 6415a8e4f25SAlexandru Elisei return r; 642495fbd4eSSasha Levin 643495fbd4eSSasha Levin return 0; 644495fbd4eSSasha Levin } 645495fbd4eSSasha Levin 646eb34a8c2SJean-Philippe Brucker int virtio_pci__reset(struct kvm *kvm, struct virtio_device *vdev) 647eb34a8c2SJean-Philippe Brucker { 64831e0eaccSMartin Radev unsigned int vq; 649eb34a8c2SJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 650eb34a8c2SJean-Philippe Brucker 651c6590f78SJean-Philippe Brucker virtio_pci__del_msix_route(vpci, vpci->config_gsi); 652c6590f78SJean-Philippe Brucker vpci->config_gsi = 0; 653c6590f78SJean-Philippe Brucker vpci->config_vector = VIRTIO_MSI_NO_VECTOR; 654c6590f78SJean-Philippe Brucker 655eb34a8c2SJean-Philippe Brucker for (vq = 0; vq < vdev->ops->get_vq_count(kvm, vpci->dev); vq++) 656eb34a8c2SJean-Philippe Brucker virtio_pci_exit_vq(kvm, vdev, vq); 657eb34a8c2SJean-Philippe Brucker 658eb34a8c2SJean-Philippe Brucker return 0; 659eb34a8c2SJean-Philippe Brucker } 660eb34a8c2SJean-Philippe Brucker 66102eca50cSAsias He int virtio_pci__exit(struct kvm *kvm, struct virtio_device *vdev) 662495fbd4eSSasha Levin { 66302eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 664495fbd4eSSasha Levin 665eb34a8c2SJean-Philippe Brucker virtio_pci__reset(kvm, vdev); 666e539f3e4SAlexandru Elisei kvm__deregister_mmio(kvm, virtio_pci__mmio_addr(vpci)); 667e539f3e4SAlexandru Elisei kvm__deregister_mmio(kvm, virtio_pci__msix_io_addr(vpci)); 668205eaa79SAndre Przywara kvm__deregister_pio(kvm, virtio_pci__port_addr(vpci)); 669495fbd4eSSasha Levin 67036f5dc91SSasha Levin return 0; 67136f5dc91SSasha Levin } 672