/* * libqos driver framework * * Copyright (c) 2018 Emanuele Giuseppe Esposito * * 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 */ #include "qemu/osdep.h" #include "hw/net/e1000_regs.h" #include "hw/pci/pci_ids.h" #include "../libqtest.h" #include "pci-pc.h" #include "qemu/sockets.h" #include "qemu/iov.h" #include "qemu/module.h" #include "qemu/bitops.h" #include "libqos-malloc.h" #include "qgraph.h" #include "e1000e.h" #define E1000E_IVAR_TEST_CFG \ (((E1000E_RX0_MSG_ID | E1000_IVAR_INT_ALLOC_VALID) << E1000_IVAR_RXQ0_SHIFT) | \ ((E1000E_TX0_MSG_ID | E1000_IVAR_INT_ALLOC_VALID) << E1000_IVAR_TXQ0_SHIFT) | \ ((E1000E_OTHER_MSG_ID | E1000_IVAR_INT_ALLOC_VALID) << E1000_IVAR_OTHER_SHIFT) | \ E1000_IVAR_TX_INT_EVERY_WB) #define E1000E_RING_LEN (0x1000) static void e1000e_macreg_write(QE1000E *d, uint32_t reg, uint32_t val) { QE1000E_PCI *d_pci = container_of(d, QE1000E_PCI, e1000e); qpci_io_writel(&d_pci->pci_dev, d_pci->mac_regs, reg, val); } static uint32_t e1000e_macreg_read(QE1000E *d, uint32_t reg) { QE1000E_PCI *d_pci = container_of(d, QE1000E_PCI, e1000e); return qpci_io_readl(&d_pci->pci_dev, d_pci->mac_regs, reg); } void e1000e_tx_ring_push(QE1000E *d, void *descr) { QE1000E_PCI *d_pci = container_of(d, QE1000E_PCI, e1000e); uint32_t tail = e1000e_macreg_read(d, E1000E_TDT); uint32_t len = e1000e_macreg_read(d, E1000E_TDLEN) / E1000_RING_DESC_LEN; qtest_memwrite(d_pci->pci_dev.bus->qts, d->tx_ring + tail * E1000_RING_DESC_LEN, descr, E1000_RING_DESC_LEN); e1000e_macreg_write(d, E1000E_TDT, (tail + 1) % len); /* Read WB data for the packet transmitted */ qtest_memread(d_pci->pci_dev.bus->qts, d->tx_ring + tail * E1000_RING_DESC_LEN, descr, E1000_RING_DESC_LEN); } void e1000e_rx_ring_push(QE1000E *d, void *descr) { QE1000E_PCI *d_pci = container_of(d, QE1000E_PCI, e1000e); uint32_t tail = e1000e_macreg_read(d, E1000E_RDT); uint32_t len = e1000e_macreg_read(d, E1000E_RDLEN) / E1000_RING_DESC_LEN; qtest_memwrite(d_pci->pci_dev.bus->qts, d->rx_ring + tail * E1000_RING_DESC_LEN, descr, E1000_RING_DESC_LEN); e1000e_macreg_write(d, E1000E_RDT, (tail + 1) % len); /* Read WB data for the packet received */ qtest_memread(d_pci->pci_dev.bus->qts, d->rx_ring + tail * E1000_RING_DESC_LEN, descr, E1000_RING_DESC_LEN); } static void e1000e_foreach_callback(QPCIDevice *dev, int devfn, void *data) { QPCIDevice *res = data; memcpy(res, dev, sizeof(QPCIDevice)); g_free(dev); } void e1000e_wait_isr(QE1000E *d, uint16_t msg_id) { QE1000E_PCI *d_pci = container_of(d, QE1000E_PCI, e1000e); guint64 end_time = g_get_monotonic_time() + 5 * G_TIME_SPAN_SECOND; do { if (qpci_msix_pending(&d_pci->pci_dev, msg_id)) { return; } qtest_clock_step(d_pci->pci_dev.bus->qts, 10000); } while (g_get_monotonic_time() < end_time); g_error("Timeout expired"); } static void e1000e_pci_destructor(QOSGraphObject *obj) { QE1000E_PCI *epci = (QE1000E_PCI *) obj; qpci_iounmap(&epci->pci_dev, epci->mac_regs); qpci_msix_disable(&epci->pci_dev); } static void e1000e_pci_start_hw(QOSGraphObject *obj) { QE1000E_PCI *d = (QE1000E_PCI *) obj; uint32_t val; /* Enable the device */ qpci_device_enable(&d->pci_dev); /* Reset the device */ val = e1000e_macreg_read(&d->e1000e, E1000_CTRL); e1000e_macreg_write(&d->e1000e, E1000_CTRL, val | E1000_CTRL_RST | E1000_CTRL_SLU); /* Enable and configure MSI-X */ qpci_msix_enable(&d->pci_dev); e1000e_macreg_write(&d->e1000e, E1000_IVAR, E1000E_IVAR_TEST_CFG); /* Check the device status - link and speed */ val = e1000e_macreg_read(&d->e1000e, E1000_STATUS); g_assert_cmphex(val & (E1000_STATUS_LU | E1000_STATUS_ASDV_1000), ==, E1000_STATUS_LU | E1000_STATUS_ASDV_1000); /* Initialize TX/RX logic */ e1000e_macreg_write(&d->e1000e, E1000_RCTL, 0); e1000e_macreg_write(&d->e1000e, E1000_TCTL, 0); /* Notify the device that the driver is ready */ val = e1000e_macreg_read(&d->e1000e, E1000_CTRL_EXT); e1000e_macreg_write(&d->e1000e, E1000_CTRL_EXT, val | E1000_CTRL_EXT_DRV_LOAD); e1000e_macreg_write(&d->e1000e, E1000_TDBAL, (uint32_t) d->e1000e.tx_ring); e1000e_macreg_write(&d->e1000e, E1000_TDBAH, (uint32_t) (d->e1000e.tx_ring >> 32)); e1000e_macreg_write(&d->e1000e, E1000E_TDLEN, E1000E_RING_LEN); e1000e_macreg_write(&d->e1000e, E1000E_TDT, 0); e1000e_macreg_write(&d->e1000e, E1000_TDH, 0); /* Enable transmit */ e1000e_macreg_write(&d->e1000e, E1000_TCTL, E1000_TCTL_EN); e1000e_macreg_write(&d->e1000e, E1000_RDBAL, (uint32_t)d->e1000e.rx_ring); e1000e_macreg_write(&d->e1000e, E1000_RDBAH, (uint32_t)(d->e1000e.rx_ring >> 32)); e1000e_macreg_write(&d->e1000e, E1000E_RDLEN, E1000E_RING_LEN); e1000e_macreg_write(&d->e1000e, E1000E_RDT, 0); e1000e_macreg_write(&d->e1000e, E1000_RDH, 0); /* Enable receive */ e1000e_macreg_write(&d->e1000e, E1000_RFCTL, E1000_RFCTL_EXTEN); e1000e_macreg_write(&d->e1000e, E1000_RCTL, E1000_RCTL_EN | E1000_RCTL_UPE | E1000_RCTL_MPE); /* Enable all interrupts */ e1000e_macreg_write(&d->e1000e, E1000_IMS, 0xFFFFFFFF); } static void *e1000e_pci_get_driver(void *obj, const char *interface) { QE1000E_PCI *epci = obj; if (!g_strcmp0(interface, "e1000e-if")) { return &epci->e1000e; } /* implicit contains */ if (!g_strcmp0(interface, "pci-device")) { return &epci->pci_dev; } fprintf(stderr, "%s not present in e1000e\n", interface); g_assert_not_reached(); } static void *e1000e_pci_create(void *pci_bus, QGuestAllocator *alloc, void *addr) { QE1000E_PCI *d = g_new0(QE1000E_PCI, 1); QPCIBus *bus = pci_bus; QPCIAddress *address = addr; qpci_device_foreach(bus, address->vendor_id, address->device_id, e1000e_foreach_callback, &d->pci_dev); /* Map BAR0 (mac registers) */ d->mac_regs = qpci_iomap(&d->pci_dev, 0, NULL); /* Allocate and setup TX ring */ d->e1000e.tx_ring = guest_alloc(alloc, E1000E_RING_LEN); g_assert(d->e1000e.tx_ring != 0); /* Allocate and setup RX ring */ d->e1000e.rx_ring = guest_alloc(alloc, E1000E_RING_LEN); g_assert(d->e1000e.rx_ring != 0); d->obj.get_driver = e1000e_pci_get_driver; d->obj.start_hw = e1000e_pci_start_hw; d->obj.destructor = e1000e_pci_destructor; return &d->obj; } static void e1000e_register_nodes(void) { QPCIAddress addr = { .vendor_id = PCI_VENDOR_ID_INTEL, .device_id = E1000_DEV_ID_82574L, }; /* FIXME: every test using this node needs to setup a -netdev socket,id=hs0 * otherwise QEMU is not going to start */ QOSGraphEdgeOptions opts = { .extra_device_opts = "netdev=hs0", }; add_qpci_address(&opts, &addr); qos_node_create_driver("e1000e", e1000e_pci_create); qos_node_consumes("e1000e", "pci-bus", &opts); } libqos_init(e1000e_register_nodes);