Implement meter object stats read function.

Signed-off-by: Jasvinder Singh <jasvinder.si...@intel.com>
---
 drivers/net/softnic/rte_eth_softnic_meter.c | 115 +++++++++++++++++++++++++++-
 1 file changed, 114 insertions(+), 1 deletion(-)

diff --git a/drivers/net/softnic/rte_eth_softnic_meter.c 
b/drivers/net/softnic/rte_eth_softnic_meter.c
index bc1f2ea..369f670 100644
--- a/drivers/net/softnic/rte_eth_softnic_meter.c
+++ b/drivers/net/softnic/rte_eth_softnic_meter.c
@@ -580,6 +580,119 @@ pmd_mtr_policer_actions_update(struct rte_eth_dev *dev,
        return 0;
 }
 
+/* MTR object stats read */
+static int
+pmd_mtr_stats_read(struct rte_eth_dev *dev,
+       uint32_t mtr_id,
+       struct rte_mtr_stats *stats,
+       uint64_t *stats_mask,
+       int clear,
+       struct rte_mtr_error *error)
+{
+       struct pmd_internals *p = dev->data->dev_private;
+       struct rte_table_action_mtr_counters counters;
+       struct rte_table_action_mtr_counters_tc *c;
+       struct rte_mtr_stats s;
+       struct softnic_table *table;
+       struct pipeline *pipeline;
+       struct softnic_mtr *m;
+       uint64_t mask = 0;
+       uint32_t i, tc_mask = 1 << 0;
+       int status;
+
+       /* MTR object id must be valid */
+       m = softnic_mtr_find(p, mtr_id);
+       if (m == NULL)
+               return -rte_mtr_error_set(error,
+                       EEXIST,
+                       RTE_MTR_ERROR_TYPE_MTR_ID,
+                       NULL,
+                       "MTR object id not valid");
+
+       /* MTR meter object owner valid? */
+       if (m->flow == NULL)
+               return 0;
+
+       /* Meter stats */
+       pipeline = m->flow->pipeline;
+       table = &pipeline->table[m->flow->table_id];
+
+       status = rte_table_action_meter_read(table->a,
+               m->flow->data,
+               tc_mask,
+               &counters,
+               clear);
+       if (status)
+               return -rte_mtr_error_set(error,
+                       EINVAL,
+                       RTE_MTR_ERROR_TYPE_UNSPECIFIED,
+                       NULL,
+                       "Meter stats read failed");
+
+       c = &counters.stats[0];
+       memset(&s, 0, sizeof(s));
+
+       if (c->n_packets_valid) {
+               for (i = 0; i < RTE_MTR_COLORS; i++) {
+                       if (m->params.action[i] == 
MTR_POLICER_ACTION_COLOR_GREEN)
+                               s.n_pkts[RTE_MTR_GREEN] += c->n_packets[i];
+
+                       if (m->params.action[i] == 
MTR_POLICER_ACTION_COLOR_YELLOW)
+                               s.n_pkts[RTE_MTR_YELLOW] += c->n_packets[i];
+
+                       if (m->params.action[i] == MTR_POLICER_ACTION_COLOR_RED)
+                               s.n_pkts[RTE_MTR_RED] += c->n_packets[i];
+
+                       if (m->params.action[i] == MTR_POLICER_ACTION_DROP)
+                               s.n_pkts_dropped += c->n_packets[i];
+               }
+
+               mask = RTE_MTR_STATS_N_PKTS_GREEN |
+                       RTE_MTR_STATS_N_PKTS_YELLOW |
+                       RTE_MTR_STATS_N_PKTS_RED |
+                       RTE_MTR_STATS_N_PKTS_DROPPED;
+       }
+
+       if (c->n_bytes_valid) {
+               for (i = 0; i < RTE_MTR_COLORS; i++) {
+                       if (m->params.action[i] == 
MTR_POLICER_ACTION_COLOR_GREEN)
+                               s.n_bytes[RTE_MTR_GREEN] += c->n_bytes[i];
+
+                       if (m->params.action[i] == 
MTR_POLICER_ACTION_COLOR_YELLOW)
+                               s.n_bytes[RTE_MTR_YELLOW] += c->n_bytes[i];
+
+                       if (m->params.action[i] == MTR_POLICER_ACTION_COLOR_RED)
+                               s.n_bytes[RTE_MTR_RED] += c->n_bytes[i];
+
+                       if (m->params.action[i] == MTR_POLICER_ACTION_DROP)
+                               s.n_bytes_dropped += c->n_bytes[i];
+               }
+
+               mask |= RTE_MTR_STATS_N_BYTES_GREEN |
+                       RTE_MTR_STATS_N_BYTES_YELLOW |
+                       RTE_MTR_STATS_N_BYTES_RED |
+                       RTE_MTR_STATS_N_BYTES_DROPPED;
+       }
+
+       /* Read */
+       if (stats) {
+               memset(stats, 0, sizeof(*stats));
+               memcpy(stats, &s, sizeof(*stats));
+       }
+
+       if (stats_mask) {
+               if (mask)
+                       *stats_mask = mask;
+               else
+                       *stats_mask = RTE_MTR_STATS_N_PKTS_GREEN |
+                               RTE_MTR_STATS_N_PKTS_YELLOW |
+                               RTE_MTR_STATS_N_PKTS_RED |
+                               RTE_MTR_STATS_N_PKTS_DROPPED;
+       }
+
+       return 0;
+}
+
 const struct rte_mtr_ops pmd_mtr_ops = {
        .capabilities_get = NULL,
 
@@ -596,5 +709,5 @@ const struct rte_mtr_ops pmd_mtr_ops = {
        .policer_actions_update = pmd_mtr_policer_actions_update,
        .stats_update = NULL,
 
-       .stats_read = NULL,
+       .stats_read = pmd_mtr_stats_read,
 };
-- 
2.9.3

Reply via email to