1583349d1SEmanuele Giuseppe Esposito /* 2583349d1SEmanuele Giuseppe Esposito * libqos driver framework 3583349d1SEmanuele Giuseppe Esposito * 4583349d1SEmanuele Giuseppe Esposito * Copyright (c) 2018 Emanuele Giuseppe Esposito <e.emanuelegiuseppe@gmail.com> 5583349d1SEmanuele Giuseppe Esposito * 6583349d1SEmanuele Giuseppe Esposito * This library is free software; you can redistribute it and/or 7583349d1SEmanuele Giuseppe Esposito * modify it under the terms of the GNU Lesser General Public 8dc0ad02dSThomas Huth * License version 2.1 as published by the Free Software Foundation. 9583349d1SEmanuele Giuseppe Esposito * 10583349d1SEmanuele Giuseppe Esposito * This library is distributed in the hope that it will be useful, 11583349d1SEmanuele Giuseppe Esposito * but WITHOUT ANY WARRANTY; without even the implied warranty of 12583349d1SEmanuele Giuseppe Esposito * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 13583349d1SEmanuele Giuseppe Esposito * Lesser General Public License for more details. 14583349d1SEmanuele Giuseppe Esposito * 15583349d1SEmanuele Giuseppe Esposito * You should have received a copy of the GNU Lesser General Public 16583349d1SEmanuele Giuseppe Esposito * License along with this library; if not, see <http://www.gnu.org/licenses/> 17583349d1SEmanuele Giuseppe Esposito */ 18583349d1SEmanuele Giuseppe Esposito 19583349d1SEmanuele Giuseppe Esposito #include "qemu/osdep.h" 20583349d1SEmanuele Giuseppe Esposito #include "libqtest.h" 210b8fa32fSMarkus Armbruster #include "qemu/module.h" 22*a2ce7dbdSPaolo Bonzini #include "qgraph.h" 23*a2ce7dbdSPaolo Bonzini #include "virtio-net.h" 24583349d1SEmanuele Giuseppe Esposito #include "hw/virtio/virtio-net.h" 25583349d1SEmanuele Giuseppe Esposito 26583349d1SEmanuele Giuseppe Esposito 27583349d1SEmanuele Giuseppe Esposito static QGuestAllocator *alloc; 28583349d1SEmanuele Giuseppe Esposito 29583349d1SEmanuele Giuseppe Esposito static void virtio_net_cleanup(QVirtioNet *interface) 30583349d1SEmanuele Giuseppe Esposito { 316bd4a6d4SPaolo Bonzini int i; 326bd4a6d4SPaolo Bonzini 336bd4a6d4SPaolo Bonzini for (i = 0; i < interface->n_queues; i++) { 346bd4a6d4SPaolo Bonzini qvirtqueue_cleanup(interface->vdev->bus, interface->queues[i], alloc); 356bd4a6d4SPaolo Bonzini } 366bd4a6d4SPaolo Bonzini g_free(interface->queues); 37583349d1SEmanuele Giuseppe Esposito } 38583349d1SEmanuele Giuseppe Esposito 39583349d1SEmanuele Giuseppe Esposito static void virtio_net_setup(QVirtioNet *interface) 40583349d1SEmanuele Giuseppe Esposito { 41583349d1SEmanuele Giuseppe Esposito QVirtioDevice *vdev = interface->vdev; 42583349d1SEmanuele Giuseppe Esposito uint64_t features; 436bd4a6d4SPaolo Bonzini int i; 44583349d1SEmanuele Giuseppe Esposito 45583349d1SEmanuele Giuseppe Esposito features = qvirtio_get_features(vdev); 46583349d1SEmanuele Giuseppe Esposito features &= ~(QVIRTIO_F_BAD_FEATURE | 47a9340358SStefan Hajnoczi (1ull << VIRTIO_RING_F_INDIRECT_DESC) | 48a9340358SStefan Hajnoczi (1ull << VIRTIO_RING_F_EVENT_IDX)); 49583349d1SEmanuele Giuseppe Esposito qvirtio_set_features(vdev, features); 50583349d1SEmanuele Giuseppe Esposito 51a9340358SStefan Hajnoczi if (features & (1ull << VIRTIO_NET_F_MQ)) { 526bd4a6d4SPaolo Bonzini interface->n_queues = qvirtio_config_readw(vdev, 8) * 2; 536bd4a6d4SPaolo Bonzini } else { 546bd4a6d4SPaolo Bonzini interface->n_queues = 2; 556bd4a6d4SPaolo Bonzini } 56375eae1cSOleinik, Alexander interface->n_queues++; /* Account for the ctrl queue */ 576bd4a6d4SPaolo Bonzini 586bd4a6d4SPaolo Bonzini interface->queues = g_new(QVirtQueue *, interface->n_queues); 596bd4a6d4SPaolo Bonzini for (i = 0; i < interface->n_queues; i++) { 606bd4a6d4SPaolo Bonzini interface->queues[i] = qvirtqueue_setup(vdev, alloc, i); 616bd4a6d4SPaolo Bonzini } 62583349d1SEmanuele Giuseppe Esposito qvirtio_set_driver_ok(vdev); 63583349d1SEmanuele Giuseppe Esposito } 64583349d1SEmanuele Giuseppe Esposito 65583349d1SEmanuele Giuseppe Esposito /* virtio-net-device */ 66583349d1SEmanuele Giuseppe Esposito static void qvirtio_net_device_destructor(QOSGraphObject *obj) 67583349d1SEmanuele Giuseppe Esposito { 68583349d1SEmanuele Giuseppe Esposito QVirtioNetDevice *v_net = (QVirtioNetDevice *) obj; 69583349d1SEmanuele Giuseppe Esposito virtio_net_cleanup(&v_net->net); 70583349d1SEmanuele Giuseppe Esposito } 71583349d1SEmanuele Giuseppe Esposito 72583349d1SEmanuele Giuseppe Esposito static void qvirtio_net_device_start_hw(QOSGraphObject *obj) 73583349d1SEmanuele Giuseppe Esposito { 74583349d1SEmanuele Giuseppe Esposito QVirtioNetDevice *v_net = (QVirtioNetDevice *) obj; 75583349d1SEmanuele Giuseppe Esposito QVirtioNet *interface = &v_net->net; 76583349d1SEmanuele Giuseppe Esposito 77583349d1SEmanuele Giuseppe Esposito virtio_net_setup(interface); 78583349d1SEmanuele Giuseppe Esposito } 79583349d1SEmanuele Giuseppe Esposito 80583349d1SEmanuele Giuseppe Esposito static void *qvirtio_net_get_driver(QVirtioNet *v_net, 81583349d1SEmanuele Giuseppe Esposito const char *interface) 82583349d1SEmanuele Giuseppe Esposito { 83583349d1SEmanuele Giuseppe Esposito if (!g_strcmp0(interface, "virtio-net")) { 84583349d1SEmanuele Giuseppe Esposito return v_net; 85583349d1SEmanuele Giuseppe Esposito } 86583349d1SEmanuele Giuseppe Esposito if (!g_strcmp0(interface, "virtio")) { 87583349d1SEmanuele Giuseppe Esposito return v_net->vdev; 88583349d1SEmanuele Giuseppe Esposito } 89583349d1SEmanuele Giuseppe Esposito 90583349d1SEmanuele Giuseppe Esposito fprintf(stderr, "%s not present in virtio-net-device\n", interface); 91583349d1SEmanuele Giuseppe Esposito g_assert_not_reached(); 92583349d1SEmanuele Giuseppe Esposito } 93583349d1SEmanuele Giuseppe Esposito 94583349d1SEmanuele Giuseppe Esposito static void *qvirtio_net_device_get_driver(void *object, 95583349d1SEmanuele Giuseppe Esposito const char *interface) 96583349d1SEmanuele Giuseppe Esposito { 97583349d1SEmanuele Giuseppe Esposito QVirtioNetDevice *v_net = object; 98583349d1SEmanuele Giuseppe Esposito return qvirtio_net_get_driver(&v_net->net, interface); 99583349d1SEmanuele Giuseppe Esposito } 100583349d1SEmanuele Giuseppe Esposito 101583349d1SEmanuele Giuseppe Esposito static void *virtio_net_device_create(void *virtio_dev, 102583349d1SEmanuele Giuseppe Esposito QGuestAllocator *t_alloc, 103583349d1SEmanuele Giuseppe Esposito void *addr) 104583349d1SEmanuele Giuseppe Esposito { 105583349d1SEmanuele Giuseppe Esposito QVirtioNetDevice *virtio_ndevice = g_new0(QVirtioNetDevice, 1); 106583349d1SEmanuele Giuseppe Esposito QVirtioNet *interface = &virtio_ndevice->net; 107583349d1SEmanuele Giuseppe Esposito 108583349d1SEmanuele Giuseppe Esposito interface->vdev = virtio_dev; 109583349d1SEmanuele Giuseppe Esposito alloc = t_alloc; 110583349d1SEmanuele Giuseppe Esposito 111583349d1SEmanuele Giuseppe Esposito virtio_ndevice->obj.destructor = qvirtio_net_device_destructor; 112583349d1SEmanuele Giuseppe Esposito virtio_ndevice->obj.get_driver = qvirtio_net_device_get_driver; 113583349d1SEmanuele Giuseppe Esposito virtio_ndevice->obj.start_hw = qvirtio_net_device_start_hw; 114583349d1SEmanuele Giuseppe Esposito 115583349d1SEmanuele Giuseppe Esposito return &virtio_ndevice->obj; 116583349d1SEmanuele Giuseppe Esposito } 117583349d1SEmanuele Giuseppe Esposito 118583349d1SEmanuele Giuseppe Esposito /* virtio-net-pci */ 119583349d1SEmanuele Giuseppe Esposito static void qvirtio_net_pci_destructor(QOSGraphObject *obj) 120583349d1SEmanuele Giuseppe Esposito { 121583349d1SEmanuele Giuseppe Esposito QVirtioNetPCI *v_net = (QVirtioNetPCI *) obj; 122583349d1SEmanuele Giuseppe Esposito QVirtioNet *interface = &v_net->net; 123583349d1SEmanuele Giuseppe Esposito QOSGraphObject *pci_vobj = &v_net->pci_vdev.obj; 124583349d1SEmanuele Giuseppe Esposito 125583349d1SEmanuele Giuseppe Esposito virtio_net_cleanup(interface); 126583349d1SEmanuele Giuseppe Esposito qvirtio_pci_destructor(pci_vobj); 127583349d1SEmanuele Giuseppe Esposito } 128583349d1SEmanuele Giuseppe Esposito 129583349d1SEmanuele Giuseppe Esposito static void qvirtio_net_pci_start_hw(QOSGraphObject *obj) 130583349d1SEmanuele Giuseppe Esposito { 131583349d1SEmanuele Giuseppe Esposito QVirtioNetPCI *v_net = (QVirtioNetPCI *) obj; 132583349d1SEmanuele Giuseppe Esposito QVirtioNet *interface = &v_net->net; 133583349d1SEmanuele Giuseppe Esposito QOSGraphObject *pci_vobj = &v_net->pci_vdev.obj; 134583349d1SEmanuele Giuseppe Esposito 135583349d1SEmanuele Giuseppe Esposito qvirtio_pci_start_hw(pci_vobj); 136583349d1SEmanuele Giuseppe Esposito virtio_net_setup(interface); 137583349d1SEmanuele Giuseppe Esposito } 138583349d1SEmanuele Giuseppe Esposito 139583349d1SEmanuele Giuseppe Esposito static void *qvirtio_net_pci_get_driver(void *object, 140583349d1SEmanuele Giuseppe Esposito const char *interface) 141583349d1SEmanuele Giuseppe Esposito { 142583349d1SEmanuele Giuseppe Esposito QVirtioNetPCI *v_net = object; 143583349d1SEmanuele Giuseppe Esposito if (!g_strcmp0(interface, "pci-device")) { 144583349d1SEmanuele Giuseppe Esposito return v_net->pci_vdev.pdev; 145583349d1SEmanuele Giuseppe Esposito } 146583349d1SEmanuele Giuseppe Esposito return qvirtio_net_get_driver(&v_net->net, interface); 147583349d1SEmanuele Giuseppe Esposito } 148583349d1SEmanuele Giuseppe Esposito 149583349d1SEmanuele Giuseppe Esposito static void *virtio_net_pci_create(void *pci_bus, QGuestAllocator *t_alloc, 150583349d1SEmanuele Giuseppe Esposito void *addr) 151583349d1SEmanuele Giuseppe Esposito { 152583349d1SEmanuele Giuseppe Esposito QVirtioNetPCI *virtio_bpci = g_new0(QVirtioNetPCI, 1); 153583349d1SEmanuele Giuseppe Esposito QVirtioNet *interface = &virtio_bpci->net; 154583349d1SEmanuele Giuseppe Esposito QOSGraphObject *obj = &virtio_bpci->pci_vdev.obj; 155583349d1SEmanuele Giuseppe Esposito 156583349d1SEmanuele Giuseppe Esposito virtio_pci_init(&virtio_bpci->pci_vdev, pci_bus, addr); 157583349d1SEmanuele Giuseppe Esposito interface->vdev = &virtio_bpci->pci_vdev.vdev; 158583349d1SEmanuele Giuseppe Esposito alloc = t_alloc; 159583349d1SEmanuele Giuseppe Esposito 160583349d1SEmanuele Giuseppe Esposito g_assert_cmphex(interface->vdev->device_type, ==, VIRTIO_ID_NET); 161583349d1SEmanuele Giuseppe Esposito 162583349d1SEmanuele Giuseppe Esposito obj->destructor = qvirtio_net_pci_destructor; 163583349d1SEmanuele Giuseppe Esposito obj->start_hw = qvirtio_net_pci_start_hw; 164583349d1SEmanuele Giuseppe Esposito obj->get_driver = qvirtio_net_pci_get_driver; 165583349d1SEmanuele Giuseppe Esposito 166583349d1SEmanuele Giuseppe Esposito return obj; 167583349d1SEmanuele Giuseppe Esposito } 168583349d1SEmanuele Giuseppe Esposito 169583349d1SEmanuele Giuseppe Esposito static void virtio_net_register_nodes(void) 170583349d1SEmanuele Giuseppe Esposito { 171583349d1SEmanuele Giuseppe Esposito /* FIXME: every test using these nodes needs to setup a 172583349d1SEmanuele Giuseppe Esposito * -netdev socket,id=hs0 otherwise QEMU is not going to start. 173583349d1SEmanuele Giuseppe Esposito * Therefore, we do not include "produces" edge for virtio 174583349d1SEmanuele Giuseppe Esposito * and pci-device yet. 175583349d1SEmanuele Giuseppe Esposito */ 176583349d1SEmanuele Giuseppe Esposito QPCIAddress addr = { 177583349d1SEmanuele Giuseppe Esposito .devfn = QPCI_DEVFN(4, 0), 178583349d1SEmanuele Giuseppe Esposito }; 179583349d1SEmanuele Giuseppe Esposito 180583349d1SEmanuele Giuseppe Esposito QOSGraphEdgeOptions opts = { }; 181583349d1SEmanuele Giuseppe Esposito 182583349d1SEmanuele Giuseppe Esposito /* virtio-net-device */ 183583349d1SEmanuele Giuseppe Esposito opts.extra_device_opts = "netdev=hs0"; 184583349d1SEmanuele Giuseppe Esposito qos_node_create_driver("virtio-net-device", 185583349d1SEmanuele Giuseppe Esposito virtio_net_device_create); 186583349d1SEmanuele Giuseppe Esposito qos_node_consumes("virtio-net-device", "virtio-bus", &opts); 187583349d1SEmanuele Giuseppe Esposito qos_node_produces("virtio-net-device", "virtio-net"); 188583349d1SEmanuele Giuseppe Esposito 189583349d1SEmanuele Giuseppe Esposito /* virtio-net-pci */ 190583349d1SEmanuele Giuseppe Esposito opts.extra_device_opts = "netdev=hs0,addr=04.0"; 191583349d1SEmanuele Giuseppe Esposito add_qpci_address(&opts, &addr); 192583349d1SEmanuele Giuseppe Esposito qos_node_create_driver("virtio-net-pci", virtio_net_pci_create); 193583349d1SEmanuele Giuseppe Esposito qos_node_consumes("virtio-net-pci", "pci-bus", &opts); 194583349d1SEmanuele Giuseppe Esposito qos_node_produces("virtio-net-pci", "virtio-net"); 195583349d1SEmanuele Giuseppe Esposito } 196583349d1SEmanuele Giuseppe Esposito 197583349d1SEmanuele Giuseppe Esposito libqos_init(virtio_net_register_nodes); 198