Implement stat values clean operation by agent channel.

Signed-off-by: Bingbin Chen <chen.bingbin@zte.com.cn>
---
 drivers/net/zxdh/zxdh_ethdev_ops.c |   4 +
 drivers/net/zxdh/zxdh_np.c         | 344 +++++++++++++++++++++++++++++
 drivers/net/zxdh/zxdh_np.h         |  23 +-
 3 files changed, 370 insertions(+), 1 deletion(-)

diff --git a/drivers/net/zxdh/zxdh_ethdev_ops.c b/drivers/net/zxdh/zxdh_ethdev_ops.c
index 1a21ded58e..284bf27d10 100644
--- a/drivers/net/zxdh/zxdh_ethdev_ops.c
+++ b/drivers/net/zxdh/zxdh_ethdev_ops.c
@@ -1500,11 +1500,15 @@ static int zxdh_hw_stats_reset(struct rte_eth_dev *dev, enum zxdh_agent_msg_type
 int zxdh_dev_stats_reset(struct rte_eth_dev *dev)
 {
     struct zxdh_hw *hw = dev->data->dev_private;
+    uint64_t stats_data;
 
     zxdh_hw_stats_reset(dev, ZXDH_VQM_DEV_STATS_RESET);
     if (hw->is_pf)
         zxdh_hw_stats_reset(dev, ZXDH_MAC_STATS_RESET);
 
+    zxdh_np_stat_ppu_cnt_get_ex(0, ZXDH_STAT_64_MODE, 0,
+        ZXDH_STAT_RD_CLR_MODE_CLR, (uint32_t *)&stats_data);
+
     return 0;
 }
 
diff --git a/drivers/net/zxdh/zxdh_np.c b/drivers/net/zxdh/zxdh_np.c
index 9de3e2f406..e4d360c8f5 100644
--- a/drivers/net/zxdh/zxdh_np.c
+++ b/drivers/net/zxdh/zxdh_np.c
@@ -3420,6 +3420,37 @@ zxdh_np_reg_read(uint32_t dev_id, uint32_t reg_no,
     return rc;
 }
 
+static uint32_t
+zxdh_np_reg_read32(uint32_t dev_id, uint32_t reg_no,
+    uint32_t m_offset, uint32_t n_offset, uint32_t *p_data)
+{
+    uint32_t rc = 0;
+    uint32_t addr = 0;
+    uint32_t reg_type = 0;
+    uint32_t reg_module = 0;
+    ZXDH_REG_T *p_reg_info = NULL;
+    uint32_t p_buff[ZXDH_REG_DATA_MAX] = {0};
+    uint32_t reg_real_no = 0;
+
+    p_reg_info = &g_dpp_reg_info[reg_no];
+    reg_module = p_reg_info->module_no;
+    reg_type = p_reg_info->flags;
+    reg_real_no = p_reg_info->reg_no;
+
+    addr = zxdh_np_reg_get_reg_addr(reg_no, m_offset, n_offset);
+
+    if (reg_module == DTB4K) {
+        rc = p_reg_info->p_read_fun(dev_id, addr, p_data);
+        ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "p_reg_info->p_read_fun");
+    } else {
+        rc = zxdh_np_agent_channel_reg_read(dev_id, reg_type, reg_real_no, 4, addr, p_buff);
+        ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_agent_channel_reg_read");
+        *p_data = p_buff[0];
+    }
+
+    return rc;
+}
+
 static uint32_t
 zxdh_np_dtb_queue_vm_info_get(uint32_t dev_id,
         uint32_t queue_id,
@@ -10678,3 +10709,316 @@ zxdh_np_dtb_hash_offline_delete(uint32_t dev_id,
 
     return rc;
 }
+
+static uint32_t
+zxdh_np_se_done_status_check(uint32_t dev_id, uint32_t reg_no, uint32_t pos)
+{
+    uint32_t rc = ZXDH_OK;
+
+    uint32_t data = 0;
+    uint32_t rd_cnt = 0;
+    uint32_t done_flag = 0;
+
+    while (!done_flag) {
+        rc = zxdh_np_reg_read32(dev_id, reg_no, 0, 0, &data);
+        if (rc != ZXDH_OK) {
+            PMD_DRV_LOG(ERR, " [ErrorCode:0x%x] !-- zxdh_np_reg_read32 Fail!", rc);
+            return rc;
+        }
+
+        done_flag = (data >> pos) & 0x1;
+
+        if (done_flag)
+            break;
+
+        if (rd_cnt > ZXDH_RD_CNT_MAX * ZXDH_RD_CNT_MAX)
+            return ZXDH_ERR;
+
+        rd_cnt++;
+    }
+
+    return rc;
+}
+
+static uint32_t
+zxdh_np_se_smmu0_ind_read(uint32_t dev_id,
+                        uint32_t base_addr,
+                        uint32_t index,
+                        uint32_t rd_mode,
+                        uint32_t rd_clr_mode,
+                        uint32_t *p_data)
+{
+    uint32_t rc = ZXDH_OK;
+    uint32_t i = 0;
+    uint32_t row_index = 0;
+    uint32_t col_index = 0;
+    uint32_t temp_data[4] = {0};
+    uint32_t *p_temp_data = NULL;
+    ZXDH_SMMU0_SMMU0_CPU_IND_CMD_T cpu_ind_cmd = {0};
+    ZXDH_MUTEX_T *p_ind_mutex = NULL;
+
+    rc = zxdh_np_dev_opr_mutex_get(dev_id, ZXDH_DEV_MUTEX_T_SMMU0, &p_ind_mutex);
+    ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_dev_opr_mutex_get");
+
+    rc = zxdh_np_comm_mutex_lock(p_ind_mutex);
+    ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_lock");
+
+    rc = zxdh_np_se_done_status_check(dev_id, ZXDH_SMMU0_SMMU0_WR_ARB_CPU_RDYR, 0);
+    ZXDH_COMM_CHECK_DEV_RC_UNLOCK(dev_id, rc, "zxdh_np_se_done_status_check", p_ind_mutex);
+
+    if (rd_clr_mode == ZXDH_RD_MODE_HOLD) {
+        cpu_ind_cmd.cpu_ind_rw = ZXDH_SE_OPR_RD;
+        cpu_ind_cmd.cpu_ind_rd_mode = ZXDH_RD_MODE_HOLD;
+        cpu_ind_cmd.cpu_req_mode = ZXDH_ERAM128_OPR_128b;
+
+        switch (rd_mode) {
+        case ZXDH_ERAM128_OPR_128b:
+        {
+            if ((0xFFFFFFFF - (base_addr)) < (index)) {
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                PMD_DRV_LOG(ERR, "%s : index 0x%x is invalid!", __func__, index);
+                return ZXDH_PAR_CHK_INVALID_INDEX;
+            }
+            if (base_addr + index > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = (index << 7) & ZXDH_ERAM128_BADDR_MASK;
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_64b:
+        {
+            if ((base_addr + (index >> 1)) > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = (index << 6) & ZXDH_ERAM128_BADDR_MASK;
+            col_index = index & 0x1;
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_32b:
+        {
+            if ((base_addr + (index >> 2)) > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = (index << 5) & ZXDH_ERAM128_BADDR_MASK;
+            col_index = index & 0x3;
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_1b:
+        {
+            if ((base_addr + (index >> 7)) > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = index & ZXDH_ERAM128_BADDR_MASK;
+            col_index = index & 0x7F;
+            break;
+        }
+        }
+
+        cpu_ind_cmd.cpu_ind_addr = ((base_addr << 7) & ZXDH_ERAM128_BADDR_MASK) + row_index;
+    } else {
+        cpu_ind_cmd.cpu_ind_rw = ZXDH_SE_OPR_RD;
+        cpu_ind_cmd.cpu_ind_rd_mode = ZXDH_RD_MODE_CLEAR;
+
+        switch (rd_mode) {
+        case ZXDH_ERAM128_OPR_128b:
+        {
+            if ((0xFFFFFFFF - (base_addr)) < (index)) {
+                PMD_DRV_LOG(ERR, "%s : index 0x%x is invalid!", __func__, index);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_PAR_CHK_INVALID_INDEX;
+            }
+
+            if (base_addr + index > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = (index << 7);
+            cpu_ind_cmd.cpu_req_mode = ZXDH_ERAM128_OPR_128b;
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_64b:
+        {
+            if ((base_addr + (index >> 1)) > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = (index << 6);
+            cpu_ind_cmd.cpu_req_mode = 2;
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_32b:
+        {
+            if ((base_addr + (index >> 2)) > ZXDH_SE_SMMU0_ERAM_ADDR_NUM_TOTAL - 1) {
+                PMD_DRV_LOG(ERR, "%s : index out of range !", __func__);
+                rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+                ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+                return ZXDH_ERR;
+            }
+
+            row_index = (index << 5);
+            cpu_ind_cmd.cpu_req_mode = 1;
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_1b:
+        {
+            PMD_DRV_LOG(ERR, "rd_clr_mode[%d] or rd_mode[%d] error! ",
+                rd_clr_mode, rd_mode);
+            rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+            ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+            RTE_ASSERT(0);
+            return ZXDH_ERR;
+        }
+        }
+
+        cpu_ind_cmd.cpu_ind_addr = ((base_addr << 7) & ZXDH_ERAM128_BADDR_MASK) + row_index;
+    }
+
+    rc = zxdh_np_reg_write(dev_id,
+                        ZXDH_SMMU0_SMMU0_CPU_IND_CMDR,
+                        0,
+                        0,
+                        &cpu_ind_cmd);
+    ZXDH_COMM_CHECK_DEV_RC_UNLOCK(dev_id, rc, "zxdh_np_reg_write", p_ind_mutex);
+
+    rc = zxdh_np_se_done_status_check(dev_id, ZXDH_SMMU0_SMMU0_CPU_IND_RD_DONER, 0);
+    ZXDH_COMM_CHECK_DEV_RC_UNLOCK(dev_id, rc,
+        "zxdh_np_se_done_status_check", p_ind_mutex);
+
+    p_temp_data = temp_data;
+    for (i = 0; i < 4; i++) {
+        rc = zxdh_np_reg_read(dev_id,
+                            ZXDH_SMMU0_SMMU0_CPU_IND_RDAT0R + i,
+                            0,
+                            0,
+                            p_temp_data + 3 - i);
+        ZXDH_COMM_CHECK_DEV_RC_UNLOCK(dev_id, rc, "zxdh_np_reg_read", p_ind_mutex);
+    }
+
+    if (rd_clr_mode == ZXDH_RD_MODE_HOLD) {
+        switch (rd_mode) {
+        case ZXDH_ERAM128_OPR_128b:
+        {
+            rte_memcpy(p_data, p_temp_data, (128 / 8));
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_64b:
+        {
+            rte_memcpy(p_data, p_temp_data + ((1 - col_index) << 1), (64 / 8));
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_32b:
+        {
+            rte_memcpy(p_data, p_temp_data + ((3 - col_index)), (32 / 8));
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_1b:
+        {
+            ZXDH_COMM_UINT32_GET_BITS(p_data[0],
+                *(p_temp_data + (3 - col_index / 32)), (col_index % 32), 1);
+            break;
+        }
+        }
+    } else {
+        switch (rd_mode) {
+        case ZXDH_ERAM128_OPR_128b:
+        {
+            rte_memcpy(p_data, p_temp_data, (128 / 8));
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_64b:
+        {
+            rte_memcpy(p_data, p_temp_data, (64 / 8));
+            break;
+        }
+
+        case ZXDH_ERAM128_OPR_32b:
+        {
+            rte_memcpy(p_data, p_temp_data, (64 / 8));
+            break;
+        }
+        }
+    }
+
+    rc = zxdh_np_comm_mutex_unlock(p_ind_mutex);
+    ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_comm_mutex_unlock");
+
+    return rc;
+}
+
+uint32_t
+zxdh_np_stat_ppu_cnt_get_ex(uint32_t dev_id,
+                ZXDH_STAT_CNT_MODE_E rd_mode,
+                uint32_t index,
+                uint32_t clr_mode,
+                uint32_t *p_data)
+{
+    uint32_t rc = ZXDH_OK;
+    uint32_t ppu_eram_baddr = 0;
+    uint32_t ppu_eram_depth = 0;
+    uint32_t eram_rd_mode   = 0;
+    uint32_t eram_clr_mode  = 0;
+    ZXDH_PPU_STAT_CFG_T stat_cfg = {0};
+
+    zxdh_np_stat_cfg_soft_get(dev_id, &stat_cfg);
+
+    ppu_eram_depth = stat_cfg.eram_depth;
+    ppu_eram_baddr = stat_cfg.eram_baddr;
+
+    if ((index >> (ZXDH_STAT_128_MODE - rd_mode)) < ppu_eram_depth) {
+        if (rd_mode == ZXDH_STAT_128_MODE)
+            eram_rd_mode = ZXDH_ERAM128_OPR_128b;
+        else
+            eram_rd_mode = ZXDH_ERAM128_OPR_64b;
+
+        if (clr_mode == ZXDH_STAT_RD_CLR_MODE_UNCLR)
+            eram_clr_mode = ZXDH_RD_MODE_HOLD;
+        else
+            eram_clr_mode = ZXDH_RD_MODE_CLEAR;
+
+        rc = zxdh_np_se_smmu0_ind_read(dev_id,
+                                    ppu_eram_baddr,
+                                    index,
+                                    eram_rd_mode,
+                                    eram_clr_mode,
+                                    p_data);
+        ZXDH_COMM_CHECK_DEV_RC(dev_id, rc, "zxdh_np_se_smmu0_ind_read");
+    } else {
+        PMD_DRV_LOG(ERR, "DPDK DONT HAVE DDR STAT.");
+    }
+
+    return rc;
+}
diff --git a/drivers/net/zxdh/zxdh_np.h b/drivers/net/zxdh/zxdh_np.h
index 08a9b3c3a6..bcb4699c6f 100644
--- a/drivers/net/zxdh/zxdh_np.h
+++ b/drivers/net/zxdh/zxdh_np.h
@@ -1188,6 +1188,12 @@ typedef struct zxdh_dtb4k_dtb_enq_cfg_epid_v_func_num_0_127_t {
     uint32_t cfg_vfunc_active;
 } ZXDH_DTB4K_DTB_ENQ_CFG_EPID_V_FUNC_NUM_0_127_T;
 
+typedef struct zxdh_smmu0_smmu0_cpu_ind_cmd_t {
+    uint32_t cpu_ind_rw;
+    uint32_t cpu_ind_rd_mode;
+    uint32_t cpu_req_mode;
+    uint32_t cpu_ind_addr;
+} ZXDH_SMMU0_SMMU0_CPU_IND_CMD_T;
 
 typedef uint32_t (*ZXDH_REG_WRITE)(uint32_t dev_id, uint32_t addr, uint32_t *p_data);
 typedef uint32_t (*ZXDH_REG_READ)(uint32_t dev_id, uint32_t addr, uint32_t *p_data);
@@ -1498,6 +1504,17 @@ typedef enum zxdh_stat_cnt_mode_e {
     ZXDH_STAT_MAX_MODE,
 } ZXDH_STAT_CNT_MODE_E;
 
+typedef enum zxdh_stat_rd_clr_mode_e {
+    ZXDH_STAT_RD_CLR_MODE_UNCLR = 0,
+    ZXDH_STAT_RD_CLR_MODE_CLR   = 1,
+    ZXDH_STAT_RD_CLR_MODE_MAX,
+} STAT_RD_CLR_MODE_E;
+
+typedef enum zxdh_eram128_rd_clr_mode_e {
+    ZXDH_RD_MODE_HOLD   = 0,
+    ZXDH_RD_MODE_CLEAR  = 1,
+} ZXDH_ERAM128_RD_CLR_MODE_E;
+
 typedef enum zxdh_np_agent_msg_type_e {
     ZXDH_REG_MSG = 0,
     ZXDH_DTB_MSG,
@@ -1741,5 +1758,9 @@ uint32_t zxdh_np_dtb_hash_offline_delete(uint32_t dev_id,
                         uint32_t queue_id,
                         uint32_t sdt_no,
                         __rte_unused uint32_t flush_mode);
-
+uint32_t zxdh_np_stat_ppu_cnt_get_ex(uint32_t dev_id,
+                        ZXDH_STAT_CNT_MODE_E rd_mode,
+                        uint32_t index,
+                        uint32_t clr_mode,
+                        uint32_t *p_data);
 #endif /* ZXDH_NP_H */
-- 
2.27.0