From: Beilei Xing <beilei.x...@intel.com>

Introduce base init and deinit in common module.

Signed-off-by: Wenjun Wu <wenjun1...@intel.com>
Signed-off-by: Beilei Xing <beilei.x...@intel.com>
---
 drivers/common/idpf/idpf_common_device.c   | 153 ++++++++++++++++++++
 drivers/common/idpf/idpf_common_device.h   |   6 +
 drivers/common/idpf/idpf_common_virtchnl.h |   2 -
 drivers/common/idpf/version.map            |   4 +-
 drivers/net/idpf/idpf_ethdev.c             | 158 +++------------------
 drivers/net/idpf/idpf_ethdev.h             |   2 -
 6 files changed, 178 insertions(+), 147 deletions(-)

diff --git a/drivers/common/idpf/idpf_common_device.c 
b/drivers/common/idpf/idpf_common_device.c
index 5062780362..b2b42443e4 100644
--- a/drivers/common/idpf/idpf_common_device.c
+++ b/drivers/common/idpf/idpf_common_device.c
@@ -4,5 +4,158 @@
 
 #include <rte_log.h>
 #include <idpf_common_device.h>
+#include <idpf_common_virtchnl.h>
+
+static void
+idpf_reset_pf(struct idpf_hw *hw)
+{
+       uint32_t reg;
+
+       reg = IDPF_READ_REG(hw, PFGEN_CTRL);
+       IDPF_WRITE_REG(hw, PFGEN_CTRL, (reg | PFGEN_CTRL_PFSWR));
+}
+
+#define IDPF_RESET_WAIT_CNT 100
+static int
+idpf_check_pf_reset_done(struct idpf_hw *hw)
+{
+       uint32_t reg;
+       int i;
+
+       for (i = 0; i < IDPF_RESET_WAIT_CNT; i++) {
+               reg = IDPF_READ_REG(hw, PFGEN_RSTAT);
+               if (reg != 0xFFFFFFFF && (reg & PFGEN_RSTAT_PFR_STATE_M))
+                       return 0;
+               rte_delay_ms(1000);
+       }
+
+       DRV_LOG(ERR, "IDPF reset timeout");
+       return -EBUSY;
+}
+
+#define CTLQ_NUM 2
+static int
+idpf_init_mbx(struct idpf_hw *hw)
+{
+       struct idpf_ctlq_create_info ctlq_info[CTLQ_NUM] = {
+               {
+                       .type = IDPF_CTLQ_TYPE_MAILBOX_TX,
+                       .id = IDPF_CTLQ_ID,
+                       .len = IDPF_CTLQ_LEN,
+                       .buf_size = IDPF_DFLT_MBX_BUF_SIZE,
+                       .reg = {
+                               .head = PF_FW_ATQH,
+                               .tail = PF_FW_ATQT,
+                               .len = PF_FW_ATQLEN,
+                               .bah = PF_FW_ATQBAH,
+                               .bal = PF_FW_ATQBAL,
+                               .len_mask = PF_FW_ATQLEN_ATQLEN_M,
+                               .len_ena_mask = PF_FW_ATQLEN_ATQENABLE_M,
+                               .head_mask = PF_FW_ATQH_ATQH_M,
+                       }
+               },
+               {
+                       .type = IDPF_CTLQ_TYPE_MAILBOX_RX,
+                       .id = IDPF_CTLQ_ID,
+                       .len = IDPF_CTLQ_LEN,
+                       .buf_size = IDPF_DFLT_MBX_BUF_SIZE,
+                       .reg = {
+                               .head = PF_FW_ARQH,
+                               .tail = PF_FW_ARQT,
+                               .len = PF_FW_ARQLEN,
+                               .bah = PF_FW_ARQBAH,
+                               .bal = PF_FW_ARQBAL,
+                               .len_mask = PF_FW_ARQLEN_ARQLEN_M,
+                               .len_ena_mask = PF_FW_ARQLEN_ARQENABLE_M,
+                               .head_mask = PF_FW_ARQH_ARQH_M,
+                       }
+               }
+       };
+       struct idpf_ctlq_info *ctlq;
+       int ret;
+
+       ret = idpf_ctlq_init(hw, CTLQ_NUM, ctlq_info);
+       if (ret != 0)
+               return ret;
+
+       LIST_FOR_EACH_ENTRY_SAFE(ctlq, NULL, &hw->cq_list_head,
+                                struct idpf_ctlq_info, cq_list) {
+               if (ctlq->q_id == IDPF_CTLQ_ID &&
+                   ctlq->cq_type == IDPF_CTLQ_TYPE_MAILBOX_TX)
+                       hw->asq = ctlq;
+               if (ctlq->q_id == IDPF_CTLQ_ID &&
+                   ctlq->cq_type == IDPF_CTLQ_TYPE_MAILBOX_RX)
+                       hw->arq = ctlq;
+       }
+
+       if (hw->asq == NULL || hw->arq == NULL) {
+               idpf_ctlq_deinit(hw);
+               ret = -ENOENT;
+       }
+
+       return ret;
+}
+
+int
+idpf_adapter_init(struct idpf_adapter *adapter)
+{
+       struct idpf_hw *hw = &adapter->hw;
+       int ret;
+
+       idpf_reset_pf(hw);
+       ret = idpf_check_pf_reset_done(hw);
+       if (ret != 0) {
+               DRV_LOG(ERR, "IDPF is still resetting");
+               goto err_check_reset;
+       }
+
+       ret = idpf_init_mbx(hw);
+       if (ret != 0) {
+               DRV_LOG(ERR, "Failed to init mailbox");
+               goto err_check_reset;
+       }
+
+       adapter->mbx_resp = rte_zmalloc("idpf_adapter_mbx_resp",
+                                       IDPF_DFLT_MBX_BUF_SIZE, 0);
+       if (adapter->mbx_resp == NULL) {
+               DRV_LOG(ERR, "Failed to allocate idpf_adapter_mbx_resp memory");
+               ret = -ENOMEM;
+               goto err_mbx_resp;
+       }
+
+       ret = idpf_vc_check_api_version(adapter);
+       if (ret != 0) {
+               DRV_LOG(ERR, "Failed to check api version");
+               goto err_check_api;
+       }
+
+       ret = idpf_vc_get_caps(adapter);
+       if (ret != 0) {
+               DRV_LOG(ERR, "Failed to get capabilities");
+               goto err_check_api;
+       }
+
+       return 0;
+
+err_check_api:
+       rte_free(adapter->mbx_resp);
+       adapter->mbx_resp = NULL;
+err_mbx_resp:
+       idpf_ctlq_deinit(hw);
+err_check_reset:
+       return ret;
+}
+
+int
+idpf_adapter_deinit(struct idpf_adapter *adapter)
+{
+       struct idpf_hw *hw = &adapter->hw;
+
+       idpf_ctlq_deinit(hw);
+       rte_free(adapter->mbx_resp);
+       adapter->mbx_resp = NULL;
+
+       return 0;
+}
 
 RTE_LOG_REGISTER_SUFFIX(idpf_common_logtype, common, NOTICE);
