1 // SPDX-License-Identifier: GPL-2.0-only 2 #include "kselftest.h" 3 #include <libvfio.h> 4 5 #ifdef __x86_64__ 6 extern struct vfio_pci_driver_ops dsa_ops; 7 extern struct vfio_pci_driver_ops ioat_ops; 8 #endif 9 10 extern struct vfio_pci_driver_ops nv_falcon_ops; 11 12 static struct vfio_pci_driver_ops *driver_ops[] = { 13 #ifdef __x86_64__ 14 &dsa_ops, 15 &ioat_ops, 16 #endif 17 &nv_falcon_ops, 18 }; 19 20 void vfio_pci_driver_probe(struct vfio_pci_device *device) 21 { 22 struct vfio_pci_driver_ops *ops; 23 int i; 24 25 VFIO_ASSERT_NULL(device->driver.ops); 26 27 for (i = 0; i < ARRAY_SIZE(driver_ops); i++) { 28 ops = driver_ops[i]; 29 30 if (ops->probe(device)) 31 continue; 32 33 device->driver.ops = ops; 34 } 35 } 36 37 static void vfio_check_driver_op(struct vfio_pci_driver *driver, void *op, 38 const char *op_name) 39 { 40 VFIO_ASSERT_NOT_NULL(driver->ops); 41 VFIO_ASSERT_NOT_NULL(op, "Driver has no %s()\n", op_name); 42 VFIO_ASSERT_EQ(driver->initialized, op != driver->ops->init); 43 VFIO_ASSERT_EQ(driver->memcpy_in_progress, op == driver->ops->memcpy_wait); 44 } 45 46 #define VFIO_CHECK_DRIVER_OP(_driver, _op) do { \ 47 struct vfio_pci_driver *__driver = (_driver); \ 48 vfio_check_driver_op(__driver, __driver->ops->_op, #_op); \ 49 } while (0) 50 51 void vfio_pci_driver_init(struct vfio_pci_device *device) 52 { 53 struct vfio_pci_driver *driver = &device->driver; 54 55 VFIO_ASSERT_NOT_NULL(driver->region.vaddr); 56 VFIO_CHECK_DRIVER_OP(driver, init); 57 58 driver->ops->init(device); 59 60 driver->initialized = true; 61 } 62 63 void vfio_pci_driver_remove(struct vfio_pci_device *device) 64 { 65 struct vfio_pci_driver *driver = &device->driver; 66 67 VFIO_CHECK_DRIVER_OP(driver, remove); 68 69 driver->ops->remove(device); 70 driver->initialized = false; 71 } 72 73 void vfio_pci_driver_send_msi(struct vfio_pci_device *device) 74 { 75 struct vfio_pci_driver *driver = &device->driver; 76 77 VFIO_CHECK_DRIVER_OP(driver, send_msi); 78 79 driver->ops->send_msi(device); 80 } 81 82 void vfio_pci_driver_memcpy_start(struct vfio_pci_device *device, 83 iova_t src, iova_t dst, u64 size, 84 u64 count) 85 { 86 struct vfio_pci_driver *driver = &device->driver; 87 88 VFIO_ASSERT_LE(size, driver->max_memcpy_size); 89 VFIO_ASSERT_LE(count, driver->max_memcpy_count); 90 VFIO_CHECK_DRIVER_OP(driver, memcpy_start); 91 92 driver->ops->memcpy_start(device, src, dst, size, count); 93 driver->memcpy_in_progress = true; 94 } 95 96 int vfio_pci_driver_memcpy_wait(struct vfio_pci_device *device) 97 { 98 struct vfio_pci_driver *driver = &device->driver; 99 int r; 100 101 VFIO_CHECK_DRIVER_OP(driver, memcpy_wait); 102 103 r = driver->ops->memcpy_wait(device); 104 driver->memcpy_in_progress = false; 105 106 return r; 107 } 108 109 int vfio_pci_driver_memcpy(struct vfio_pci_device *device, 110 iova_t src, iova_t dst, u64 size) 111 { 112 struct vfio_pci_driver *driver = &device->driver; 113 u64 offset = 0; 114 115 while (offset < size) { 116 u64 chunk = min(size - offset, driver->max_memcpy_size); 117 int ret; 118 119 vfio_pci_driver_memcpy_start(device, src + offset, 120 dst + offset, chunk, 1); 121 ret = vfio_pci_driver_memcpy_wait(device); 122 if (ret) 123 return ret; 124 125 offset += chunk; 126 } 127 128 return 0; 129 } 130