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 */
vp_get_features(struct virtio_device * vdev)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 */
vp_finalize_features(struct virtio_device * vdev)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 */
vp_get(struct virtio_device * vdev,unsigned int offset,void * buf,unsigned int len)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 */
vp_set(struct virtio_device * vdev,unsigned int offset,const void * buf,unsigned int len)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 */
vp_get_status(struct virtio_device * vdev)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
vp_set_status(struct virtio_device * vdev,u8 status)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
vp_reset(struct virtio_device * vdev)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
vp_config_vector(struct virtio_pci_device * vp_dev,u16 vector)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
setup_vq(struct virtio_pci_device * vp_dev,struct virtio_pci_vq_info * info,unsigned int index,void (* callback)(struct virtqueue * vq),const char * name,bool ctx,u16 msix_vec)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 */
13113aa8c6cSMichael 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
del_vq(struct virtio_pci_vq_info * info)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 */
virtio_pci_legacy_probe(struct virtio_pci_device * vp_dev)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;
226*13f3efacSFeng Liu vp_dev->is_legacy = true;
22738eb4a29SMichael S. Tsirkin
22838eb4a29SMichael S. Tsirkin return 0;
22938eb4a29SMichael S. Tsirkin }
23038eb4a29SMichael S. Tsirkin
virtio_pci_legacy_remove(struct virtio_pci_device * vp_dev)231ff31d2e2SMichael S. Tsirkin void virtio_pci_legacy_remove(struct virtio_pci_device *vp_dev)
23238eb4a29SMichael S. Tsirkin {
233d89c8169SWu Zongyong struct virtio_pci_legacy_device *ldev = &vp_dev->ldev;
23438eb4a29SMichael S. Tsirkin
235d89c8169SWu Zongyong vp_legacy_remove(ldev);
23638eb4a29SMichael S. Tsirkin }
237