1f33f5fe2SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 238eb4a29SMichael S. Tsirkin /* 3a90fdce9SMichael S. Tsirkin * Virtio PCI driver - legacy device support 438eb4a29SMichael S. Tsirkin * 538eb4a29SMichael S. Tsirkin * This module allows virtio devices to be used over a virtual PCI device. 638eb4a29SMichael S. Tsirkin * This can be used with QEMU based VMMs like KVM or Xen. 738eb4a29SMichael S. Tsirkin * 838eb4a29SMichael S. Tsirkin * Copyright IBM Corp. 2007 9a90fdce9SMichael S. Tsirkin * Copyright Red Hat, Inc. 2014 1038eb4a29SMichael S. Tsirkin * 1138eb4a29SMichael S. Tsirkin * Authors: 1238eb4a29SMichael S. Tsirkin * Anthony Liguori <aliguori@us.ibm.com> 13a90fdce9SMichael S. Tsirkin * Rusty Russell <rusty@rustcorp.com.au> 14a90fdce9SMichael S. Tsirkin * Michael S. Tsirkin <mst@redhat.com> 1538eb4a29SMichael S. Tsirkin */ 1638eb4a29SMichael S. Tsirkin 17*d89c8169SWu Zongyong #include "linux/virtio_pci_legacy.h" 185f4c9760SMichael S. Tsirkin #include "virtio_pci_common.h" 1938eb4a29SMichael S. Tsirkin 2038eb4a29SMichael S. Tsirkin /* virtio config->get_features() implementation */ 2138eb4a29SMichael S. Tsirkin static u64 vp_get_features(struct virtio_device *vdev) 2238eb4a29SMichael S. Tsirkin { 2338eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 2438eb4a29SMichael S. Tsirkin 2538eb4a29SMichael S. Tsirkin /* When someone needs more than 32 feature bits, we'll need to 2638eb4a29SMichael S. Tsirkin * steal a bit to indicate that the rest are somewhere else. */ 27*d89c8169SWu Zongyong return vp_legacy_get_features(&vp_dev->ldev); 2838eb4a29SMichael S. Tsirkin } 2938eb4a29SMichael S. Tsirkin 3038eb4a29SMichael S. Tsirkin /* virtio config->finalize_features() implementation */ 3138eb4a29SMichael S. Tsirkin static int vp_finalize_features(struct virtio_device *vdev) 3238eb4a29SMichael S. Tsirkin { 3338eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 3438eb4a29SMichael S. Tsirkin 3538eb4a29SMichael S. Tsirkin /* Give virtio_ring a chance to accept features. */ 3638eb4a29SMichael S. Tsirkin vring_transport_features(vdev); 3738eb4a29SMichael S. Tsirkin 3838eb4a29SMichael S. Tsirkin /* Make sure we don't have any features > 32 bits! */ 3938eb4a29SMichael S. Tsirkin BUG_ON((u32)vdev->features != vdev->features); 4038eb4a29SMichael S. Tsirkin 4138eb4a29SMichael S. Tsirkin /* We only support 32 feature bits. */ 42*d89c8169SWu Zongyong vp_legacy_set_features(&vp_dev->ldev, vdev->features); 4338eb4a29SMichael S. Tsirkin 4438eb4a29SMichael S. Tsirkin return 0; 4538eb4a29SMichael S. Tsirkin } 4638eb4a29SMichael S. Tsirkin 4738eb4a29SMichael S. Tsirkin /* virtio config->get() implementation */ 4838eb4a29SMichael S. Tsirkin static void vp_get(struct virtio_device *vdev, unsigned offset, 4938eb4a29SMichael S. Tsirkin void *buf, unsigned len) 5038eb4a29SMichael S. Tsirkin { 5138eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 52*d89c8169SWu Zongyong void __iomem *ioaddr = vp_dev->ldev.ioaddr + 53e8d26f29SDongli Zhang VIRTIO_PCI_CONFIG_OFF(vp_dev->msix_enabled) + 54e8d26f29SDongli Zhang offset; 5538eb4a29SMichael S. Tsirkin u8 *ptr = buf; 5638eb4a29SMichael S. Tsirkin int i; 5738eb4a29SMichael S. Tsirkin 5838eb4a29SMichael S. Tsirkin for (i = 0; i < len; i++) 5938eb4a29SMichael S. Tsirkin ptr[i] = ioread8(ioaddr + i); 6038eb4a29SMichael S. Tsirkin } 6138eb4a29SMichael S. Tsirkin 6238eb4a29SMichael S. Tsirkin /* the config->set() implementation. it's symmetric to the config->get() 6338eb4a29SMichael S. Tsirkin * implementation */ 6438eb4a29SMichael S. Tsirkin static void vp_set(struct virtio_device *vdev, unsigned offset, 6538eb4a29SMichael S. Tsirkin const void *buf, unsigned len) 6638eb4a29SMichael S. Tsirkin { 6738eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 68*d89c8169SWu Zongyong void __iomem *ioaddr = vp_dev->ldev.ioaddr + 69e8d26f29SDongli Zhang VIRTIO_PCI_CONFIG_OFF(vp_dev->msix_enabled) + 70e8d26f29SDongli Zhang offset; 7138eb4a29SMichael S. Tsirkin const u8 *ptr = buf; 7238eb4a29SMichael S. Tsirkin int i; 7338eb4a29SMichael S. Tsirkin 7438eb4a29SMichael S. Tsirkin for (i = 0; i < len; i++) 7538eb4a29SMichael S. Tsirkin iowrite8(ptr[i], ioaddr + i); 7638eb4a29SMichael S. Tsirkin } 7738eb4a29SMichael S. Tsirkin 7838eb4a29SMichael S. Tsirkin /* config->{get,set}_status() implementations */ 7938eb4a29SMichael S. Tsirkin static u8 vp_get_status(struct virtio_device *vdev) 8038eb4a29SMichael S. Tsirkin { 8138eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 82*d89c8169SWu Zongyong return vp_legacy_get_status(&vp_dev->ldev); 8338eb4a29SMichael S. Tsirkin } 8438eb4a29SMichael S. Tsirkin 8538eb4a29SMichael S. Tsirkin static void vp_set_status(struct virtio_device *vdev, u8 status) 8638eb4a29SMichael S. Tsirkin { 8738eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 8838eb4a29SMichael S. Tsirkin /* We should never be setting status to 0. */ 8938eb4a29SMichael S. Tsirkin BUG_ON(status == 0); 90*d89c8169SWu Zongyong vp_legacy_set_status(&vp_dev->ldev, status); 9138eb4a29SMichael S. Tsirkin } 9238eb4a29SMichael S. Tsirkin 9338eb4a29SMichael S. Tsirkin static void vp_reset(struct virtio_device *vdev) 9438eb4a29SMichael S. Tsirkin { 9538eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 9638eb4a29SMichael S. Tsirkin /* 0 status means a reset. */ 97*d89c8169SWu Zongyong vp_legacy_set_status(&vp_dev->ldev, 0); 9838eb4a29SMichael S. Tsirkin /* Flush out the status write, and flush in device writes, 9938eb4a29SMichael S. Tsirkin * including MSi-X interrupts, if any. */ 100*d89c8169SWu Zongyong vp_legacy_get_status(&vp_dev->ldev); 10138eb4a29SMichael S. Tsirkin /* Flush pending VQ/configuration callbacks. */ 10238eb4a29SMichael S. Tsirkin vp_synchronize_vectors(vdev); 10338eb4a29SMichael S. Tsirkin } 10438eb4a29SMichael S. Tsirkin 10538eb4a29SMichael S. Tsirkin static u16 vp_config_vector(struct virtio_pci_device *vp_dev, u16 vector) 10638eb4a29SMichael S. Tsirkin { 107*d89c8169SWu Zongyong return vp_legacy_config_vector(&vp_dev->ldev, vector); 10838eb4a29SMichael S. Tsirkin } 10938eb4a29SMichael S. Tsirkin 11038eb4a29SMichael S. Tsirkin static struct virtqueue *setup_vq(struct virtio_pci_device *vp_dev, 1110a9b3f47SMichael S. Tsirkin struct virtio_pci_vq_info *info, 11238eb4a29SMichael S. Tsirkin unsigned index, 11338eb4a29SMichael S. Tsirkin void (*callback)(struct virtqueue *vq), 11438eb4a29SMichael S. Tsirkin const char *name, 115f94682ddSMichael S. Tsirkin bool ctx, 11638eb4a29SMichael S. Tsirkin u16 msix_vec) 11738eb4a29SMichael S. Tsirkin { 11838eb4a29SMichael S. Tsirkin struct virtqueue *vq; 11938eb4a29SMichael S. Tsirkin u16 num; 12038eb4a29SMichael S. Tsirkin int err; 12169599206SSuzuki K Poulose u64 q_pfn; 12238eb4a29SMichael S. Tsirkin 12338eb4a29SMichael S. Tsirkin /* Check if queue is either not available or already active. */ 124*d89c8169SWu Zongyong num = vp_legacy_get_queue_size(&vp_dev->ldev, index); 125*d89c8169SWu Zongyong if (!num || vp_legacy_get_queue_enable(&vp_dev->ldev, index)) 12638eb4a29SMichael S. Tsirkin return ERR_PTR(-ENOENT); 12738eb4a29SMichael S. Tsirkin 1280a9b3f47SMichael S. Tsirkin info->msix_vector = msix_vec; 1290a9b3f47SMichael S. Tsirkin 1307a5589b2SAndy Lutomirski /* create the vring */ 1317a5589b2SAndy Lutomirski vq = vring_create_virtqueue(index, num, 1327a5589b2SAndy Lutomirski VIRTIO_PCI_VRING_ALIGN, &vp_dev->vdev, 133f94682ddSMichael S. Tsirkin true, false, ctx, 134f94682ddSMichael S. Tsirkin vp_notify, callback, name); 1357a5589b2SAndy Lutomirski if (!vq) 13638eb4a29SMichael S. Tsirkin return ERR_PTR(-ENOMEM); 13738eb4a29SMichael S. Tsirkin 13869599206SSuzuki K Poulose q_pfn = virtqueue_get_desc_addr(vq) >> VIRTIO_PCI_QUEUE_ADDR_SHIFT; 13969599206SSuzuki K Poulose if (q_pfn >> 32) { 14069599206SSuzuki K Poulose dev_err(&vp_dev->pci_dev->dev, 14169599206SSuzuki K Poulose "platform bug: legacy virtio-mmio must not be used with RAM above 0x%llxGB\n", 14269599206SSuzuki K Poulose 0x1ULL << (32 + PAGE_SHIFT - 30)); 14369599206SSuzuki K Poulose err = -E2BIG; 14469599206SSuzuki K Poulose goto out_del_vq; 14569599206SSuzuki K Poulose } 14669599206SSuzuki K Poulose 14738eb4a29SMichael S. Tsirkin /* activate the queue */ 148*d89c8169SWu Zongyong vp_legacy_set_queue_address(&vp_dev->ldev, index, q_pfn); 14938eb4a29SMichael S. Tsirkin 150*d89c8169SWu Zongyong vq->priv = (void __force *)vp_dev->ldev.ioaddr + VIRTIO_PCI_QUEUE_NOTIFY; 15138eb4a29SMichael S. Tsirkin 15238eb4a29SMichael S. Tsirkin if (msix_vec != VIRTIO_MSI_NO_VECTOR) { 153*d89c8169SWu Zongyong msix_vec = vp_legacy_queue_vector(&vp_dev->ldev, index, msix_vec); 15438eb4a29SMichael S. Tsirkin if (msix_vec == VIRTIO_MSI_NO_VECTOR) { 15538eb4a29SMichael S. Tsirkin err = -EBUSY; 1567a5589b2SAndy Lutomirski goto out_deactivate; 15738eb4a29SMichael S. Tsirkin } 15838eb4a29SMichael S. Tsirkin } 15938eb4a29SMichael S. Tsirkin 16038eb4a29SMichael S. Tsirkin return vq; 16138eb4a29SMichael S. Tsirkin 1627a5589b2SAndy Lutomirski out_deactivate: 163*d89c8169SWu Zongyong vp_legacy_set_queue_address(&vp_dev->ldev, index, 0); 16469599206SSuzuki K Poulose out_del_vq: 1657a5589b2SAndy Lutomirski vring_del_virtqueue(vq); 16638eb4a29SMichael S. Tsirkin return ERR_PTR(err); 16738eb4a29SMichael S. Tsirkin } 16838eb4a29SMichael S. Tsirkin 1690a9b3f47SMichael S. Tsirkin static void del_vq(struct virtio_pci_vq_info *info) 17038eb4a29SMichael S. Tsirkin { 1710a9b3f47SMichael S. Tsirkin struct virtqueue *vq = info->vq; 17238eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vq->vdev); 17338eb4a29SMichael S. Tsirkin 1742008c154SMichael S. Tsirkin if (vp_dev->msix_enabled) { 175*d89c8169SWu Zongyong vp_legacy_queue_vector(&vp_dev->ldev, vq->index, 176*d89c8169SWu Zongyong VIRTIO_MSI_NO_VECTOR); 17738eb4a29SMichael S. Tsirkin /* Flush the write out to device */ 178*d89c8169SWu Zongyong ioread8(vp_dev->ldev.ioaddr + VIRTIO_PCI_ISR); 17938eb4a29SMichael S. Tsirkin } 18038eb4a29SMichael S. Tsirkin 18138eb4a29SMichael S. Tsirkin /* Select and deactivate the queue */ 182*d89c8169SWu Zongyong vp_legacy_set_queue_address(&vp_dev->ldev, vq->index, 0); 18338eb4a29SMichael S. Tsirkin 1847a5589b2SAndy Lutomirski vring_del_virtqueue(vq); 18538eb4a29SMichael S. Tsirkin } 18638eb4a29SMichael S. Tsirkin 18738eb4a29SMichael S. Tsirkin static const struct virtio_config_ops virtio_pci_config_ops = { 18838eb4a29SMichael S. Tsirkin .get = vp_get, 18938eb4a29SMichael S. Tsirkin .set = vp_set, 19038eb4a29SMichael S. Tsirkin .get_status = vp_get_status, 19138eb4a29SMichael S. Tsirkin .set_status = vp_set_status, 19238eb4a29SMichael S. Tsirkin .reset = vp_reset, 19338eb4a29SMichael S. Tsirkin .find_vqs = vp_find_vqs, 19438eb4a29SMichael S. Tsirkin .del_vqs = vp_del_vqs, 19538eb4a29SMichael S. Tsirkin .get_features = vp_get_features, 19638eb4a29SMichael S. Tsirkin .finalize_features = vp_finalize_features, 19738eb4a29SMichael S. Tsirkin .bus_name = vp_bus_name, 19838eb4a29SMichael S. Tsirkin .set_vq_affinity = vp_set_vq_affinity, 199bbaba479SChristoph Hellwig .get_vq_affinity = vp_get_vq_affinity, 20038eb4a29SMichael S. Tsirkin }; 20138eb4a29SMichael S. Tsirkin 20238eb4a29SMichael S. Tsirkin /* the PCI probing function */ 203ff31d2e2SMichael S. Tsirkin int virtio_pci_legacy_probe(struct virtio_pci_device *vp_dev) 20438eb4a29SMichael S. Tsirkin { 205*d89c8169SWu Zongyong struct virtio_pci_legacy_device *ldev = &vp_dev->ldev; 206ff31d2e2SMichael S. Tsirkin struct pci_dev *pci_dev = vp_dev->pci_dev; 20759a5b0f7SGerd Hoffmann int rc; 20838eb4a29SMichael S. Tsirkin 209*d89c8169SWu Zongyong ldev->pci_dev = pci_dev; 21038eb4a29SMichael S. Tsirkin 211*d89c8169SWu Zongyong rc = vp_legacy_probe(ldev); 21259a5b0f7SGerd Hoffmann if (rc) 21359a5b0f7SGerd Hoffmann return rc; 21459a5b0f7SGerd Hoffmann 215*d89c8169SWu Zongyong vp_dev->isr = ldev->isr; 216*d89c8169SWu Zongyong vp_dev->vdev.id = ldev->id; 21738eb4a29SMichael S. Tsirkin 218ff31d2e2SMichael S. Tsirkin vp_dev->vdev.config = &virtio_pci_config_ops; 219ff31d2e2SMichael S. Tsirkin 22038eb4a29SMichael S. Tsirkin vp_dev->config_vector = vp_config_vector; 22138eb4a29SMichael S. Tsirkin vp_dev->setup_vq = setup_vq; 22238eb4a29SMichael S. Tsirkin vp_dev->del_vq = del_vq; 22338eb4a29SMichael S. Tsirkin 22438eb4a29SMichael S. Tsirkin return 0; 22538eb4a29SMichael S. Tsirkin } 22638eb4a29SMichael S. Tsirkin 227ff31d2e2SMichael S. Tsirkin void virtio_pci_legacy_remove(struct virtio_pci_device *vp_dev) 22838eb4a29SMichael S. Tsirkin { 229*d89c8169SWu Zongyong struct virtio_pci_legacy_device *ldev = &vp_dev->ldev; 23038eb4a29SMichael S. Tsirkin 231*d89c8169SWu Zongyong vp_legacy_remove(ldev); 23238eb4a29SMichael S. Tsirkin } 233