|  | /* | 
|  | * libqos driver framework | 
|  | * | 
|  | * Copyright (c) 2018 Emanuele Giuseppe Esposito <e.emanuelegiuseppe@gmail.com> | 
|  | * | 
|  | * This library is free software; you can redistribute it and/or | 
|  | * modify it under the terms of the GNU Lesser General Public | 
|  | * License version 2.1 as published by the Free Software Foundation. | 
|  | * | 
|  | * This library is distributed in the hope that it will be useful, | 
|  | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU | 
|  | * Lesser General Public License for more details. | 
|  | * | 
|  | * You should have received a copy of the GNU Lesser General Public | 
|  | * License along with this library; if not, see <http://www.gnu.org/licenses/> | 
|  | */ | 
|  |  | 
|  | #include "qemu/osdep.h" | 
|  | #include "../libqtest.h" | 
|  | #include "qemu/module.h" | 
|  | #include "qgraph.h" | 
|  | #include "virtio-net.h" | 
|  | #include "hw/virtio/virtio-net.h" | 
|  |  | 
|  |  | 
|  | static QGuestAllocator *alloc; | 
|  |  | 
|  | static void virtio_net_cleanup(QVirtioNet *interface) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < interface->n_queues; i++) { | 
|  | qvirtqueue_cleanup(interface->vdev->bus, interface->queues[i], alloc); | 
|  | } | 
|  | g_free(interface->queues); | 
|  | } | 
|  |  | 
|  | static void virtio_net_setup(QVirtioNet *interface) | 
|  | { | 
|  | QVirtioDevice *vdev = interface->vdev; | 
|  | uint64_t features; | 
|  | int i; | 
|  |  | 
|  | features = qvirtio_get_features(vdev); | 
|  | features &= ~(QVIRTIO_F_BAD_FEATURE | | 
|  | (1ull << VIRTIO_RING_F_INDIRECT_DESC) | | 
|  | (1ull << VIRTIO_RING_F_EVENT_IDX)); | 
|  | qvirtio_set_features(vdev, features); | 
|  |  | 
|  | if (features & (1ull << VIRTIO_NET_F_MQ)) { | 
|  | interface->n_queues = qvirtio_config_readw(vdev, 8) * 2; | 
|  | } else { | 
|  | interface->n_queues = 2; | 
|  | } | 
|  | interface->n_queues++; /* Account for the ctrl queue */ | 
|  |  | 
|  | interface->queues = g_new(QVirtQueue *, interface->n_queues); | 
|  | for (i = 0; i < interface->n_queues; i++) { | 
|  | interface->queues[i] = qvirtqueue_setup(vdev, alloc, i); | 
|  | } | 
|  | qvirtio_set_driver_ok(vdev); | 
|  | } | 
|  |  | 
|  | /* virtio-net-device */ | 
|  | static void qvirtio_net_device_destructor(QOSGraphObject *obj) | 
|  | { | 
|  | QVirtioNetDevice *v_net = (QVirtioNetDevice *) obj; | 
|  | virtio_net_cleanup(&v_net->net); | 
|  | } | 
|  |  | 
|  | static void qvirtio_net_device_start_hw(QOSGraphObject *obj) | 
|  | { | 
|  | QVirtioNetDevice *v_net = (QVirtioNetDevice *) obj; | 
|  | QVirtioNet *interface = &v_net->net; | 
|  |  | 
|  | virtio_net_setup(interface); | 
|  | } | 
|  |  | 
|  | static void *qvirtio_net_get_driver(QVirtioNet *v_net, | 
|  | const char *interface) | 
|  | { | 
|  | if (!g_strcmp0(interface, "virtio-net")) { | 
|  | return v_net; | 
|  | } | 
|  | if (!g_strcmp0(interface, "virtio")) { | 
|  | return v_net->vdev; | 
|  | } | 
|  |  | 
|  | fprintf(stderr, "%s not present in virtio-net-device\n", interface); | 
|  | g_assert_not_reached(); | 
|  | } | 
|  |  | 
|  | static void *qvirtio_net_device_get_driver(void *object, | 
|  | const char *interface) | 
|  | { | 
|  | QVirtioNetDevice *v_net = object; | 
|  | return qvirtio_net_get_driver(&v_net->net, interface); | 
|  | } | 
|  |  | 
|  | static void *virtio_net_device_create(void *virtio_dev, | 
|  | QGuestAllocator *t_alloc, | 
|  | void *addr) | 
|  | { | 
|  | QVirtioNetDevice *virtio_ndevice = g_new0(QVirtioNetDevice, 1); | 
|  | QVirtioNet *interface = &virtio_ndevice->net; | 
|  |  | 
|  | interface->vdev = virtio_dev; | 
|  | alloc = t_alloc; | 
|  |  | 
|  | virtio_ndevice->obj.destructor = qvirtio_net_device_destructor; | 
|  | virtio_ndevice->obj.get_driver = qvirtio_net_device_get_driver; | 
|  | virtio_ndevice->obj.start_hw = qvirtio_net_device_start_hw; | 
|  |  | 
|  | return &virtio_ndevice->obj; | 
|  | } | 
|  |  | 
|  | /* virtio-net-pci */ | 
|  | static void qvirtio_net_pci_destructor(QOSGraphObject *obj) | 
|  | { | 
|  | QVirtioNetPCI *v_net = (QVirtioNetPCI *) obj; | 
|  | QVirtioNet *interface = &v_net->net; | 
|  | QOSGraphObject *pci_vobj =  &v_net->pci_vdev.obj; | 
|  |  | 
|  | virtio_net_cleanup(interface); | 
|  | qvirtio_pci_destructor(pci_vobj); | 
|  | } | 
|  |  | 
|  | static void qvirtio_net_pci_start_hw(QOSGraphObject *obj) | 
|  | { | 
|  | QVirtioNetPCI *v_net = (QVirtioNetPCI *) obj; | 
|  | QVirtioNet *interface = &v_net->net; | 
|  | QOSGraphObject *pci_vobj =  &v_net->pci_vdev.obj; | 
|  |  | 
|  | qvirtio_pci_start_hw(pci_vobj); | 
|  | virtio_net_setup(interface); | 
|  | } | 
|  |  | 
|  | static void *qvirtio_net_pci_get_driver(void *object, | 
|  | const char *interface) | 
|  | { | 
|  | QVirtioNetPCI *v_net = object; | 
|  | if (!g_strcmp0(interface, "pci-device")) { | 
|  | return v_net->pci_vdev.pdev; | 
|  | } | 
|  | return qvirtio_net_get_driver(&v_net->net, interface); | 
|  | } | 
|  |  | 
|  | static void *virtio_net_pci_create(void *pci_bus, QGuestAllocator *t_alloc, | 
|  | void *addr) | 
|  | { | 
|  | QVirtioNetPCI *virtio_bpci = g_new0(QVirtioNetPCI, 1); | 
|  | QVirtioNet *interface = &virtio_bpci->net; | 
|  | QOSGraphObject *obj = &virtio_bpci->pci_vdev.obj; | 
|  |  | 
|  | virtio_pci_init(&virtio_bpci->pci_vdev, pci_bus, addr); | 
|  | interface->vdev = &virtio_bpci->pci_vdev.vdev; | 
|  | alloc = t_alloc; | 
|  |  | 
|  | g_assert_cmphex(interface->vdev->device_type, ==, VIRTIO_ID_NET); | 
|  |  | 
|  | obj->destructor = qvirtio_net_pci_destructor; | 
|  | obj->start_hw = qvirtio_net_pci_start_hw; | 
|  | obj->get_driver = qvirtio_net_pci_get_driver; | 
|  |  | 
|  | return obj; | 
|  | } | 
|  |  | 
|  | static void virtio_net_register_nodes(void) | 
|  | { | 
|  | /* FIXME: every test using these nodes needs to setup a | 
|  | * -netdev socket,id=hs0 otherwise QEMU is not going to start. | 
|  | * Therefore, we do not include "produces" edge for virtio | 
|  | * and pci-device yet. | 
|  | */ | 
|  | QPCIAddress addr = { | 
|  | .devfn = QPCI_DEVFN(4, 0), | 
|  | }; | 
|  |  | 
|  | QOSGraphEdgeOptions opts = { }; | 
|  |  | 
|  | /* virtio-net-device */ | 
|  | opts.extra_device_opts = "netdev=hs0"; | 
|  | qos_node_create_driver("virtio-net-device", | 
|  | virtio_net_device_create); | 
|  | qos_node_consumes("virtio-net-device", "virtio-bus", &opts); | 
|  | qos_node_produces("virtio-net-device", "virtio-net"); | 
|  |  | 
|  | /* virtio-net-pci */ | 
|  | opts.extra_device_opts = "netdev=hs0,addr=04.0"; | 
|  | add_qpci_address(&opts, &addr); | 
|  | qos_node_create_driver("virtio-net-pci", virtio_net_pci_create); | 
|  | qos_node_consumes("virtio-net-pci", "pci-bus", &opts); | 
|  | qos_node_produces("virtio-net-pci", "virtio-net"); | 
|  | } | 
|  |  | 
|  | libqos_init(virtio_net_register_nodes); |