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 17d89c8169SWu 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. */ 27d89c8169SWu 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. */ 42d89c8169SWu 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 */ 4831532340SSolomon Tan static void vp_get(struct virtio_device *vdev, unsigned int offset, 4931532340SSolomon Tan void *buf, unsigned int len) 5038eb4a29SMichael S. Tsirkin { 5138eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 52d89c8169SWu 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 */ 6431532340SSolomon Tan static void vp_set(struct virtio_device *vdev, unsigned int offset, 6531532340SSolomon Tan const void *buf, unsigned int len) 6638eb4a29SMichael S. Tsirkin { 6738eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vdev); 68d89c8169SWu 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); 82d89c8169SWu 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); 90d89c8169SWu 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. */ 97d89c8169SWu 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. */ 100d89c8169SWu Zongyong vp_legacy_get_status(&vp_dev->ldev); 101eb4cecb4SJason Wang /* Flush pending VQ/configuration callbacks. */ 102eb4cecb4SJason Wang 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 { 107d89c8169SWu 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, 11231532340SSolomon Tan unsigned int 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. */ 124d89c8169SWu Zongyong num = vp_legacy_get_queue_size(&vp_dev->ldev, index); 125d89c8169SWu 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 */ 131*13aa8c6cSMichael S. Tsirkin 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 138da802961SXuan Zhuo vq->num_max = num; 139da802961SXuan Zhuo 14069599206SSuzuki K Poulose q_pfn = virtqueue_get_desc_addr(vq) >> VIRTIO_PCI_QUEUE_ADDR_SHIFT; 14169599206SSuzuki K Poulose if (q_pfn >> 32) { 14269599206SSuzuki K Poulose dev_err(&vp_dev->pci_dev->dev, 1436017599bS王贇 "platform bug: legacy virtio-pci must not be used with RAM above 0x%llxGB\n", 14469599206SSuzuki K Poulose 0x1ULL << (32 + PAGE_SHIFT - 30)); 14569599206SSuzuki K Poulose err = -E2BIG; 14669599206SSuzuki K Poulose goto out_del_vq; 14769599206SSuzuki K Poulose } 14869599206SSuzuki K Poulose 14938eb4a29SMichael S. Tsirkin /* activate the queue */ 150d89c8169SWu Zongyong vp_legacy_set_queue_address(&vp_dev->ldev, index, q_pfn); 15138eb4a29SMichael S. Tsirkin 152d89c8169SWu Zongyong vq->priv = (void __force *)vp_dev->ldev.ioaddr + VIRTIO_PCI_QUEUE_NOTIFY; 15338eb4a29SMichael S. Tsirkin 15438eb4a29SMichael S. Tsirkin if (msix_vec != VIRTIO_MSI_NO_VECTOR) { 155d89c8169SWu Zongyong msix_vec = vp_legacy_queue_vector(&vp_dev->ldev, index, msix_vec); 15638eb4a29SMichael S. Tsirkin if (msix_vec == VIRTIO_MSI_NO_VECTOR) { 15738eb4a29SMichael S. Tsirkin err = -EBUSY; 1587a5589b2SAndy Lutomirski goto out_deactivate; 15938eb4a29SMichael S. Tsirkin } 16038eb4a29SMichael S. Tsirkin } 16138eb4a29SMichael S. Tsirkin 16238eb4a29SMichael S. Tsirkin return vq; 16338eb4a29SMichael S. Tsirkin 1647a5589b2SAndy Lutomirski out_deactivate: 165d89c8169SWu Zongyong vp_legacy_set_queue_address(&vp_dev->ldev, index, 0); 16669599206SSuzuki K Poulose out_del_vq: 1677a5589b2SAndy Lutomirski vring_del_virtqueue(vq); 16838eb4a29SMichael S. Tsirkin return ERR_PTR(err); 16938eb4a29SMichael S. Tsirkin } 17038eb4a29SMichael S. Tsirkin 1710a9b3f47SMichael S. Tsirkin static void del_vq(struct virtio_pci_vq_info *info) 17238eb4a29SMichael S. Tsirkin { 1730a9b3f47SMichael S. Tsirkin struct virtqueue *vq = info->vq; 17438eb4a29SMichael S. Tsirkin struct virtio_pci_device *vp_dev = to_vp_device(vq->vdev); 17538eb4a29SMichael S. Tsirkin 1762008c154SMichael S. Tsirkin if (vp_dev->msix_enabled) { 177d89c8169SWu Zongyong vp_legacy_queue_vector(&vp_dev->ldev, vq->index, 178d89c8169SWu Zongyong VIRTIO_MSI_NO_VECTOR); 17938eb4a29SMichael S. Tsirkin /* Flush the write out to device */ 180d89c8169SWu Zongyong ioread8(vp_dev->ldev.ioaddr + VIRTIO_PCI_ISR); 18138eb4a29SMichael S. Tsirkin } 18238eb4a29SMichael S. Tsirkin 18338eb4a29SMichael S. Tsirkin /* Select and deactivate the queue */ 184d89c8169SWu Zongyong vp_legacy_set_queue_address(&vp_dev->ldev, vq->index, 0); 18538eb4a29SMichael S. Tsirkin 1867a5589b2SAndy Lutomirski vring_del_virtqueue(vq); 18738eb4a29SMichael S. Tsirkin } 18838eb4a29SMichael S. Tsirkin 18938eb4a29SMichael S. Tsirkin static const struct virtio_config_ops virtio_pci_config_ops = { 19038eb4a29SMichael S. Tsirkin .get = vp_get, 19138eb4a29SMichael S. Tsirkin .set = vp_set, 19238eb4a29SMichael S. Tsirkin .get_status = vp_get_status, 19338eb4a29SMichael S. Tsirkin .set_status = vp_set_status, 19438eb4a29SMichael S. Tsirkin .reset = vp_reset, 19538eb4a29SMichael S. Tsirkin .find_vqs = vp_find_vqs, 19638eb4a29SMichael S. Tsirkin .del_vqs = vp_del_vqs, 19748b3dd24SJason Wang .synchronize_cbs = vp_synchronize_vectors, 19838eb4a29SMichael S. Tsirkin .get_features = vp_get_features, 19938eb4a29SMichael S. Tsirkin .finalize_features = vp_finalize_features, 20038eb4a29SMichael S. Tsirkin .bus_name = vp_bus_name, 20138eb4a29SMichael S. Tsirkin .set_vq_affinity = vp_set_vq_affinity, 202bbaba479SChristoph Hellwig .get_vq_affinity = vp_get_vq_affinity, 20338eb4a29SMichael S. Tsirkin }; 20438eb4a29SMichael S. Tsirkin 20538eb4a29SMichael S. Tsirkin /* the PCI probing function */ 206ff31d2e2SMichael S. Tsirkin int virtio_pci_legacy_probe(struct virtio_pci_device *vp_dev) 20738eb4a29SMichael S. Tsirkin { 208d89c8169SWu Zongyong struct virtio_pci_legacy_device *ldev = &vp_dev->ldev; 209ff31d2e2SMichael S. Tsirkin struct pci_dev *pci_dev = vp_dev->pci_dev; 21059a5b0f7SGerd Hoffmann int rc; 21138eb4a29SMichael S. Tsirkin 212d89c8169SWu Zongyong ldev->pci_dev = pci_dev; 21338eb4a29SMichael S. Tsirkin 214d89c8169SWu Zongyong rc = vp_legacy_probe(ldev); 21559a5b0f7SGerd Hoffmann if (rc) 21659a5b0f7SGerd Hoffmann return rc; 21759a5b0f7SGerd Hoffmann 218d89c8169SWu Zongyong vp_dev->isr = ldev->isr; 219d89c8169SWu Zongyong vp_dev->vdev.id = ldev->id; 22038eb4a29SMichael S. Tsirkin 221ff31d2e2SMichael S. Tsirkin vp_dev->vdev.config = &virtio_pci_config_ops; 222ff31d2e2SMichael S. Tsirkin 22338eb4a29SMichael S. Tsirkin vp_dev->config_vector = vp_config_vector; 22438eb4a29SMichael S. Tsirkin vp_dev->setup_vq = setup_vq; 22538eb4a29SMichael S. Tsirkin vp_dev->del_vq = del_vq; 22638eb4a29SMichael S. Tsirkin 22738eb4a29SMichael S. Tsirkin return 0; 22838eb4a29SMichael S. Tsirkin } 22938eb4a29SMichael S. Tsirkin 230ff31d2e2SMichael S. Tsirkin void virtio_pci_legacy_remove(struct virtio_pci_device *vp_dev) 23138eb4a29SMichael S. Tsirkin { 232d89c8169SWu Zongyong struct virtio_pci_legacy_device *ldev = &vp_dev->ldev; 23338eb4a29SMichael S. Tsirkin 234d89c8169SWu Zongyong vp_legacy_remove(ldev); 23538eb4a29SMichael S. Tsirkin } 236