add implementation for probe/init and remove/deinit of the PCI device

Signed-off-by: Serhii Iliushyk <sil-...@napatech.com>
---
v6
* Add driver deinitialization
* Add API rte_eth_dev_probing_finish
        * Add correct API for finishing probing the device
        * Remove duplicated calling 'rte_eth_copy_pci_info()'
         via 'eth_dev_pci_specific_init()
* Remove unnecessary comments
* Remove duplicatet initialization of the numa_node
---
 drivers/net/ntnic/ntnic_ethdev.c | 109 +++++++++++++++++++++++++++++--
 1 file changed, 104 insertions(+), 5 deletions(-)

diff --git a/drivers/net/ntnic/ntnic_ethdev.c b/drivers/net/ntnic/ntnic_ethdev.c
index 68df9be2ff..a744f78adb 100644
--- a/drivers/net/ntnic/ntnic_ethdev.c
+++ b/drivers/net/ntnic/ntnic_ethdev.c
@@ -3,6 +3,7 @@
  * Copyright(c) 2023 Napatech A/S
  */
 
+#include <rte_vfio.h>
 #include <rte_ethdev.h>
 #include <rte_bus_pci.h>
 #include <ethdev_pci.h>
@@ -16,29 +17,127 @@ static const struct rte_pci_id nthw_pci_id_map[] = {
 };
 
 static int