diff --git a/drivers/common/idpf/idpf_common_device.h 
b/drivers/common/idpf/idpf_common_device.h
index a7537281d1..e4344ea392 100644
--- a/drivers/common/idpf/idpf_common_device.h
+++ b/drivers/common/idpf/idpf_common_device.h
@@ -9,6 +9,7 @@
 #include <base/virtchnl2.h>
 #include <idpf_common_logs.h>
 
+#define IDPF_CTLQ_ID           -1
 #define IDPF_CTLQ_LEN          64
 #define IDPF_DFLT_MBX_BUF_SIZE 4096
 
@@ -137,4 +138,9 @@ atomic_set_cmd(struct idpf_adapter *adapter, uint32_t ops)
        return !ret;
 }
 
+__rte_internal
+int idpf_adapter_init(struct idpf_adapter *adapter);
+__rte_internal
+int idpf_adapter_deinit(struct idpf_adapter *adapter);
+
 #endif /* _IDPF_COMMON_DEVICE_H_ */
diff --git a/drivers/common/idpf/idpf_common_virtchnl.h 
b/drivers/common/idpf/idpf_common_virtchnl.h
index bbc66d63c4..a1bae81372 100644
--- a/drivers/common/idpf/idpf_common_virtchnl.h
+++ b/drivers/common/idpf/idpf_common_virtchnl.h
@@ -7,9 +7,7 @@
 
 #include <idpf_common_device.h>
 
