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 401599d724SSasha Levin static void virtio_pci__ioevent_callback(struct kvm *kvm, void *param) 411599d724SSasha Levin { 421599d724SSasha Levin struct virtio_pci_ioevent_param *ioeventfd = param; 4302eca50cSAsias He struct virtio_pci *vpci = ioeventfd->vdev->virtio; 441599d724SSasha Levin 4502eca50cSAsias He ioeventfd->vdev->ops->notify_vq(kvm, vpci->dev, ioeventfd->vq); 461599d724SSasha Levin } 471599d724SSasha Levin 4802eca50cSAsias He static int virtio_pci__init_ioeventfd(struct kvm *kvm, struct virtio_device *vdev, u32 vq) 491599d724SSasha Levin { 501599d724SSasha Levin struct ioevent ioevent; 5102eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 52e539f3e4SAlexandru Elisei u32 mmio_addr = virtio_pci__mmio_addr(vpci); 53e539f3e4SAlexandru Elisei u16 port_addr = virtio_pci__port_addr(vpci); 540e1882a4SJean-Philippe Brucker int r, flags = 0; 550e1882a4SJean-Philippe Brucker int fd; 561599d724SSasha Levin 571599d724SSasha Levin vpci->ioeventfds[vq] = (struct virtio_pci_ioevent_param) { 5802eca50cSAsias He .vdev = vdev, 591599d724SSasha Levin .vq = vq, 601599d724SSasha Levin }; 611599d724SSasha Levin 621599d724SSasha Levin ioevent = (struct ioevent) { 631599d724SSasha Levin .fn = virtio_pci__ioevent_callback, 641599d724SSasha Levin .fn_ptr = &vpci->ioeventfds[vq], 651599d724SSasha Levin .datamatch = vq, 661599d724SSasha Levin .fn_kvm = kvm, 671599d724SSasha Levin }; 681599d724SSasha Levin 69627d6874SAsias He /* 70a463650cSWill Deacon * Vhost will poll the eventfd in host kernel side, otherwise we 71a463650cSWill Deacon * need to poll in userspace. 72627d6874SAsias He */ 73a463650cSWill Deacon if (!vdev->use_vhost) 74a463650cSWill Deacon flags |= IOEVENTFD_FLAG_USER_POLL; 75a463650cSWill Deacon 76a463650cSWill Deacon /* ioport */ 77e539f3e4SAlexandru Elisei ioevent.io_addr = port_addr + VIRTIO_PCI_QUEUE_NOTIFY; 78a463650cSWill Deacon ioevent.io_len = sizeof(u16); 790e1882a4SJean-Philippe Brucker ioevent.fd = fd = eventfd(0, 0); 8071ca0facSAndre Przywara r = ioeventfd__add_event(&ioevent, flags | IOEVENTFD_FLAG_PIO); 81ea6eeb1cSSasha Levin if (r) 82ea6eeb1cSSasha Levin return r; 831599d724SSasha Levin 84a463650cSWill Deacon /* mmio */ 85e539f3e4SAlexandru Elisei ioevent.io_addr = mmio_addr + VIRTIO_PCI_QUEUE_NOTIFY; 86fe50bacbSAndreas Herrmann ioevent.io_len = sizeof(u16); 870e1882a4SJean-Philippe Brucker ioevent.fd = eventfd(0, 0); 88a463650cSWill Deacon r = ioeventfd__add_event(&ioevent, flags); 89a463650cSWill Deacon if (r) 90a463650cSWill Deacon goto free_ioport_evt; 91263b80e8SSasha Levin 92a463650cSWill Deacon if (vdev->ops->notify_vq_eventfd) 930e1882a4SJean-Philippe Brucker vdev->ops->notify_vq_eventfd(kvm, vpci->dev, vq, fd); 941599d724SSasha Levin return 0; 95a463650cSWill Deacon 96a463650cSWill Deacon free_ioport_evt: 97e539f3e4SAlexandru Elisei ioeventfd__del_event(port_addr + VIRTIO_PCI_QUEUE_NOTIFY, vq); 98a463650cSWill Deacon return r; 991599d724SSasha Levin } 1001599d724SSasha Levin 101ad346c2eSJean-Philippe Brucker static void virtio_pci_exit_vq(struct kvm *kvm, struct virtio_device *vdev, 102ad346c2eSJean-Philippe Brucker int vq) 103ad346c2eSJean-Philippe Brucker { 104ad346c2eSJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 105e539f3e4SAlexandru Elisei u32 mmio_addr = virtio_pci__mmio_addr(vpci); 106e539f3e4SAlexandru Elisei u16 port_addr = virtio_pci__port_addr(vpci); 107ad346c2eSJean-Philippe Brucker 108e539f3e4SAlexandru Elisei ioeventfd__del_event(mmio_addr + VIRTIO_PCI_QUEUE_NOTIFY, vq); 109e539f3e4SAlexandru Elisei ioeventfd__del_event(port_addr + VIRTIO_PCI_QUEUE_NOTIFY, vq); 110ad346c2eSJean-Philippe Brucker virtio_exit_vq(kvm, vdev, vpci->dev, vq); 111ad346c2eSJean-Philippe Brucker } 112ad346c2eSJean-Philippe Brucker 11306f48103SSasha Levin static inline bool virtio_pci__msix_enabled(struct virtio_pci *vpci) 11406f48103SSasha Levin { 115aa73be70SMatt Evans return vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_ENABLE); 11606f48103SSasha Levin } 11706f48103SSasha Levin 118e09b599aSJulien Thierry static bool virtio_pci__specific_data_in(struct kvm *kvm, struct virtio_device *vdev, 11906e1e6feSMartin Radev void *data, u32 size, unsigned long offset) 12036f5dc91SSasha Levin { 12136f5dc91SSasha Levin u32 config_offset; 12202eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 12306f48103SSasha Levin int type = virtio__get_dev_specific_field(offset - 20, 12406f48103SSasha Levin virtio_pci__msix_enabled(vpci), 1251382aba0SSasha Levin &config_offset); 12636f5dc91SSasha Levin if (type == VIRTIO_PCI_O_MSIX) { 12736f5dc91SSasha Levin switch (offset) { 12836f5dc91SSasha Levin case VIRTIO_MSI_CONFIG_VECTOR: 12936f5dc91SSasha Levin ioport__write16(data, vpci->config_vector); 13036f5dc91SSasha Levin break; 13136f5dc91SSasha Levin case VIRTIO_MSI_QUEUE_VECTOR: 13236f5dc91SSasha Levin ioport__write16(data, vpci->vq_vector[vpci->queue_selector]); 13336f5dc91SSasha Levin break; 13436f5dc91SSasha Levin }; 13536f5dc91SSasha Levin 13636f5dc91SSasha Levin return true; 13736f5dc91SSasha Levin } else if (type == VIRTIO_PCI_O_CONFIG) { 13836f5dc91SSasha Levin u8 cfg; 139e4730284SMartin Radev size_t config_size; 14036f5dc91SSasha Levin 141e4730284SMartin Radev config_size = vdev->ops->get_config_size(kvm, vpci->dev); 142e4730284SMartin Radev if (config_offset + size > config_size) { 143e4730284SMartin Radev /* Access goes beyond the config size, so return failure. */ 144e4730284SMartin Radev WARN_ONCE(1, "Config access offset (%u) is beyond config size (%zu)\n", 145e4730284SMartin Radev config_offset, config_size); 146e4730284SMartin Radev return false; 147e4730284SMartin Radev } 148e4730284SMartin Radev 149e4730284SMartin Radev /* TODO: Handle access lengths beyond one byte */ 150e4730284SMartin Radev if (size != 1) { 151e4730284SMartin Radev WARN_ONCE(1, "Size (%u) not supported\n", size); 152e4730284SMartin Radev return false; 153e4730284SMartin Radev } 154c5ae742bSSasha Levin cfg = vdev->ops->get_config(kvm, vpci->dev)[config_offset]; 15536f5dc91SSasha Levin ioport__write8(data, cfg); 15636f5dc91SSasha Levin return true; 15736f5dc91SSasha Levin } 15836f5dc91SSasha Levin 15936f5dc91SSasha Levin return false; 16036f5dc91SSasha Levin } 16136f5dc91SSasha Levin 162e09b599aSJulien Thierry static bool virtio_pci__data_in(struct kvm_cpu *vcpu, struct virtio_device *vdev, 16306e1e6feSMartin Radev unsigned long offset, void *data, u32 size) 16436f5dc91SSasha Levin { 16536f5dc91SSasha Levin bool ret = true; 16636f5dc91SSasha Levin struct virtio_pci *vpci; 16753fbb17bSJean-Philippe Brucker struct virt_queue *vq; 1684123ca55SMarc Zyngier struct kvm *kvm; 16936f5dc91SSasha Levin u32 val; 17036f5dc91SSasha Levin 1714123ca55SMarc Zyngier kvm = vcpu->kvm; 17202eca50cSAsias He vpci = vdev->virtio; 17336f5dc91SSasha Levin 17436f5dc91SSasha Levin switch (offset) { 17536f5dc91SSasha Levin case VIRTIO_PCI_HOST_FEATURES: 17602eca50cSAsias He val = vdev->ops->get_host_features(kvm, vpci->dev); 17736f5dc91SSasha Levin ioport__write32(data, val); 17836f5dc91SSasha Levin break; 17936f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_PFN: 18053fbb17bSJean-Philippe Brucker vq = vdev->ops->get_vq(kvm, vpci->dev, vpci->queue_selector); 181*609ee906SJean-Philippe Brucker ioport__write32(data, vq->vring_addr.pfn); 18236f5dc91SSasha Levin break; 18336f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_NUM: 18402eca50cSAsias He val = vdev->ops->get_size_vq(kvm, vpci->dev, vpci->queue_selector); 185657ee18bSMatt Evans ioport__write16(data, val); 18636f5dc91SSasha Levin break; 18736f5dc91SSasha Levin case VIRTIO_PCI_STATUS: 18836f5dc91SSasha Levin ioport__write8(data, vpci->status); 18936f5dc91SSasha Levin break; 19036f5dc91SSasha Levin case VIRTIO_PCI_ISR: 19136f5dc91SSasha Levin ioport__write8(data, vpci->isr); 192e9922aafSAndre Przywara kvm__irq_line(kvm, vpci->legacy_irq_line, VIRTIO_IRQ_LOW); 19336f5dc91SSasha Levin vpci->isr = VIRTIO_IRQ_LOW; 19436f5dc91SSasha Levin break; 19536f5dc91SSasha Levin default: 196e09b599aSJulien Thierry ret = virtio_pci__specific_data_in(kvm, vdev, data, size, offset); 19736f5dc91SSasha Levin break; 19836f5dc91SSasha Levin }; 19936f5dc91SSasha Levin 20036f5dc91SSasha Levin return ret; 20136f5dc91SSasha Levin } 20236f5dc91SSasha Levin 2036518065aSAndre Przywara static void update_msix_map(struct virtio_pci *vpci, 2046518065aSAndre Przywara struct msix_table *msix_entry, u32 vecnum) 2056518065aSAndre Przywara { 2066518065aSAndre Przywara u32 gsi, i; 2076518065aSAndre Przywara 2086518065aSAndre Przywara /* Find the GSI number used for that vector */ 2096518065aSAndre Przywara if (vecnum == vpci->config_vector) { 2106518065aSAndre Przywara gsi = vpci->config_gsi; 2116518065aSAndre Przywara } else { 2126518065aSAndre Przywara for (i = 0; i < VIRTIO_PCI_MAX_VQ; i++) 2136518065aSAndre Przywara if (vpci->vq_vector[i] == vecnum) 2146518065aSAndre Przywara break; 2156518065aSAndre Przywara if (i == VIRTIO_PCI_MAX_VQ) 2166518065aSAndre Przywara return; 2176518065aSAndre Przywara gsi = vpci->gsis[i]; 2186518065aSAndre Przywara } 2196518065aSAndre Przywara 2206518065aSAndre Przywara if (gsi == 0) 2216518065aSAndre Przywara return; 2226518065aSAndre Przywara 2236518065aSAndre Przywara msix_entry = &msix_entry[vecnum]; 2246518065aSAndre Przywara irq__update_msix_route(vpci->kvm, gsi, &msix_entry->msg); 2256518065aSAndre Przywara } 2266518065aSAndre Przywara 227e09b599aSJulien Thierry static bool virtio_pci__specific_data_out(struct kvm *kvm, struct virtio_device *vdev, 22806e1e6feSMartin Radev void *data, u32 size, unsigned long offset) 22936f5dc91SSasha Levin { 23002eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 2318ccc8549SAndre Przywara u32 config_offset, vec; 2328ccc8549SAndre Przywara int gsi; 23306f48103SSasha Levin int type = virtio__get_dev_specific_field(offset - 20, virtio_pci__msix_enabled(vpci), 2341382aba0SSasha Levin &config_offset); 23536f5dc91SSasha Levin if (type == VIRTIO_PCI_O_MSIX) { 23636f5dc91SSasha Levin switch (offset) { 23736f5dc91SSasha Levin case VIRTIO_MSI_CONFIG_VECTOR: 23836f5dc91SSasha Levin vec = vpci->config_vector = ioport__read16(data); 239f8327b05SSasha Levin if (vec == VIRTIO_MSI_NO_VECTOR) 240f8327b05SSasha Levin break; 24136f5dc91SSasha Levin 2428ccc8549SAndre Przywara gsi = irq__add_msix_route(kvm, 243f9ef46f2SAndre Przywara &vpci->msix_table[vec].msg, 244f9ef46f2SAndre Przywara vpci->dev_hdr.dev_num << 3); 245928ab7acSAndre Przywara /* 246928ab7acSAndre Przywara * We don't need IRQ routing if we can use 247928ab7acSAndre Przywara * MSI injection via the KVM_SIGNAL_MSI ioctl. 248928ab7acSAndre Przywara */ 249928ab7acSAndre Przywara if (gsi == -ENXIO && 250928ab7acSAndre Przywara vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 251928ab7acSAndre Przywara break; 252928ab7acSAndre Przywara 253928ab7acSAndre Przywara if (gsi < 0) { 254928ab7acSAndre Przywara die("failed to configure MSIs"); 255928ab7acSAndre Przywara break; 256928ab7acSAndre Przywara } 257928ab7acSAndre Przywara 25836f5dc91SSasha Levin vpci->config_gsi = gsi; 25936f5dc91SSasha Levin break; 2603a60be06SSasha Levin case VIRTIO_MSI_QUEUE_VECTOR: 2618ccc8549SAndre Przywara vec = ioport__read16(data); 2628ccc8549SAndre Przywara vpci->vq_vector[vpci->queue_selector] = vec; 26336f5dc91SSasha Levin 264f8327b05SSasha Levin if (vec == VIRTIO_MSI_NO_VECTOR) 265f8327b05SSasha Levin break; 266f8327b05SSasha Levin 2678ccc8549SAndre Przywara gsi = irq__add_msix_route(kvm, 268f9ef46f2SAndre Przywara &vpci->msix_table[vec].msg, 269f9ef46f2SAndre Przywara vpci->dev_hdr.dev_num << 3); 270928ab7acSAndre Przywara /* 271928ab7acSAndre Przywara * We don't need IRQ routing if we can use 272928ab7acSAndre Przywara * MSI injection via the KVM_SIGNAL_MSI ioctl. 273928ab7acSAndre Przywara */ 274928ab7acSAndre Przywara if (gsi == -ENXIO && 275928ab7acSAndre Przywara vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 2768ccc8549SAndre Przywara break; 277928ab7acSAndre Przywara 278928ab7acSAndre Przywara if (gsi < 0) { 279928ab7acSAndre Przywara die("failed to configure MSIs"); 280928ab7acSAndre Przywara break; 281928ab7acSAndre Przywara } 282928ab7acSAndre Przywara 28336f5dc91SSasha Levin vpci->gsis[vpci->queue_selector] = gsi; 28402eca50cSAsias He if (vdev->ops->notify_vq_gsi) 28502eca50cSAsias He vdev->ops->notify_vq_gsi(kvm, vpci->dev, 2868ccc8549SAndre Przywara vpci->queue_selector, 2878ccc8549SAndre Przywara gsi); 28836f5dc91SSasha Levin break; 28936f5dc91SSasha Levin }; 29036f5dc91SSasha Levin 29136f5dc91SSasha Levin return true; 29236f5dc91SSasha Levin } else if (type == VIRTIO_PCI_O_CONFIG) { 293e4730284SMartin Radev size_t config_size; 294e4730284SMartin Radev 295e4730284SMartin Radev config_size = vdev->ops->get_config_size(kvm, vpci->dev); 296e4730284SMartin Radev if (config_offset + size > config_size) { 297e4730284SMartin Radev /* Access goes beyond the config size, so return failure. */ 298e4730284SMartin Radev WARN_ONCE(1, "Config access offset (%u) is beyond config size (%zu)\n", 299e4730284SMartin Radev config_offset, config_size); 300e4730284SMartin Radev return false; 301e4730284SMartin Radev } 302e4730284SMartin Radev 303e4730284SMartin Radev /* TODO: Handle access lengths beyond one byte */ 304e4730284SMartin Radev if (size != 1) { 305e4730284SMartin Radev WARN_ONCE(1, "Size (%u) not supported\n", size); 306e4730284SMartin Radev return false; 307e4730284SMartin Radev } 308c5ae742bSSasha Levin vdev->ops->get_config(kvm, vpci->dev)[config_offset] = *(u8 *)data; 30936f5dc91SSasha Levin 31036f5dc91SSasha Levin return true; 31136f5dc91SSasha Levin } 31236f5dc91SSasha Levin 31336f5dc91SSasha Levin return false; 31436f5dc91SSasha Levin } 31536f5dc91SSasha Levin 316e09b599aSJulien Thierry static bool virtio_pci__data_out(struct kvm_cpu *vcpu, struct virtio_device *vdev, 31706e1e6feSMartin Radev unsigned long offset, void *data, u32 size) 31836f5dc91SSasha Levin { 31936f5dc91SSasha Levin bool ret = true; 32036f5dc91SSasha Levin struct virtio_pci *vpci; 321*609ee906SJean-Philippe Brucker struct virt_queue *vq; 3224123ca55SMarc Zyngier struct kvm *kvm; 32336f5dc91SSasha Levin u32 val; 32431e0eaccSMartin Radev unsigned int vq_count; 32536f5dc91SSasha Levin 3264123ca55SMarc Zyngier kvm = vcpu->kvm; 32702eca50cSAsias He vpci = vdev->virtio; 32831e0eaccSMartin Radev vq_count = vdev->ops->get_vq_count(kvm, vpci->dev); 32936f5dc91SSasha Levin 33036f5dc91SSasha Levin switch (offset) { 33136f5dc91SSasha Levin case VIRTIO_PCI_GUEST_FEATURES: 33236f5dc91SSasha Levin val = ioport__read32(data); 33356a16c90SJean-Philippe Brucker virtio_set_guest_features(kvm, vdev, vpci->dev, val); 33436f5dc91SSasha Levin break; 33536f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_PFN: 33636f5dc91SSasha Levin val = ioport__read32(data); 337ad346c2eSJean-Philippe Brucker if (val) { 338*609ee906SJean-Philippe Brucker vq = vdev->ops->get_vq(kvm, vpci->dev, 339*609ee906SJean-Philippe Brucker vpci->queue_selector); 340*609ee906SJean-Philippe Brucker vq->vring_addr = (struct vring_addr) { 341*609ee906SJean-Philippe Brucker .legacy = true, 342*609ee906SJean-Philippe Brucker .pfn = val, 343*609ee906SJean-Philippe Brucker .align = VIRTIO_PCI_VRING_ALIGN, 344*609ee906SJean-Philippe Brucker .pgsize = 1 << VIRTIO_PCI_QUEUE_ADDR_SHIFT, 345*609ee906SJean-Philippe Brucker }; 346ad346c2eSJean-Philippe Brucker virtio_pci__init_ioeventfd(kvm, vdev, 347ad346c2eSJean-Philippe Brucker vpci->queue_selector); 348*609ee906SJean-Philippe Brucker vdev->ops->init_vq(kvm, vpci->dev, 349*609ee906SJean-Philippe Brucker vpci->queue_selector); 350ad346c2eSJean-Philippe Brucker } else { 351ad346c2eSJean-Philippe Brucker virtio_pci_exit_vq(kvm, vdev, vpci->queue_selector); 352ad346c2eSJean-Philippe Brucker } 35336f5dc91SSasha Levin break; 35436f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_SEL: 35531e0eaccSMartin Radev val = ioport__read16(data); 35631e0eaccSMartin Radev if (val >= vq_count) { 35731e0eaccSMartin Radev WARN_ONCE(1, "QUEUE_SEL value (%u) is larger than VQ count (%u)\n", 35831e0eaccSMartin Radev val, vq_count); 35931e0eaccSMartin Radev return false; 36031e0eaccSMartin Radev } 36131e0eaccSMartin Radev vpci->queue_selector = val; 36236f5dc91SSasha Levin break; 36336f5dc91SSasha Levin case VIRTIO_PCI_QUEUE_NOTIFY: 36436f5dc91SSasha Levin val = ioport__read16(data); 36531e0eaccSMartin Radev if (val >= vq_count) { 36631e0eaccSMartin Radev WARN_ONCE(1, "QUEUE_SEL value (%u) is larger than VQ count (%u)\n", 36731e0eaccSMartin Radev val, vq_count); 36831e0eaccSMartin Radev return false; 36931e0eaccSMartin Radev } 37002eca50cSAsias He vdev->ops->notify_vq(kvm, vpci->dev, val); 37136f5dc91SSasha Levin break; 37236f5dc91SSasha Levin case VIRTIO_PCI_STATUS: 37336f5dc91SSasha Levin vpci->status = ioport__read8(data); 3744123ca55SMarc Zyngier if (!vpci->status) /* Sample endianness on reset */ 3754123ca55SMarc Zyngier vdev->endian = kvm_cpu__get_endianness(vcpu); 37695242e44SJean-Philippe Brucker virtio_notify_status(kvm, vdev, vpci->dev, vpci->status); 37736f5dc91SSasha Levin break; 37836f5dc91SSasha Levin default: 379e09b599aSJulien Thierry ret = virtio_pci__specific_data_out(kvm, vdev, data, size, offset); 38036f5dc91SSasha Levin break; 38136f5dc91SSasha Levin }; 38236f5dc91SSasha Levin 38336f5dc91SSasha Levin return ret; 38436f5dc91SSasha Levin } 38536f5dc91SSasha Levin 3869b735910SMarc Zyngier static void virtio_pci__msix_mmio_callback(struct kvm_cpu *vcpu, 3879b735910SMarc Zyngier u64 addr, u8 *data, u32 len, 388a463650cSWill Deacon u8 is_write, void *ptr) 38936f5dc91SSasha Levin { 390e09b599aSJulien Thierry struct virtio_device *vdev = ptr; 391e09b599aSJulien Thierry struct virtio_pci *vpci = vdev->virtio; 3926518065aSAndre Przywara struct msix_table *table; 393e539f3e4SAlexandru Elisei u32 msix_io_addr = virtio_pci__msix_io_addr(vpci); 3942e7380dbSMarc Zyngier u32 pba_offset; 3956518065aSAndre Przywara int vecnum; 3966518065aSAndre Przywara size_t offset; 39736f5dc91SSasha Levin 3982e7380dbSMarc Zyngier BUILD_BUG_ON(VIRTIO_NR_MSIX > (sizeof(vpci->msix_pba) * 8)); 3992e7380dbSMarc Zyngier 4002e7380dbSMarc Zyngier pba_offset = vpci->pci_hdr.msix.pba_offset & ~PCI_MSIX_TABLE_BIR; 4012e7380dbSMarc Zyngier if (addr >= msix_io_addr + pba_offset) { 4022e7380dbSMarc Zyngier /* Read access to PBA */ 4036518065aSAndre Przywara if (is_write) 4046518065aSAndre Przywara return; 4052e7380dbSMarc Zyngier offset = addr - (msix_io_addr + pba_offset); 4062e7380dbSMarc Zyngier if ((offset + len) > sizeof (vpci->msix_pba)) 4072e7380dbSMarc Zyngier return; 4082e7380dbSMarc Zyngier memcpy(data, (void *)&vpci->msix_pba + offset, len); 4092e7380dbSMarc Zyngier return; 4102e7380dbSMarc Zyngier } 4112e7380dbSMarc Zyngier 4126518065aSAndre Przywara table = vpci->msix_table; 413e539f3e4SAlexandru Elisei offset = addr - msix_io_addr; 4142e7380dbSMarc Zyngier 4156518065aSAndre Przywara vecnum = offset / sizeof(struct msix_table); 4166518065aSAndre Przywara offset = offset % sizeof(struct msix_table); 4176518065aSAndre Przywara 4186518065aSAndre Przywara if (!is_write) { 4196518065aSAndre Przywara memcpy(data, (void *)&table[vecnum] + offset, len); 4206518065aSAndre Przywara return; 42136f5dc91SSasha Levin } 42236f5dc91SSasha Levin 4236518065aSAndre Przywara memcpy((void *)&table[vecnum] + offset, data, len); 4246518065aSAndre Przywara 4256518065aSAndre Przywara /* Did we just update the address or payload? */ 4266518065aSAndre Przywara if (offset < offsetof(struct msix_table, ctrl)) 4276518065aSAndre Przywara update_msix_map(vpci, table, vecnum); 42806f48103SSasha Levin } 42906f48103SSasha Levin 430714ab9e6SAndre Przywara static void virtio_pci__signal_msi(struct kvm *kvm, struct virtio_pci *vpci, 431714ab9e6SAndre Przywara int vec) 43243c81c74SSasha Levin { 43343c81c74SSasha Levin struct kvm_msi msi = { 43443c81c74SSasha Levin .address_lo = vpci->msix_table[vec].msg.address_lo, 43543c81c74SSasha Levin .address_hi = vpci->msix_table[vec].msg.address_hi, 43643c81c74SSasha Levin .data = vpci->msix_table[vec].msg.data, 43743c81c74SSasha Levin }; 43843c81c74SSasha Levin 439714ab9e6SAndre Przywara if (kvm->msix_needs_devid) { 440714ab9e6SAndre Przywara msi.flags = KVM_MSI_VALID_DEVID; 441714ab9e6SAndre Przywara msi.devid = vpci->dev_hdr.dev_num << 3; 442714ab9e6SAndre Przywara } 443714ab9e6SAndre Przywara 444f6108d72SJean-Philippe Brucker irq__signal_msi(kvm, &msi); 44543c81c74SSasha Levin } 44643c81c74SSasha Levin 44702eca50cSAsias He int virtio_pci__signal_vq(struct kvm *kvm, struct virtio_device *vdev, u32 vq) 44836f5dc91SSasha Levin { 44902eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 45006f48103SSasha Levin int tbl = vpci->vq_vector[vq]; 45136f5dc91SSasha Levin 452f8327b05SSasha Levin if (virtio_pci__msix_enabled(vpci) && tbl != VIRTIO_MSI_NO_VECTOR) { 453aa73be70SMatt Evans if (vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_MASKALL) || 454aa73be70SMatt Evans vpci->msix_table[tbl].ctrl & cpu_to_le16(PCI_MSIX_ENTRY_CTRL_MASKBIT)) { 45506f48103SSasha Levin 45606f48103SSasha Levin vpci->msix_pba |= 1 << tbl; 45706f48103SSasha Levin return 0; 45806f48103SSasha Levin } 45906f48103SSasha Levin 46043c81c74SSasha Levin if (vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 46143c81c74SSasha Levin virtio_pci__signal_msi(kvm, vpci, vpci->vq_vector[vq]); 46243c81c74SSasha Levin else 46306f48103SSasha Levin kvm__irq_trigger(kvm, vpci->gsis[vq]); 46406f48103SSasha Levin } else { 465a36eca7bSSasha Levin vpci->isr = VIRTIO_IRQ_HIGH; 4662108c86dSMarc Zyngier kvm__irq_line(kvm, vpci->legacy_irq_line, VIRTIO_IRQ_HIGH); 46706f48103SSasha Levin } 46836f5dc91SSasha Levin return 0; 46936f5dc91SSasha Levin } 47036f5dc91SSasha Levin 47102eca50cSAsias He int virtio_pci__signal_config(struct kvm *kvm, struct virtio_device *vdev) 47236f5dc91SSasha Levin { 47302eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 47406f48103SSasha Levin int tbl = vpci->config_vector; 47506f48103SSasha Levin 476f8327b05SSasha Levin if (virtio_pci__msix_enabled(vpci) && tbl != VIRTIO_MSI_NO_VECTOR) { 477aa73be70SMatt Evans if (vpci->pci_hdr.msix.ctrl & cpu_to_le16(PCI_MSIX_FLAGS_MASKALL) || 478aa73be70SMatt Evans vpci->msix_table[tbl].ctrl & cpu_to_le16(PCI_MSIX_ENTRY_CTRL_MASKBIT)) { 47906f48103SSasha Levin 48006f48103SSasha Levin vpci->msix_pba |= 1 << tbl; 48106f48103SSasha Levin return 0; 48206f48103SSasha Levin } 48306f48103SSasha Levin 48443c81c74SSasha Levin if (vpci->features & VIRTIO_PCI_F_SIGNAL_MSI) 485f8327b05SSasha Levin virtio_pci__signal_msi(kvm, vpci, tbl); 48643c81c74SSasha Levin else 48706f48103SSasha Levin kvm__irq_trigger(kvm, vpci->config_gsi); 48806f48103SSasha Levin } else { 48906f48103SSasha Levin vpci->isr = VIRTIO_PCI_ISR_CONFIG; 490e9922aafSAndre Przywara kvm__irq_trigger(kvm, vpci->legacy_irq_line); 49106f48103SSasha Levin } 49236f5dc91SSasha Levin 49336f5dc91SSasha Levin return 0; 49436f5dc91SSasha Levin } 49536f5dc91SSasha Levin 4969b735910SMarc Zyngier static void virtio_pci__io_mmio_callback(struct kvm_cpu *vcpu, 4979b735910SMarc Zyngier u64 addr, u8 *data, u32 len, 498a463650cSWill Deacon u8 is_write, void *ptr) 499a463650cSWill Deacon { 500e09b599aSJulien Thierry struct virtio_device *vdev = ptr; 501e09b599aSJulien Thierry struct virtio_pci *vpci = vdev->virtio; 502205eaa79SAndre Przywara u32 ioport_addr = virtio_pci__port_addr(vpci); 503205eaa79SAndre Przywara u32 base_addr; 504205eaa79SAndre Przywara 505205eaa79SAndre Przywara if (addr >= ioport_addr && 506205eaa79SAndre Przywara addr < ioport_addr + pci__bar_size(&vpci->pci_hdr, 0)) 507205eaa79SAndre Przywara base_addr = ioport_addr; 508205eaa79SAndre Przywara else 509205eaa79SAndre Przywara base_addr = virtio_pci__mmio_addr(vpci); 510a463650cSWill Deacon 511e09b599aSJulien Thierry if (!is_write) 512205eaa79SAndre Przywara virtio_pci__data_in(vcpu, vdev, addr - base_addr, data, len); 513e09b599aSJulien Thierry else 514205eaa79SAndre Przywara virtio_pci__data_out(vcpu, vdev, addr - base_addr, data, len); 515a463650cSWill Deacon } 516a463650cSWill Deacon 5175a8e4f25SAlexandru Elisei static int virtio_pci__bar_activate(struct kvm *kvm, 5185a8e4f25SAlexandru Elisei struct pci_device_header *pci_hdr, 5195a8e4f25SAlexandru Elisei int bar_num, void *data) 5205a8e4f25SAlexandru Elisei { 5215a8e4f25SAlexandru Elisei struct virtio_device *vdev = data; 5225a8e4f25SAlexandru Elisei u32 bar_addr, bar_size; 5235a8e4f25SAlexandru Elisei int r = -EINVAL; 5245a8e4f25SAlexandru Elisei 5255a8e4f25SAlexandru Elisei assert(bar_num <= 2); 5265a8e4f25SAlexandru Elisei 5275a8e4f25SAlexandru Elisei bar_addr = pci__bar_address(pci_hdr, bar_num); 5285a8e4f25SAlexandru Elisei bar_size = pci__bar_size(pci_hdr, bar_num); 5295a8e4f25SAlexandru Elisei 5305a8e4f25SAlexandru Elisei switch (bar_num) { 5315a8e4f25SAlexandru Elisei case 0: 532205eaa79SAndre Przywara r = kvm__register_pio(kvm, bar_addr, bar_size, 533205eaa79SAndre Przywara virtio_pci__io_mmio_callback, vdev); 5345a8e4f25SAlexandru Elisei break; 5355a8e4f25SAlexandru Elisei case 1: 5365a8e4f25SAlexandru Elisei r = kvm__register_mmio(kvm, bar_addr, bar_size, false, 5375a8e4f25SAlexandru Elisei virtio_pci__io_mmio_callback, vdev); 5385a8e4f25SAlexandru Elisei break; 5395a8e4f25SAlexandru Elisei case 2: 5405a8e4f25SAlexandru Elisei r = kvm__register_mmio(kvm, bar_addr, bar_size, false, 5415a8e4f25SAlexandru Elisei virtio_pci__msix_mmio_callback, vdev); 5425a8e4f25SAlexandru Elisei break; 5435a8e4f25SAlexandru Elisei } 5445a8e4f25SAlexandru Elisei 5455a8e4f25SAlexandru Elisei return r; 5465a8e4f25SAlexandru Elisei } 5475a8e4f25SAlexandru Elisei 5485a8e4f25SAlexandru Elisei static int virtio_pci__bar_deactivate(struct kvm *kvm, 5495a8e4f25SAlexandru Elisei struct pci_device_header *pci_hdr, 5505a8e4f25SAlexandru Elisei int bar_num, void *data) 5515a8e4f25SAlexandru Elisei { 5525a8e4f25SAlexandru Elisei u32 bar_addr; 5535a8e4f25SAlexandru Elisei bool success; 5545a8e4f25SAlexandru Elisei int r = -EINVAL; 5555a8e4f25SAlexandru Elisei 5565a8e4f25SAlexandru Elisei assert(bar_num <= 2); 5575a8e4f25SAlexandru Elisei 5585a8e4f25SAlexandru Elisei bar_addr = pci__bar_address(pci_hdr, bar_num); 5595a8e4f25SAlexandru Elisei 5605a8e4f25SAlexandru Elisei switch (bar_num) { 5615a8e4f25SAlexandru Elisei case 0: 562205eaa79SAndre Przywara r = kvm__deregister_pio(kvm, bar_addr); 5635a8e4f25SAlexandru Elisei break; 5645a8e4f25SAlexandru Elisei case 1: 5655a8e4f25SAlexandru Elisei case 2: 5665a8e4f25SAlexandru Elisei success = kvm__deregister_mmio(kvm, bar_addr); 5675a8e4f25SAlexandru Elisei /* kvm__deregister_mmio fails when the region is not found. */ 5685a8e4f25SAlexandru Elisei r = (success ? 0 : -ENOENT); 5695a8e4f25SAlexandru Elisei break; 5705a8e4f25SAlexandru Elisei } 5715a8e4f25SAlexandru Elisei 5725a8e4f25SAlexandru Elisei return r; 5735a8e4f25SAlexandru Elisei } 5745a8e4f25SAlexandru Elisei 57502eca50cSAsias He int virtio_pci__init(struct kvm *kvm, void *dev, struct virtio_device *vdev, 576507e02d8SAsias He int device_id, int subsys_id, int class) 57736f5dc91SSasha Levin { 57802eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 579e539f3e4SAlexandru Elisei u32 mmio_addr, msix_io_block; 580e539f3e4SAlexandru Elisei u16 port_addr; 5817af40b91SSasha Levin int r; 58236f5dc91SSasha Levin 583a463650cSWill Deacon vpci->kvm = kvm; 58436f5dc91SSasha Levin vpci->dev = dev; 58536f5dc91SSasha Levin 586ce2fc8f5SAlexandru Elisei BUILD_BUG_ON(!is_power_of_two(PCI_IO_SIZE)); 587ce2fc8f5SAlexandru Elisei 588e539f3e4SAlexandru Elisei port_addr = pci_get_io_port_block(PCI_IO_SIZE); 589e539f3e4SAlexandru Elisei mmio_addr = pci_get_mmio_block(PCI_IO_SIZE); 5902e7380dbSMarc Zyngier msix_io_block = pci_get_mmio_block(VIRTIO_MSIX_BAR_SIZE); 591a463650cSWill Deacon 59236f5dc91SSasha Levin vpci->pci_hdr = (struct pci_device_header) { 593aa73be70SMatt Evans .vendor_id = cpu_to_le16(PCI_VENDOR_ID_REDHAT_QUMRANET), 594aa73be70SMatt Evans .device_id = cpu_to_le16(device_id), 595ec7dd52fSSasha Levin .command = PCI_COMMAND_IO | PCI_COMMAND_MEMORY, 59636f5dc91SSasha Levin .header_type = PCI_HEADER_TYPE_NORMAL, 59736f5dc91SSasha Levin .revision_id = 0, 598aa73be70SMatt Evans .class[0] = class & 0xff, 599aa73be70SMatt Evans .class[1] = (class >> 8) & 0xff, 600aa73be70SMatt Evans .class[2] = (class >> 16) & 0xff, 601aa73be70SMatt Evans .subsys_vendor_id = cpu_to_le16(PCI_SUBSYSTEM_VENDOR_ID_REDHAT_QUMRANET), 602aa73be70SMatt Evans .subsys_id = cpu_to_le16(subsys_id), 603e539f3e4SAlexandru Elisei .bar[0] = cpu_to_le32(port_addr 6049c26dab4SSasha Levin | PCI_BASE_ADDRESS_SPACE_IO), 605e539f3e4SAlexandru Elisei .bar[1] = cpu_to_le32(mmio_addr 606a508ea95SJean-Philippe Brucker | PCI_BASE_ADDRESS_SPACE_MEMORY), 607e539f3e4SAlexandru Elisei .bar[2] = cpu_to_le32(msix_io_block 608b4dab816SSasha Levin | PCI_BASE_ADDRESS_SPACE_MEMORY), 609aa73be70SMatt Evans .status = cpu_to_le16(PCI_STATUS_CAP_LIST), 61036f5dc91SSasha Levin .capabilities = (void *)&vpci->pci_hdr.msix - (void *)&vpci->pci_hdr, 61148843d10SJulien Thierry .bar_size[0] = cpu_to_le32(PCI_IO_SIZE), 61248843d10SJulien Thierry .bar_size[1] = cpu_to_le32(PCI_IO_SIZE), 6132e7380dbSMarc Zyngier .bar_size[2] = cpu_to_le32(VIRTIO_MSIX_BAR_SIZE), 61436f5dc91SSasha Levin }; 61536f5dc91SSasha Levin 6165a8e4f25SAlexandru Elisei r = pci__register_bar_regions(kvm, &vpci->pci_hdr, 6175a8e4f25SAlexandru Elisei virtio_pci__bar_activate, 6185a8e4f25SAlexandru Elisei virtio_pci__bar_deactivate, vdev); 6195a8e4f25SAlexandru Elisei if (r < 0) 6205a8e4f25SAlexandru Elisei return r; 6215a8e4f25SAlexandru Elisei 62221ff329dSWill Deacon vpci->dev_hdr = (struct device_header) { 62321ff329dSWill Deacon .bus_type = DEVICE_BUS_PCI, 62421ff329dSWill Deacon .data = &vpci->pci_hdr, 62521ff329dSWill Deacon }; 62621ff329dSWill Deacon 62736f5dc91SSasha Levin vpci->pci_hdr.msix.cap = PCI_CAP_ID_MSIX; 62836f5dc91SSasha Levin vpci->pci_hdr.msix.next = 0; 62914bba8a0SAsias He /* 6302e7380dbSMarc Zyngier * We at most have VIRTIO_NR_MSIX entries (VIRTIO_PCI_MAX_VQ 6312e7380dbSMarc Zyngier * entries for virt queue, VIRTIO_PCI_MAX_CONFIG entries for 6322e7380dbSMarc Zyngier * config). 63314bba8a0SAsias He * 63414bba8a0SAsias He * To quote the PCI spec: 63514bba8a0SAsias He * 63614bba8a0SAsias He * System software reads this field to determine the 63714bba8a0SAsias He * MSI-X Table Size N, which is encoded as N-1. 63814bba8a0SAsias He * For example, a returned value of "00000000011" 63914bba8a0SAsias He * indicates a table size of 4. 64014bba8a0SAsias He */ 6412e7380dbSMarc Zyngier vpci->pci_hdr.msix.ctrl = cpu_to_le16(VIRTIO_NR_MSIX - 1); 64206f48103SSasha Levin 643a463650cSWill Deacon /* Both table and PBA are mapped to the same BAR (2) */ 644a463650cSWill Deacon vpci->pci_hdr.msix.table_offset = cpu_to_le32(2); 6452e7380dbSMarc Zyngier vpci->pci_hdr.msix.pba_offset = cpu_to_le32(2 | VIRTIO_MSIX_TABLE_SIZE); 64636f5dc91SSasha Levin vpci->config_vector = 0; 64736f5dc91SSasha Levin 648f6108d72SJean-Philippe Brucker if (irq__can_signal_msi(kvm)) 64943c81c74SSasha Levin vpci->features |= VIRTIO_PCI_F_SIGNAL_MSI; 65043c81c74SSasha Levin 651c0c45eedSAndre Przywara vpci->legacy_irq_line = pci__assign_irq(&vpci->pci_hdr); 652c0c45eedSAndre Przywara 65321ff329dSWill Deacon r = device__register(&vpci->dev_hdr); 654495fbd4eSSasha Levin if (r < 0) 6555a8e4f25SAlexandru Elisei return r; 656495fbd4eSSasha Levin 657495fbd4eSSasha Levin return 0; 658495fbd4eSSasha Levin } 659495fbd4eSSasha Levin 660eb34a8c2SJean-Philippe Brucker int virtio_pci__reset(struct kvm *kvm, struct virtio_device *vdev) 661eb34a8c2SJean-Philippe Brucker { 66231e0eaccSMartin Radev unsigned int vq; 663eb34a8c2SJean-Philippe Brucker struct virtio_pci *vpci = vdev->virtio; 664eb34a8c2SJean-Philippe Brucker 665eb34a8c2SJean-Philippe Brucker for (vq = 0; vq < vdev->ops->get_vq_count(kvm, vpci->dev); vq++) 666eb34a8c2SJean-Philippe Brucker virtio_pci_exit_vq(kvm, vdev, vq); 667eb34a8c2SJean-Philippe Brucker 668eb34a8c2SJean-Philippe Brucker return 0; 669eb34a8c2SJean-Philippe Brucker } 670eb34a8c2SJean-Philippe Brucker 67102eca50cSAsias He int virtio_pci__exit(struct kvm *kvm, struct virtio_device *vdev) 672495fbd4eSSasha Levin { 67302eca50cSAsias He struct virtio_pci *vpci = vdev->virtio; 674495fbd4eSSasha Levin 675eb34a8c2SJean-Philippe Brucker virtio_pci__reset(kvm, vdev); 676e539f3e4SAlexandru Elisei kvm__deregister_mmio(kvm, virtio_pci__mmio_addr(vpci)); 677e539f3e4SAlexandru Elisei kvm__deregister_mmio(kvm, virtio_pci__msix_io_addr(vpci)); 678205eaa79SAndre Przywara kvm__deregister_pio(kvm, virtio_pci__port_addr(vpci)); 679495fbd4eSSasha Levin 68036f5dc91SSasha Levin return 0; 68136f5dc91SSasha Levin } 682