-nthw_pci_dev_init(struct rte_pci_device *pci_dev __rte_unused)
+nthw_pci_dev_init(struct rte_pci_device *pci_dev)
 {
+       uint32_t n_port_mask = -1;      /* All ports enabled by default */
+       int n_phy_ports;
+       NT_LOG_DBGX(DEBUG, NTNIC, "Dev %s PF #%i Init : %02x:%02x:%i\n", 
pci_dev->name,
+               pci_dev->addr.function, pci_dev->addr.bus, pci_dev->addr.devid,
+               pci_dev->addr.function);
+
+       n_phy_ports = 0;
+
+       for (int n_intf_no = 0; n_intf_no < n_phy_ports; n_intf_no++) {
+               struct rte_eth_dev *eth_dev = NULL;
+               char name[32];
+
+               if ((1 << n_intf_no) & ~n_port_mask)
+                       continue;
+
+               snprintf(name, sizeof(name), "ntnic%d", n_intf_no);
+
+               eth_dev = rte_eth_dev_allocate(name);
+
+               if (!eth_dev) {
+                       NT_LOG_DBGX(ERR, NTNIC, "%s: %s: error=%d\n",
+                               (pci_dev->name[0] ? pci_dev->name : "NA"), 
name, -1);
+                       return -1;
+               }
+
+               NT_LOG_DBGX(DEBUG, NTNIC, "eth_dev %p, port_id %u, if_index 
%u\n",
+                                       eth_dev, eth_dev->data->port_id, 
n_intf_no);
+
+
+               struct rte_eth_link pmd_link;
+               pmd_link.link_speed = RTE_ETH_SPEED_NUM_NONE;
+               pmd_link.link_duplex = RTE_ETH_LINK_FULL_DUPLEX;
+               pmd_link.link_status = RTE_ETH_LINK_DOWN;
+               pmd_link.link_autoneg = RTE_ETH_LINK_AUTONEG;
+
+               eth_dev->device = &pci_dev->device;
+               eth_dev->data->dev_link = pmd_link;
+               eth_dev->dev_ops = NULL;
+
+               eth_dev_pci_specific_init(eth_dev, pci_dev);
+               rte_eth_dev_probing_finish(eth_dev);
+       }
+
        return 0;
 }
 
 static int
 nthw_pci_dev_deinit(struct rte_eth_dev *eth_dev __rte_unused)
 {
-       return 0;
+               NT_LOG_DBGX(DEBUG, NTNIC, "PCI device deinitialization\n");
+
+               int i;
+               char name[32];
+
+               struct pmd_internals *internals = eth_dev->data->dev_private;
+               ntdrv_4ga_t *p_ntdrv = &internals->p_drv->ntdrv;
+               fpga_info_t *fpga_info = &p_ntdrv->adapter_info.fpga_info;
+               const int n_phy_ports = fpga_info->n_phy_ports;
+               for (i = 0; i < n_phy_ports; i++) {
+                       sprintf(name, "ntnic%d", i);
+                       eth_dev = rte_eth_dev_allocated(name);
+                       if (eth_dev == NULL)
+                               continue; /* port already released */
+                       rte_eth_dev_release_port(eth_dev);
+               }
+               return 0;
 }
 
 static int
 nthw_pci_probe(struct rte_pci_driver *pci_drv __rte_unused,
        struct rte_pci_device *pci_dev)
 {
-       int ret;
-       ret = nthw_pci_dev_init(pci_dev);
-       return ret;
+       int res;
+
+       NT_LOG_DBGX(DEBUG, NTNIC, "pcidev: name: '%s'\n", pci_dev->name);
+       NT_LOG_DBGX(DEBUG, NTNIC, "devargs: name: '%s'\n", 
pci_dev->device.name);
+
+       if (pci_dev->device.devargs) {
+               NT_LOG_DBGX(DEBUG, NTNIC, "devargs: args: '%s'\n",
+                       (pci_dev->device.devargs->args ? 
pci_dev->device.devargs->args : "NULL"));
+               NT_LOG_DBGX(DEBUG, NTNIC, "devargs: data: '%s'\n",
+                       (pci_dev->device.devargs->data ? 
pci_dev->device.devargs->data : "NULL"));
+       }
+
+       const int n_rte_vfio_no_io_mmu_enabled = rte_vfio_noiommu_is_enabled();
+       NT_LOG(DBG, NTNIC, "vfio_no_iommu_enabled=%d\n", 
n_rte_vfio_no_io_mmu_enabled);
+
+       if (n_rte_vfio_no_io_mmu_enabled) {
+               NT_LOG(ERR, NTNIC, "vfio_no_iommu_enabled=%d: this PMD needs 
VFIO IOMMU\n",
+                       n_rte_vfio_no_io_mmu_enabled);
+               return -1;
+       }
+
+       const enum rte_iova_mode n_rte_io_va_mode = rte_eal_iova_mode();
+       NT_LOG(DBG, NTNIC, "iova mode=%d\n", n_rte_io_va_mode);
+
+       NT_LOG(DBG, NTNIC,
+               "busid=" PCI_PRI_FMT
+               " pciid=%04x:%04x_%04x:%04x locstr=%s @ numanode=%d: drv=%s 
drvalias=%s\n",
+               pci_dev->addr.domain, pci_dev->addr.bus, pci_dev->addr.devid,
+               pci_dev->addr.function, pci_dev->id.vendor_id, 
pci_dev->id.device_id,
+               pci_dev->id.subsystem_vendor_id, 
pci_dev->id.subsystem_device_id,
+               pci_dev->name[0] ? pci_dev->name : "NA",
+               pci_dev->device.numa_node,
+               pci_dev->driver->driver.name ? pci_dev->driver->driver.name : 
"NA",
+               pci_dev->driver->driver.alias ? pci_dev->driver->driver.alias : 
"NA");
+
+
+       res = nthw_pci_dev_init(pci_dev);
+
+       NT_LOG_DBGX(DEBUG, NTNIC, "leave: res=%d\n", res);
+       return res;
 }
 
 static int
 nthw_pci_remove(struct rte_pci_device *pci_dev)
 {
+       NT_LOG_DBGX(DEBUG, NTNIC);
+
        return rte_eth_dev_pci_generic_remove(pci_dev, nthw_pci_dev_deinit);
 }
 
-- 
2.45.0

Reply via email to