-__rte_internal
 int idpf_vc_check_api_version(struct idpf_adapter *adapter);
-__rte_internal
 int idpf_vc_get_caps(struct idpf_adapter *adapter);
 __rte_internal
 int idpf_vc_create_vport(struct idpf_vport *vport,
diff --git a/drivers/common/idpf/version.map b/drivers/common/idpf/version.map
index 3fa367aea4..535fa1fc24 100644
--- a/drivers/common/idpf/version.map
+++ b/drivers/common/idpf/version.map
@@ -7,8 +7,6 @@ INTERNAL {
        idpf_ctlq_recv;
        idpf_ctlq_send;
        idpf_ctlq_post_rx_buffs;
-       idpf_vc_check_api_version;
-       idpf_vc_get_caps;
        idpf_vc_create_vport;
        idpf_vc_destroy_vport;
        idpf_vc_set_rss_key;
@@ -23,6 +21,8 @@ INTERNAL {
        idpf_vc_query_ptype_info;
        idpf_read_one_msg;
        idpf_execute_vc_cmd;
+       idpf_adapter_init;
+       idpf_adapter_deinit;
 
        local: *;
 };
diff --git a/drivers/net/idpf/idpf_ethdev.c b/drivers/net/idpf/idpf_ethdev.c
index bd74fb57b4..46529cebf9 100644
--- a/drivers/net/idpf/idpf_ethdev.c
+++ b/drivers/net/idpf/idpf_ethdev.c
@@ -781,148 +781,32 @@ idpf_parse_devargs(struct rte_pci_device *pci_dev, 
struct idpf_adapter_ext *adap
        return ret;
 }
 
-static void
-idpf_reset_pf(struct idpf_hw *hw)
-{
-       uint32_t reg;
-
-       reg = IDPF_READ_REG(hw, PFGEN_CTRL);
-       IDPF_WRITE_REG(hw, PFGEN_CTRL, (reg | PFGEN_CTRL_PFSWR));
-}
-
-#define IDPF_RESET_WAIT_CNT 100
 static int
-idpf_check_pf_reset_done(struct idpf_hw *hw)
+idpf_adapter_ext_init(struct rte_pci_device *pci_dev, struct idpf_adapter_ext 
*adapter)
 {
-       uint32_t reg;
-       int i;
-
-       for (i = 0; i < IDPF_RESET_WAIT_CNT; i++) {
-               reg = IDPF_READ_REG(hw, PFGEN_RSTAT);
-               if (reg != 0xFFFFFFFF && (reg & PFGEN_RSTAT_PFR_STATE_M))
-                       return 0;
-               rte_delay_ms(1000);
-       }
-
-       PMD_INIT_LOG(ERR, "IDPF reset timeout");
-       return -EBUSY;
-}
-
-#define CTLQ_NUM 2
-static int
-idpf_init_mbx(struct idpf_hw *hw)
-{
-       struct idpf_ctlq_create_info ctlq_info[CTLQ_NUM] = {
-               {
-                       .type = IDPF_CTLQ_TYPE_MAILBOX_TX,
-                       .id = IDPF_CTLQ_ID,
-                       .len = IDPF_CTLQ_LEN,
-                       .buf_size = IDPF_DFLT_MBX_BUF_SIZE,
-                       .reg = {
-                               .head = PF_FW_ATQH,
-                               .tail = PF_FW_ATQT,
-                               .len = PF_FW_ATQLEN,
-                               .bah = PF_FW_ATQBAH,
-                               .bal = PF_FW_ATQBAL,
-                               .len_mask = PF_FW_ATQLEN_ATQLEN_M,
-                               .len_ena_mask = PF_FW_ATQLEN_ATQENABLE_M,
-                               .head_mask = PF_FW_ATQH_ATQH_M,
-                       }
-               },
-               {
-                       .type = IDPF_CTLQ_TYPE_MAILBOX_RX,
-                       .id = IDPF_CTLQ_ID,
-                       .len = IDPF_CTLQ_LEN,
-                       .buf_size = IDPF_DFLT_MBX_BUF_SIZE,
-                       .reg = {
-                               .head = PF_FW_ARQH,
-                               .tail = PF_FW_ARQT,
-                               .len = PF_FW_ARQLEN,
-                               .bah = PF_FW_ARQBAH,
-                               .bal = PF_FW_ARQBAL,
-                               .len_mask = PF_FW_ARQLEN_ARQLEN_M,
-                               .len_ena_mask = PF_FW_ARQLEN_ARQENABLE_M,
-                               .head_mask = PF_FW_ARQH_ARQH_M,
-                       }
-               }
-       };
-       struct idpf_ctlq_info *ctlq;
-       int ret;
-
-       ret = idpf_ctlq_init(hw, CTLQ_NUM, ctlq_info);
-       if (ret != 0)
-               return ret;
-
-       LIST_FOR_EACH_ENTRY_SAFE(ctlq, NULL, &hw->cq_list_head,
-                                struct idpf_ctlq_info, cq_list) {
-               if (ctlq->q_id == IDPF_CTLQ_ID &&
-                   ctlq->cq_type == IDPF_CTLQ_TYPE_MAILBOX_TX)
-                       hw->asq = ctlq;
-               if (ctlq->q_id == IDPF_CTLQ_ID &&
-                   ctlq->cq_type == IDPF_CTLQ_TYPE_MAILBOX_RX)
-                       hw->arq = ctlq;
-       }
-
-       if (hw->asq == NULL || hw->arq == NULL) {
-               idpf_ctlq_deinit(hw);
-               ret = -ENOENT;
-       }
-
-       return ret;
-}
-
-static int
-idpf_adapter_init(struct rte_pci_device *pci_dev, struct idpf_adapter_ext 
*adapter)
-{
-       struct idpf_hw *hw = &adapter->base.hw;
+       struct idpf_adapter *base = &adapter->base;
+       struct idpf_hw *hw = &base->hw;
        int ret = 0;
 
        hw->hw_addr = (void *)pci_dev->mem_resource[0].addr;
        hw->hw_addr_len = pci_dev->mem_resource[0].len;
-       hw->back = &adapter->base;
+       hw->back = base;
        hw->vendor_id = pci_dev->id.vendor_id;
        hw->device_id = pci_dev->id.device_id;
        hw->subsystem_vendor_id = pci_dev->id.subsystem_vendor_id;
 
        strncpy(adapter->name, pci_dev->device.name, PCI_PRI_STR_SIZE);
 
-       idpf_reset_pf(hw);
-       ret = idpf_check_pf_reset_done(hw);
-       if (ret != 0) {
-               PMD_INIT_LOG(ERR, "IDPF is still resetting");
-               goto err;
-       }
-
-       ret = idpf_init_mbx(hw);
-       if (ret != 0) {
-               PMD_INIT_LOG(ERR, "Failed to init mailbox");
-               goto err;
-       }
-
-       adapter->base.mbx_resp = rte_zmalloc("idpf_adapter_mbx_resp",
-                                            IDPF_DFLT_MBX_BUF_SIZE, 0);
-       if (adapter->base.mbx_resp == NULL) {
-               PMD_INIT_LOG(ERR, "Failed to allocate idpf_adapter_mbx_resp 
memory");
-               ret = -ENOMEM;
-               goto err_mbx;
-       }
-
-       ret = idpf_vc_check_api_version(&adapter->base);
+       ret = idpf_adapter_init(base);
        if (ret != 0) {
-               PMD_INIT_LOG(ERR, "Failed to check api version");
-               goto err_api;
+               PMD_INIT_LOG(ERR, "Failed to init adapter");
+               goto err_adapter_init;
        }
 
        ret = idpf_get_pkt_type(adapter);
        if (ret != 0) {
                PMD_INIT_LOG(ERR, "Failed to set ptype table");
-               goto err_api;
-       }
-
-       ret = idpf_vc_get_caps(&adapter->base);
-       if (ret != 0) {
-               PMD_INIT_LOG(ERR, "Failed to get capabilities");
-               goto err_api;
+               goto err_get_ptype;
        }
 
        adapter->max_vport_nb = adapter->base.caps.max_vports;
@@ -934,7 +818,7 @@ idpf_adapter_init(struct rte_pci_device *pci_dev, struct 
idpf_adapter_ext *adapt
        if (adapter->vports == NULL) {
                PMD_INIT_LOG(ERR, "Failed to allocate vports memory");
                ret = -ENOMEM;
-               goto err_api;
+               goto err_get_ptype;
        }
 
        adapter->cur_vports = 0;
@@ -944,12 +828,9 @@ idpf_adapter_init(struct rte_pci_device *pci_dev, struct 
idpf_adapter_ext *adapt
 
        return ret;
 
-err_api:
-       rte_free(adapter->base.mbx_resp);
-       adapter->base.mbx_resp = NULL;
-err_mbx:
-       idpf_ctlq_deinit(hw);
-err:
+err_get_ptype:
+       idpf_adapter_deinit(base);
+err_adapter_init:
        return ret;
 }
 
@@ -1088,14 +969,9 @@ idpf_find_adapter_ext(struct rte_pci_device *pci_dev)
 }
 
 static void
-idpf_adapter_rel(struct idpf_adapter_ext *adapter)
+idpf_adapter_ext_deinit(struct idpf_adapter_ext *adapter)
 {
-       struct idpf_hw *hw = &adapter->base.hw;
-
-       idpf_ctlq_deinit(hw);
-
-       rte_free(adapter->base.mbx_resp);
-       adapter->base.mbx_resp = NULL;
+       idpf_adapter_deinit(&adapter->base);
 
        rte_free(adapter->vports);
        adapter->vports = NULL;
@@ -1128,7 +1004,7 @@ idpf_pci_probe(struct rte_pci_driver *pci_drv 
__rte_unused,
                        return -ENOMEM;
                }
 
-               retval = idpf_adapter_init(pci_dev, adapter);
+               retval = idpf_adapter_ext_init(pci_dev, adapter);
                if (retval != 0) {
                        PMD_INIT_LOG(ERR, "Failed to init adapter.");
                        return retval;
@@ -1191,7 +1067,7 @@ idpf_pci_probe(struct rte_pci_driver *pci_drv 
__rte_unused,
                rte_spinlock_lock(&idpf_adapter_lock);
                TAILQ_REMOVE(&idpf_adapter_list, adapter, next);
                rte_spinlock_unlock(&idpf_adapter_lock);
-               idpf_adapter_rel(adapter);
+               idpf_adapter_ext_deinit(adapter);
                rte_free(adapter);
        }
        return retval;
@@ -1211,7 +1087,7 @@ idpf_pci_remove(struct rte_pci_device *pci_dev)
        rte_spinlock_lock(&idpf_adapter_lock);
        TAILQ_REMOVE(&idpf_adapter_list, adapter, next);
        rte_spinlock_unlock(&idpf_adapter_lock);
-       idpf_adapter_rel(adapter);
+       idpf_adapter_ext_deinit(adapter);
        rte_free(adapter);
 
        return 0;
diff --git a/drivers/net/idpf/idpf_ethdev.h b/drivers/net/idpf/idpf_ethdev.h
index 10b1542ba4..bfede6f4e3 100644
--- a/drivers/net/idpf/idpf_ethdev.h
+++ b/drivers/net/idpf/idpf_ethdev.h
@@ -31,8 +31,6 @@
 #define IDPF_RXQ_PER_GRP       1
 #define IDPF_RX_BUFQ_PER_GRP   2
 
-#define IDPF_CTLQ_ID           -1
-
 #define IDPF_DFLT_Q_VEC_NUM    1
 #define IDPF_DFLT_INTERVAL     16
 
-- 
2.26.2

Reply via email to