136a7a2e7SMaxime Coquelin /* SPDX-License-Identifier: BSD-3-Clause 236a7a2e7SMaxime Coquelin * Copyright(c) 2010-2016 Intel Corporation 336a7a2e7SMaxime Coquelin */ 436a7a2e7SMaxime Coquelin 536a7a2e7SMaxime Coquelin #include <stdint.h> 636a7a2e7SMaxime Coquelin #include <string.h> 736a7a2e7SMaxime Coquelin #include <stdio.h> 836a7a2e7SMaxime Coquelin #include <errno.h> 936a7a2e7SMaxime Coquelin #include <unistd.h> 1036a7a2e7SMaxime Coquelin 1136a7a2e7SMaxime Coquelin #include <ethdev_driver.h> 1236a7a2e7SMaxime Coquelin #include <ethdev_pci.h> 1336a7a2e7SMaxime Coquelin #include <rte_pci.h> 1436a7a2e7SMaxime Coquelin #include <rte_bus_pci.h> 1536a7a2e7SMaxime Coquelin #include <rte_errno.h> 1636a7a2e7SMaxime Coquelin 1736a7a2e7SMaxime Coquelin #include <rte_memory.h> 1836a7a2e7SMaxime Coquelin #include <rte_eal.h> 1936a7a2e7SMaxime Coquelin #include <rte_dev.h> 2036a7a2e7SMaxime Coquelin #include <rte_kvargs.h> 2136a7a2e7SMaxime Coquelin 2236a7a2e7SMaxime Coquelin #include "virtio_ethdev.h" 2336a7a2e7SMaxime Coquelin #include "virtio_pci.h" 2436a7a2e7SMaxime Coquelin #include "virtio_logs.h" 2536a7a2e7SMaxime Coquelin 2636a7a2e7SMaxime Coquelin /* 2736a7a2e7SMaxime Coquelin * The set of PCI devices this driver supports 2836a7a2e7SMaxime Coquelin */ 2936a7a2e7SMaxime Coquelin static const struct rte_pci_id pci_id_virtio_map[] = { 3036a7a2e7SMaxime Coquelin { RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_LEGACY_DEVICEID_NET) }, 3136a7a2e7SMaxime Coquelin { RTE_PCI_DEVICE(VIRTIO_PCI_VENDORID, VIRTIO_PCI_MODERN_DEVICEID_NET) }, 3236a7a2e7SMaxime Coquelin { .vendor_id = 0, /* sentinel */ }, 3336a7a2e7SMaxime Coquelin }; 3436a7a2e7SMaxime Coquelin 35512e27eeSMaxime Coquelin 36512e27eeSMaxime Coquelin /* 37512e27eeSMaxime Coquelin * Remap the PCI device again (IO port map for legacy device and 38512e27eeSMaxime Coquelin * memory map for modern device), so that the secondary process 39512e27eeSMaxime Coquelin * could have the PCI initiated correctly. 40512e27eeSMaxime Coquelin */ 41512e27eeSMaxime Coquelin static int 42*1ac79346SMaxime Coquelin virtio_remap_pci(struct rte_pci_device *pci_dev, struct virtio_pci_dev *dev) 43512e27eeSMaxime Coquelin { 44*1ac79346SMaxime Coquelin struct virtio_hw *hw = &dev->hw; 45*1ac79346SMaxime Coquelin 46*1ac79346SMaxime Coquelin if (dev->modern) { 47512e27eeSMaxime Coquelin /* 48512e27eeSMaxime Coquelin * We don't have to re-parse the PCI config space, since 49512e27eeSMaxime Coquelin * rte_pci_map_device() makes sure the mapped address 50512e27eeSMaxime Coquelin * in secondary process would equal to the one mapped in 51512e27eeSMaxime Coquelin * the primary process: error will be returned if that 52512e27eeSMaxime Coquelin * requirement is not met. 53512e27eeSMaxime Coquelin * 54512e27eeSMaxime Coquelin * That said, we could simply reuse all cap pointers 55512e27eeSMaxime Coquelin * (such as dev_cfg, common_cfg, etc.) parsed from the 56512e27eeSMaxime Coquelin * primary process, which is stored in shared memory. 57512e27eeSMaxime Coquelin */ 58512e27eeSMaxime Coquelin if (rte_pci_map_device(pci_dev)) { 59512e27eeSMaxime Coquelin PMD_INIT_LOG(DEBUG, "failed to map pci device!"); 60512e27eeSMaxime Coquelin return -1; 61512e27eeSMaxime Coquelin } 62*1ac79346SMaxime Coquelin } else { 63512e27eeSMaxime Coquelin if (rte_pci_ioport_map(pci_dev, 0, VTPCI_IO(hw)) < 0) 64512e27eeSMaxime Coquelin return -1; 65512e27eeSMaxime Coquelin } 66512e27eeSMaxime Coquelin 67512e27eeSMaxime Coquelin return 0; 68512e27eeSMaxime Coquelin } 69512e27eeSMaxime Coquelin 7036a7a2e7SMaxime Coquelin static int 7136a7a2e7SMaxime Coquelin eth_virtio_pci_init(struct rte_eth_dev *eth_dev) 7236a7a2e7SMaxime Coquelin { 73512e27eeSMaxime Coquelin struct virtio_pci_dev *dev = eth_dev->data->dev_private; 74512e27eeSMaxime Coquelin struct virtio_hw *hw = &dev->hw; 75512e27eeSMaxime Coquelin struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev); 76512e27eeSMaxime Coquelin int ret; 77512e27eeSMaxime Coquelin 787793d293SMaxime Coquelin VTPCI_DEV(hw) = pci_dev; 797793d293SMaxime Coquelin 80512e27eeSMaxime Coquelin if (rte_eal_process_type() == RTE_PROC_PRIMARY) { 81*1ac79346SMaxime Coquelin ret = vtpci_init(RTE_ETH_DEV_TO_PCI(eth_dev), dev); 82512e27eeSMaxime Coquelin if (ret) { 83512e27eeSMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to init PCI device\n"); 84512e27eeSMaxime Coquelin return -1; 85512e27eeSMaxime Coquelin } 86512e27eeSMaxime Coquelin } else { 87*1ac79346SMaxime Coquelin ret = virtio_remap_pci(RTE_ETH_DEV_TO_PCI(eth_dev), dev); 88512e27eeSMaxime Coquelin if (ret < 0) { 89512e27eeSMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to remap PCI device\n"); 90512e27eeSMaxime Coquelin return -1; 91512e27eeSMaxime Coquelin } 92512e27eeSMaxime Coquelin } 93512e27eeSMaxime Coquelin 94512e27eeSMaxime Coquelin ret = eth_virtio_dev_init(eth_dev); 95512e27eeSMaxime Coquelin if (ret < 0) { 96512e27eeSMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to init virtio device\n"); 97512e27eeSMaxime Coquelin goto err_unmap; 98512e27eeSMaxime Coquelin } 99512e27eeSMaxime Coquelin 100512e27eeSMaxime Coquelin PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x", 101512e27eeSMaxime Coquelin eth_dev->data->port_id, pci_dev->id.vendor_id, 102512e27eeSMaxime Coquelin pci_dev->id.device_id); 103512e27eeSMaxime Coquelin 104512e27eeSMaxime Coquelin return 0; 105512e27eeSMaxime Coquelin 106512e27eeSMaxime Coquelin err_unmap: 107512e27eeSMaxime Coquelin rte_pci_unmap_device(RTE_ETH_DEV_TO_PCI(eth_dev)); 108512e27eeSMaxime Coquelin if (hw->bus_type == VIRTIO_BUS_PCI_LEGACY) 109512e27eeSMaxime Coquelin rte_pci_ioport_unmap(VTPCI_IO(hw)); 110512e27eeSMaxime Coquelin 111512e27eeSMaxime Coquelin return ret; 11236a7a2e7SMaxime Coquelin } 11336a7a2e7SMaxime Coquelin 11436a7a2e7SMaxime Coquelin static int 11536a7a2e7SMaxime Coquelin eth_virtio_pci_uninit(struct rte_eth_dev *eth_dev) 11636a7a2e7SMaxime Coquelin { 11736a7a2e7SMaxime Coquelin int ret; 11836a7a2e7SMaxime Coquelin PMD_INIT_FUNC_TRACE(); 11936a7a2e7SMaxime Coquelin 12036a7a2e7SMaxime Coquelin if (rte_eal_process_type() == RTE_PROC_SECONDARY) 12136a7a2e7SMaxime Coquelin return 0; 12236a7a2e7SMaxime Coquelin 12336a7a2e7SMaxime Coquelin ret = virtio_dev_stop(eth_dev); 12436a7a2e7SMaxime Coquelin virtio_dev_close(eth_dev); 12536a7a2e7SMaxime Coquelin 12636a7a2e7SMaxime Coquelin PMD_INIT_LOG(DEBUG, "dev_uninit completed"); 12736a7a2e7SMaxime Coquelin 12836a7a2e7SMaxime Coquelin return ret; 12936a7a2e7SMaxime Coquelin } 13036a7a2e7SMaxime Coquelin 13136a7a2e7SMaxime Coquelin static int vdpa_check_handler(__rte_unused const char *key, 13236a7a2e7SMaxime Coquelin const char *value, void *ret_val) 13336a7a2e7SMaxime Coquelin { 13436a7a2e7SMaxime Coquelin if (strcmp(value, "1") == 0) 13536a7a2e7SMaxime Coquelin *(int *)ret_val = 1; 13636a7a2e7SMaxime Coquelin else 13736a7a2e7SMaxime Coquelin *(int *)ret_val = 0; 13836a7a2e7SMaxime Coquelin 13936a7a2e7SMaxime Coquelin return 0; 14036a7a2e7SMaxime Coquelin } 14136a7a2e7SMaxime Coquelin 14236a7a2e7SMaxime Coquelin #define VIRTIO_ARG_VDPA "vdpa" 14336a7a2e7SMaxime Coquelin 14436a7a2e7SMaxime Coquelin static int 14536a7a2e7SMaxime Coquelin virtio_pci_devargs_parse(struct rte_devargs *devargs, int *vdpa) 14636a7a2e7SMaxime Coquelin { 14736a7a2e7SMaxime Coquelin struct rte_kvargs *kvlist; 14836a7a2e7SMaxime Coquelin int ret = 0; 14936a7a2e7SMaxime Coquelin 15036a7a2e7SMaxime Coquelin if (devargs == NULL) 15136a7a2e7SMaxime Coquelin return 0; 15236a7a2e7SMaxime Coquelin 15336a7a2e7SMaxime Coquelin kvlist = rte_kvargs_parse(devargs->args, NULL); 15436a7a2e7SMaxime Coquelin if (kvlist == NULL) { 15536a7a2e7SMaxime Coquelin PMD_INIT_LOG(ERR, "error when parsing param"); 15636a7a2e7SMaxime Coquelin return 0; 15736a7a2e7SMaxime Coquelin } 15836a7a2e7SMaxime Coquelin 15936a7a2e7SMaxime Coquelin if (rte_kvargs_count(kvlist, VIRTIO_ARG_VDPA) == 1) { 16036a7a2e7SMaxime Coquelin /* vdpa mode selected when there's a key-value pair: 16136a7a2e7SMaxime Coquelin * vdpa=1 16236a7a2e7SMaxime Coquelin */ 16336a7a2e7SMaxime Coquelin ret = rte_kvargs_process(kvlist, VIRTIO_ARG_VDPA, 16436a7a2e7SMaxime Coquelin vdpa_check_handler, vdpa); 16536a7a2e7SMaxime Coquelin if (ret < 0) 16636a7a2e7SMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to parse %s", VIRTIO_ARG_VDPA); 16736a7a2e7SMaxime Coquelin } 16836a7a2e7SMaxime Coquelin 16936a7a2e7SMaxime Coquelin rte_kvargs_free(kvlist); 17036a7a2e7SMaxime Coquelin 17136a7a2e7SMaxime Coquelin return ret; 17236a7a2e7SMaxime Coquelin } 17336a7a2e7SMaxime Coquelin 17436a7a2e7SMaxime Coquelin static int eth_virtio_pci_probe(struct rte_pci_driver *pci_drv __rte_unused, 17536a7a2e7SMaxime Coquelin struct rte_pci_device *pci_dev) 17636a7a2e7SMaxime Coquelin { 17736a7a2e7SMaxime Coquelin int vdpa = 0; 17836a7a2e7SMaxime Coquelin int ret = 0; 17936a7a2e7SMaxime Coquelin 18036a7a2e7SMaxime Coquelin ret = virtio_pci_devargs_parse(pci_dev->device.devargs, &vdpa); 18136a7a2e7SMaxime Coquelin if (ret < 0) { 18236a7a2e7SMaxime Coquelin PMD_INIT_LOG(ERR, "devargs parsing is failed"); 18336a7a2e7SMaxime Coquelin return ret; 18436a7a2e7SMaxime Coquelin } 18536a7a2e7SMaxime Coquelin /* virtio pmd skips probe if device needs to work in vdpa mode */ 18636a7a2e7SMaxime Coquelin if (vdpa == 1) 18736a7a2e7SMaxime Coquelin return 1; 18836a7a2e7SMaxime Coquelin 18936a7a2e7SMaxime Coquelin return rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct virtio_pci_dev), 19036a7a2e7SMaxime Coquelin eth_virtio_pci_init); 19136a7a2e7SMaxime Coquelin } 19236a7a2e7SMaxime Coquelin 19336a7a2e7SMaxime Coquelin static int eth_virtio_pci_remove(struct rte_pci_device *pci_dev) 19436a7a2e7SMaxime Coquelin { 19536a7a2e7SMaxime Coquelin int ret; 19636a7a2e7SMaxime Coquelin 19736a7a2e7SMaxime Coquelin ret = rte_eth_dev_pci_generic_remove(pci_dev, eth_virtio_pci_uninit); 19836a7a2e7SMaxime Coquelin /* Port has already been released by close. */ 19936a7a2e7SMaxime Coquelin if (ret == -ENODEV) 20036a7a2e7SMaxime Coquelin ret = 0; 20136a7a2e7SMaxime Coquelin return ret; 20236a7a2e7SMaxime Coquelin } 20336a7a2e7SMaxime Coquelin 20436a7a2e7SMaxime Coquelin static struct rte_pci_driver rte_virtio_net_pci_pmd = { 20536a7a2e7SMaxime Coquelin .driver = { 20636a7a2e7SMaxime Coquelin .name = "net_virtio", 20736a7a2e7SMaxime Coquelin }, 20836a7a2e7SMaxime Coquelin .id_table = pci_id_virtio_map, 20936a7a2e7SMaxime Coquelin .drv_flags = 0, 21036a7a2e7SMaxime Coquelin .probe = eth_virtio_pci_probe, 21136a7a2e7SMaxime Coquelin .remove = eth_virtio_pci_remove, 21236a7a2e7SMaxime Coquelin }; 21336a7a2e7SMaxime Coquelin 21436a7a2e7SMaxime Coquelin RTE_INIT(rte_virtio_net_pci_pmd_init) 21536a7a2e7SMaxime Coquelin { 21636a7a2e7SMaxime Coquelin rte_eal_iopl_init(); 21736a7a2e7SMaxime Coquelin rte_pci_register(&rte_virtio_net_pci_pmd); 21836a7a2e7SMaxime Coquelin } 21936a7a2e7SMaxime Coquelin 22036a7a2e7SMaxime Coquelin RTE_PMD_REGISTER_PCI_TABLE(net_virtio, pci_id_virtio_map); 22136a7a2e7SMaxime Coquelin RTE_PMD_REGISTER_KMOD_DEP(net_virtio, "* igb_uio | uio_pci_generic | vfio-pci"); 22236a7a2e7SMaxime Coquelin RTE_PMD_EXPORT_NAME(net_virtio, __COUNTER__); 223