1 /* 2 * virtio-gpio nodes for testing 3 * 4 * Copyright (c) 2022 Linaro Ltd 5 * 6 * SPDX-License-Identifier: GPL-2.0-or-later 7 */ 8 9 #include "qemu/osdep.h" 10 #include "standard-headers/linux/virtio_config.h" 11 #include "../libqtest.h" 12 #include "qemu/module.h" 13 #include "qgraph.h" 14 #include "virtio-gpio.h" 15 16 static QGuestAllocator *alloc; 17 18 static void virtio_gpio_cleanup(QVhostUserGPIO *gpio) 19 { 20 QVirtioDevice *vdev = gpio->vdev; 21 int i; 22 23 for (i = 0; i < 2; i++) { 24 qvirtqueue_cleanup(vdev->bus, gpio->queues[i], alloc); 25 } 26 g_free(gpio->queues); 27 } 28 29 /* 30 * This handles the VirtIO setup from the point of view of the driver 31 * frontend and therefor doesn't present any vhost specific features 32 * and in fact masks of the re-used bit. 33 */ 34 static void virtio_gpio_setup(QVhostUserGPIO *gpio) 35 { 36 QVirtioDevice *vdev = gpio->vdev; 37 uint64_t features; 38 int i; 39 40 features = qvirtio_get_features(vdev); 41 features &= ~QVIRTIO_F_BAD_FEATURE; 42 qvirtio_set_features(vdev, features); 43 44 gpio->queues = g_new(QVirtQueue *, 2); 45 for (i = 0; i < 2; i++) { 46 gpio->queues[i] = qvirtqueue_setup(vdev, alloc, i); 47 } 48 qvirtio_set_driver_ok(vdev); 49 } 50 51 static void *qvirtio_gpio_get_driver(QVhostUserGPIO *v_gpio, 52 const char *interface) 53 { 54 if (!g_strcmp0(interface, "vhost-user-gpio")) { 55 return v_gpio; 56 } 57 if (!g_strcmp0(interface, "virtio")) { 58 return v_gpio->vdev; 59 } 60 61 g_assert_not_reached(); 62 } 63 64 static void *qvirtio_gpio_device_get_driver(void *object, 65 const char *interface) 66 { 67 QVhostUserGPIODevice *v_gpio = object; 68 return qvirtio_gpio_get_driver(&v_gpio->gpio, interface); 69 } 70 71 /* virtio-gpio (mmio) */ 72 static void qvirtio_gpio_device_destructor(QOSGraphObject *obj) 73 { 74 QVhostUserGPIODevice *gpio_dev = (QVhostUserGPIODevice *) obj; 75 virtio_gpio_cleanup(&gpio_dev->gpio); 76 } 77 78 static void qvirtio_gpio_device_start_hw(QOSGraphObject *obj) 79 { 80 QVhostUserGPIODevice *gpio_dev = (QVhostUserGPIODevice *) obj; 81 virtio_gpio_setup(&gpio_dev->gpio); 82 } 83 84 static void *virtio_gpio_device_create(void *virtio_dev, 85 QGuestAllocator *t_alloc, 86 void *addr) 87 { 88 QVhostUserGPIODevice *virtio_device = g_new0(QVhostUserGPIODevice, 1); 89 QVhostUserGPIO *interface = &virtio_device->gpio; 90 91 interface->vdev = virtio_dev; 92 alloc = t_alloc; 93 94 virtio_device->obj.get_driver = qvirtio_gpio_device_get_driver; 95 virtio_device->obj.start_hw = qvirtio_gpio_device_start_hw; 96 virtio_device->obj.destructor = qvirtio_gpio_device_destructor; 97 98 return &virtio_device->obj; 99 } 100 101 /* virtio-gpio-pci */ 102 static void qvirtio_gpio_pci_destructor(QOSGraphObject *obj) 103 { 104 QVhostUserGPIOPCI *gpio_pci = (QVhostUserGPIOPCI *) obj; 105 QOSGraphObject *pci_vobj = &gpio_pci->pci_vdev.obj; 106 107 virtio_gpio_cleanup(&gpio_pci->gpio); 108 qvirtio_pci_destructor(pci_vobj); 109 } 110 111 static void qvirtio_gpio_pci_start_hw(QOSGraphObject *obj) 112 { 113 QVhostUserGPIOPCI *gpio_pci = (QVhostUserGPIOPCI *) obj; 114 QOSGraphObject *pci_vobj = &gpio_pci->pci_vdev.obj; 115 116 qvirtio_pci_start_hw(pci_vobj); 117 virtio_gpio_setup(&gpio_pci->gpio); 118 } 119 120 static void *qvirtio_gpio_pci_get_driver(void *object, const char *interface) 121 { 122 QVhostUserGPIOPCI *v_gpio = object; 123 124 if (!g_strcmp0(interface, "pci-device")) { 125 return v_gpio->pci_vdev.pdev; 126 } 127 return qvirtio_gpio_get_driver(&v_gpio->gpio, interface); 128 } 129 130 static void *virtio_gpio_pci_create(void *pci_bus, QGuestAllocator *t_alloc, 131 void *addr) 132 { 133 QVhostUserGPIOPCI *virtio_spci = g_new0(QVhostUserGPIOPCI, 1); 134 QVhostUserGPIO *interface = &virtio_spci->gpio; 135 QOSGraphObject *obj = &virtio_spci->pci_vdev.obj; 136 137 virtio_pci_init(&virtio_spci->pci_vdev, pci_bus, addr); 138 interface->vdev = &virtio_spci->pci_vdev.vdev; 139 alloc = t_alloc; 140 141 obj->get_driver = qvirtio_gpio_pci_get_driver; 142 obj->start_hw = qvirtio_gpio_pci_start_hw; 143 obj->destructor = qvirtio_gpio_pci_destructor; 144 145 return obj; 146 } 147 148 static void virtio_gpio_register_nodes(void) 149 { 150 QPCIAddress addr = { 151 .devfn = QPCI_DEVFN(4, 0), 152 }; 153 154 QOSGraphEdgeOptions edge_opts = { }; 155 156 /* vhost-user-gpio-device */ 157 edge_opts.extra_device_opts = "id=gpio0,chardev=chr-vhost-user-test"; 158 qos_node_create_driver("vhost-user-gpio-device", 159 virtio_gpio_device_create); 160 qos_node_consumes("vhost-user-gpio-device", "virtio-bus", &edge_opts); 161 qos_node_produces("vhost-user-gpio-device", "vhost-user-gpio"); 162 163 /* virtio-gpio-pci */ 164 edge_opts.extra_device_opts = "id=gpio0,addr=04.0,chardev=chr-vhost-user-test"; 165 add_qpci_address(&edge_opts, &addr); 166 qos_node_create_driver("vhost-user-gpio-pci", virtio_gpio_pci_create); 167 qos_node_consumes("vhost-user-gpio-pci", "pci-bus", &edge_opts); 168 qos_node_produces("vhost-user-gpio-pci", "vhost-user-gpio"); 169 } 170 171 libqos_init(virtio_gpio_register_nodes); 172