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 42512e27eeSMaxime Coquelin virtio_remap_pci(struct rte_pci_device *pci_dev, struct virtio_hw *hw) 43512e27eeSMaxime Coquelin { 44512e27eeSMaxime Coquelin if (hw->bus_type == VIRTIO_BUS_PCI_MODERN) { 45512e27eeSMaxime Coquelin /* 46512e27eeSMaxime Coquelin * We don't have to re-parse the PCI config space, since 47512e27eeSMaxime Coquelin * rte_pci_map_device() makes sure the mapped address 48512e27eeSMaxime Coquelin * in secondary process would equal to the one mapped in 49512e27eeSMaxime Coquelin * the primary process: error will be returned if that 50512e27eeSMaxime Coquelin * requirement is not met. 51512e27eeSMaxime Coquelin * 52512e27eeSMaxime Coquelin * That said, we could simply reuse all cap pointers 53512e27eeSMaxime Coquelin * (such as dev_cfg, common_cfg, etc.) parsed from the 54512e27eeSMaxime Coquelin * primary process, which is stored in shared memory. 55512e27eeSMaxime Coquelin */ 56512e27eeSMaxime Coquelin if (rte_pci_map_device(pci_dev)) { 57512e27eeSMaxime Coquelin PMD_INIT_LOG(DEBUG, "failed to map pci device!"); 58512e27eeSMaxime Coquelin return -1; 59512e27eeSMaxime Coquelin } 60512e27eeSMaxime Coquelin } else if (hw->bus_type == VIRTIO_BUS_PCI_LEGACY) { 61512e27eeSMaxime Coquelin if (rte_pci_ioport_map(pci_dev, 0, VTPCI_IO(hw)) < 0) 62512e27eeSMaxime Coquelin return -1; 63512e27eeSMaxime Coquelin } 64512e27eeSMaxime Coquelin 65512e27eeSMaxime Coquelin return 0; 66512e27eeSMaxime Coquelin } 67512e27eeSMaxime Coquelin 6836a7a2e7SMaxime Coquelin static int 6936a7a2e7SMaxime Coquelin eth_virtio_pci_init(struct rte_eth_dev *eth_dev) 7036a7a2e7SMaxime Coquelin { 71512e27eeSMaxime Coquelin struct virtio_pci_dev *dev = eth_dev->data->dev_private; 72512e27eeSMaxime Coquelin struct virtio_hw *hw = &dev->hw; 73512e27eeSMaxime Coquelin struct rte_pci_device *pci_dev = RTE_ETH_DEV_TO_PCI(eth_dev); 74512e27eeSMaxime Coquelin int ret; 75512e27eeSMaxime Coquelin 76*7793d293SMaxime Coquelin VTPCI_DEV(hw) = pci_dev; 77*7793d293SMaxime Coquelin 78512e27eeSMaxime Coquelin if (rte_eal_process_type() == RTE_PROC_PRIMARY) { 79512e27eeSMaxime Coquelin ret = vtpci_init(RTE_ETH_DEV_TO_PCI(eth_dev), hw); 80512e27eeSMaxime Coquelin if (ret) { 81512e27eeSMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to init PCI device\n"); 82512e27eeSMaxime Coquelin return -1; 83512e27eeSMaxime Coquelin } 84512e27eeSMaxime Coquelin } else { 85512e27eeSMaxime Coquelin ret = virtio_remap_pci(RTE_ETH_DEV_TO_PCI(eth_dev), hw); 86512e27eeSMaxime Coquelin if (ret < 0) { 87512e27eeSMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to remap PCI device\n"); 88512e27eeSMaxime Coquelin return -1; 89512e27eeSMaxime Coquelin } 90512e27eeSMaxime Coquelin } 91512e27eeSMaxime Coquelin 92512e27eeSMaxime Coquelin ret = eth_virtio_dev_init(eth_dev); 93512e27eeSMaxime Coquelin if (ret < 0) { 94512e27eeSMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to init virtio device\n"); 95512e27eeSMaxime Coquelin goto err_unmap; 96512e27eeSMaxime Coquelin } 97512e27eeSMaxime Coquelin 98512e27eeSMaxime Coquelin PMD_INIT_LOG(DEBUG, "port %d vendorID=0x%x deviceID=0x%x", 99512e27eeSMaxime Coquelin eth_dev->data->port_id, pci_dev->id.vendor_id, 100512e27eeSMaxime Coquelin pci_dev->id.device_id); 101512e27eeSMaxime Coquelin 102512e27eeSMaxime Coquelin return 0; 103512e27eeSMaxime Coquelin 104512e27eeSMaxime Coquelin err_unmap: 105512e27eeSMaxime Coquelin rte_pci_unmap_device(RTE_ETH_DEV_TO_PCI(eth_dev)); 106512e27eeSMaxime Coquelin if (hw->bus_type == VIRTIO_BUS_PCI_LEGACY) 107512e27eeSMaxime Coquelin rte_pci_ioport_unmap(VTPCI_IO(hw)); 108512e27eeSMaxime Coquelin 109512e27eeSMaxime Coquelin return ret; 11036a7a2e7SMaxime Coquelin } 11136a7a2e7SMaxime Coquelin 11236a7a2e7SMaxime Coquelin static int 11336a7a2e7SMaxime Coquelin eth_virtio_pci_uninit(struct rte_eth_dev *eth_dev) 11436a7a2e7SMaxime Coquelin { 11536a7a2e7SMaxime Coquelin int ret; 11636a7a2e7SMaxime Coquelin PMD_INIT_FUNC_TRACE(); 11736a7a2e7SMaxime Coquelin 11836a7a2e7SMaxime Coquelin if (rte_eal_process_type() == RTE_PROC_SECONDARY) 11936a7a2e7SMaxime Coquelin return 0; 12036a7a2e7SMaxime Coquelin 12136a7a2e7SMaxime Coquelin ret = virtio_dev_stop(eth_dev); 12236a7a2e7SMaxime Coquelin virtio_dev_close(eth_dev); 12336a7a2e7SMaxime Coquelin 12436a7a2e7SMaxime Coquelin PMD_INIT_LOG(DEBUG, "dev_uninit completed"); 12536a7a2e7SMaxime Coquelin 12636a7a2e7SMaxime Coquelin return ret; 12736a7a2e7SMaxime Coquelin } 12836a7a2e7SMaxime Coquelin 12936a7a2e7SMaxime Coquelin static int vdpa_check_handler(__rte_unused const char *key, 13036a7a2e7SMaxime Coquelin const char *value, void *ret_val) 13136a7a2e7SMaxime Coquelin { 13236a7a2e7SMaxime Coquelin if (strcmp(value, "1") == 0) 13336a7a2e7SMaxime Coquelin *(int *)ret_val = 1; 13436a7a2e7SMaxime Coquelin else 13536a7a2e7SMaxime Coquelin *(int *)ret_val = 0; 13636a7a2e7SMaxime Coquelin 13736a7a2e7SMaxime Coquelin return 0; 13836a7a2e7SMaxime Coquelin } 13936a7a2e7SMaxime Coquelin 14036a7a2e7SMaxime Coquelin #define VIRTIO_ARG_VDPA "vdpa" 14136a7a2e7SMaxime Coquelin 14236a7a2e7SMaxime Coquelin static int 14336a7a2e7SMaxime Coquelin virtio_pci_devargs_parse(struct rte_devargs *devargs, int *vdpa) 14436a7a2e7SMaxime Coquelin { 14536a7a2e7SMaxime Coquelin struct rte_kvargs *kvlist; 14636a7a2e7SMaxime Coquelin int ret = 0; 14736a7a2e7SMaxime Coquelin 14836a7a2e7SMaxime Coquelin if (devargs == NULL) 14936a7a2e7SMaxime Coquelin return 0; 15036a7a2e7SMaxime Coquelin 15136a7a2e7SMaxime Coquelin kvlist = rte_kvargs_parse(devargs->args, NULL); 15236a7a2e7SMaxime Coquelin if (kvlist == NULL) { 15336a7a2e7SMaxime Coquelin PMD_INIT_LOG(ERR, "error when parsing param"); 15436a7a2e7SMaxime Coquelin return 0; 15536a7a2e7SMaxime Coquelin } 15636a7a2e7SMaxime Coquelin 15736a7a2e7SMaxime Coquelin if (rte_kvargs_count(kvlist, VIRTIO_ARG_VDPA) == 1) { 15836a7a2e7SMaxime Coquelin /* vdpa mode selected when there's a key-value pair: 15936a7a2e7SMaxime Coquelin * vdpa=1 16036a7a2e7SMaxime Coquelin */ 16136a7a2e7SMaxime Coquelin ret = rte_kvargs_process(kvlist, VIRTIO_ARG_VDPA, 16236a7a2e7SMaxime Coquelin vdpa_check_handler, vdpa); 16336a7a2e7SMaxime Coquelin if (ret < 0) 16436a7a2e7SMaxime Coquelin PMD_INIT_LOG(ERR, "Failed to parse %s", VIRTIO_ARG_VDPA); 16536a7a2e7SMaxime Coquelin } 16636a7a2e7SMaxime Coquelin 16736a7a2e7SMaxime Coquelin rte_kvargs_free(kvlist); 16836a7a2e7SMaxime Coquelin 16936a7a2e7SMaxime Coquelin return ret; 17036a7a2e7SMaxime Coquelin } 17136a7a2e7SMaxime Coquelin 17236a7a2e7SMaxime Coquelin static int eth_virtio_pci_probe(struct rte_pci_driver *pci_drv __rte_unused, 17336a7a2e7SMaxime Coquelin struct rte_pci_device *pci_dev) 17436a7a2e7SMaxime Coquelin { 17536a7a2e7SMaxime Coquelin int vdpa = 0; 17636a7a2e7SMaxime Coquelin int ret = 0; 17736a7a2e7SMaxime Coquelin 17836a7a2e7SMaxime Coquelin ret = virtio_pci_devargs_parse(pci_dev->device.devargs, &vdpa); 17936a7a2e7SMaxime Coquelin if (ret < 0) { 18036a7a2e7SMaxime Coquelin PMD_INIT_LOG(ERR, "devargs parsing is failed"); 18136a7a2e7SMaxime Coquelin return ret; 18236a7a2e7SMaxime Coquelin } 18336a7a2e7SMaxime Coquelin /* virtio pmd skips probe if device needs to work in vdpa mode */ 18436a7a2e7SMaxime Coquelin if (vdpa == 1) 18536a7a2e7SMaxime Coquelin return 1; 18636a7a2e7SMaxime Coquelin 18736a7a2e7SMaxime Coquelin return rte_eth_dev_pci_generic_probe(pci_dev, sizeof(struct virtio_pci_dev), 18836a7a2e7SMaxime Coquelin eth_virtio_pci_init); 18936a7a2e7SMaxime Coquelin } 19036a7a2e7SMaxime Coquelin 19136a7a2e7SMaxime Coquelin static int eth_virtio_pci_remove(struct rte_pci_device *pci_dev) 19236a7a2e7SMaxime Coquelin { 19336a7a2e7SMaxime Coquelin int ret; 19436a7a2e7SMaxime Coquelin 19536a7a2e7SMaxime Coquelin ret = rte_eth_dev_pci_generic_remove(pci_dev, eth_virtio_pci_uninit); 19636a7a2e7SMaxime Coquelin /* Port has already been released by close. */ 19736a7a2e7SMaxime Coquelin if (ret == -ENODEV) 19836a7a2e7SMaxime Coquelin ret = 0; 19936a7a2e7SMaxime Coquelin return ret; 20036a7a2e7SMaxime Coquelin } 20136a7a2e7SMaxime Coquelin 20236a7a2e7SMaxime Coquelin static struct rte_pci_driver rte_virtio_net_pci_pmd = { 20336a7a2e7SMaxime Coquelin .driver = { 20436a7a2e7SMaxime Coquelin .name = "net_virtio", 20536a7a2e7SMaxime Coquelin }, 20636a7a2e7SMaxime Coquelin .id_table = pci_id_virtio_map, 20736a7a2e7SMaxime Coquelin .drv_flags = 0, 20836a7a2e7SMaxime Coquelin .probe = eth_virtio_pci_probe, 20936a7a2e7SMaxime Coquelin .remove = eth_virtio_pci_remove, 21036a7a2e7SMaxime Coquelin }; 21136a7a2e7SMaxime Coquelin 21236a7a2e7SMaxime Coquelin RTE_INIT(rte_virtio_net_pci_pmd_init) 21336a7a2e7SMaxime Coquelin { 21436a7a2e7SMaxime Coquelin rte_eal_iopl_init(); 21536a7a2e7SMaxime Coquelin rte_pci_register(&rte_virtio_net_pci_pmd); 21636a7a2e7SMaxime Coquelin } 21736a7a2e7SMaxime Coquelin 21836a7a2e7SMaxime Coquelin RTE_PMD_REGISTER_PCI_TABLE(net_virtio, pci_id_virtio_map); 21936a7a2e7SMaxime Coquelin RTE_PMD_REGISTER_KMOD_DEP(net_virtio, "* igb_uio | uio_pci_generic | vfio-pci"); 22036a7a2e7SMaxime Coquelin RTE_PMD_EXPORT_NAME(net_virtio, __COUNTER__); 221