net/octeontx2: fix PTP and HIGIG2 coexistence
[dpdk.git] / drivers / net / octeontx2 / otx2_stats.c
index cba1228..8aaf270 100644 (file)
@@ -6,6 +6,45 @@
 
 #include "otx2_ethdev.h"
 
+struct otx2_nix_xstats_name {
+       char name[RTE_ETH_XSTATS_NAME_SIZE];
+       uint32_t offset;
+};
+
+static const struct otx2_nix_xstats_name nix_tx_xstats[] = {
+       {"tx_ucast", NIX_STAT_LF_TX_TX_UCAST},
+       {"tx_bcast", NIX_STAT_LF_TX_TX_BCAST},
+       {"tx_mcast", NIX_STAT_LF_TX_TX_MCAST},
+       {"tx_drop", NIX_STAT_LF_TX_TX_DROP},
+       {"tx_octs", NIX_STAT_LF_TX_TX_OCTS},
+};
+
+static const struct otx2_nix_xstats_name nix_rx_xstats[] = {
+       {"rx_octs", NIX_STAT_LF_RX_RX_OCTS},
+       {"rx_ucast", NIX_STAT_LF_RX_RX_UCAST},
+       {"rx_bcast", NIX_STAT_LF_RX_RX_BCAST},
+       {"rx_mcast", NIX_STAT_LF_RX_RX_MCAST},
+       {"rx_drop", NIX_STAT_LF_RX_RX_DROP},
+       {"rx_drop_octs", NIX_STAT_LF_RX_RX_DROP_OCTS},
+       {"rx_fcs", NIX_STAT_LF_RX_RX_FCS},
+       {"rx_err", NIX_STAT_LF_RX_RX_ERR},
+       {"rx_drp_bcast", NIX_STAT_LF_RX_RX_DRP_BCAST},
+       {"rx_drp_mcast", NIX_STAT_LF_RX_RX_DRP_MCAST},
+       {"rx_drp_l3bcast", NIX_STAT_LF_RX_RX_DRP_L3BCAST},
+       {"rx_drp_l3mcast", NIX_STAT_LF_RX_RX_DRP_L3MCAST},
+};
+
+static const struct otx2_nix_xstats_name nix_q_xstats[] = {
+       {"rq_op_re_pkts", NIX_LF_RQ_OP_RE_PKTS},
+};
+
+#define OTX2_NIX_NUM_RX_XSTATS RTE_DIM(nix_rx_xstats)
+#define OTX2_NIX_NUM_TX_XSTATS RTE_DIM(nix_tx_xstats)
+#define OTX2_NIX_NUM_QUEUE_XSTATS RTE_DIM(nix_q_xstats)
+
+#define OTX2_NIX_NUM_XSTATS_REG (OTX2_NIX_NUM_RX_XSTATS + \
+               OTX2_NIX_NUM_TX_XSTATS + OTX2_NIX_NUM_QUEUE_XSTATS)
+
 int
 otx2_nix_dev_stats_get(struct rte_eth_dev *eth_dev,
                       struct rte_eth_stats *stats)
@@ -92,14 +131,16 @@ otx2_nix_dev_stats_get(struct rte_eth_dev *eth_dev,
        return 0;
 }
 
-void
+int
 otx2_nix_dev_stats_reset(struct rte_eth_dev *eth_dev)
 {
        struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
        struct otx2_mbox *mbox = dev->mbox;
 
-       otx2_mbox_alloc_msg_nix_stats_rst(mbox);
-       otx2_mbox_process(mbox);
+       if (otx2_mbox_alloc_msg_nix_stats_rst(mbox) == NULL)
+               return -ENOMEM;
+
+       return otx2_mbox_process(mbox);
 }
 
 int
@@ -115,3 +156,241 @@ otx2_nix_queue_stats_mapping(struct rte_eth_dev *eth_dev, uint16_t queue_id,
 
        return 0;
 }
+
+int
+otx2_nix_xstats_get(struct rte_eth_dev *eth_dev,
+                   struct rte_eth_xstat *xstats,
+                   unsigned int n)
+{
+       struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
+       unsigned int i, count = 0;
+       uint64_t reg, val;
+
+       if (n < OTX2_NIX_NUM_XSTATS_REG)
+               return OTX2_NIX_NUM_XSTATS_REG;
+
+       if (xstats == NULL)
+               return 0;
+
+       for (i = 0; i < OTX2_NIX_NUM_TX_XSTATS; i++) {
+               xstats[count].value = otx2_read64(dev->base +
+               NIX_LF_TX_STATX(nix_tx_xstats[i].offset));
+               xstats[count].id = count;
+               count++;
+       }
+
+       for (i = 0; i < OTX2_NIX_NUM_RX_XSTATS; i++) {
+               xstats[count].value = otx2_read64(dev->base +
+               NIX_LF_RX_STATX(nix_rx_xstats[i].offset));
+               xstats[count].id = count;
+               count++;
+       }
+
+       for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
+               reg = (((uint64_t)i) << 32);
+               val = otx2_atomic64_add_nosync(reg, (int64_t *)(dev->base +
+                                              nix_q_xstats[0].offset));
+               if (val & OP_ERR)
+                       val = 0;
+               xstats[count].value += val;
+       }
+       xstats[count].id = count;
+       count++;
+
+       return count;
+}
+
+int
+otx2_nix_xstats_get_names(struct rte_eth_dev *eth_dev,
+                         struct rte_eth_xstat_name *xstats_names,
+                         unsigned int limit)
+{
+       unsigned int i, count = 0;
+
+       RTE_SET_USED(eth_dev);
+
+       if (limit < OTX2_NIX_NUM_XSTATS_REG && xstats_names != NULL)
+               return -ENOMEM;
+
+       if (xstats_names) {
+               for (i = 0; i < OTX2_NIX_NUM_TX_XSTATS; i++) {
+                       snprintf(xstats_names[count].name,
+                                sizeof(xstats_names[count].name),
+                                "%s", nix_tx_xstats[i].name);
+                       count++;
+               }
+
+               for (i = 0; i < OTX2_NIX_NUM_RX_XSTATS; i++) {
+                       snprintf(xstats_names[count].name,
+                                sizeof(xstats_names[count].name),
+                                "%s", nix_rx_xstats[i].name);
+                       count++;
+               }
+
+               for (i = 0; i < OTX2_NIX_NUM_QUEUE_XSTATS; i++) {
+                       snprintf(xstats_names[count].name,
+                                sizeof(xstats_names[count].name),
+                                "%s", nix_q_xstats[i].name);
+                       count++;
+               }
+       }
+
+       return OTX2_NIX_NUM_XSTATS_REG;
+}
+
+int
+otx2_nix_xstats_get_names_by_id(struct rte_eth_dev *eth_dev,
+                               struct rte_eth_xstat_name *xstats_names,
+                               const uint64_t *ids, unsigned int limit)
+{
+       struct rte_eth_xstat_name xstats_names_copy[OTX2_NIX_NUM_XSTATS_REG];
+       uint16_t i;
+
+       if (limit < OTX2_NIX_NUM_XSTATS_REG && ids == NULL)
+               return OTX2_NIX_NUM_XSTATS_REG;
+
+       if (limit > OTX2_NIX_NUM_XSTATS_REG)
+               return -EINVAL;
+
+       if (xstats_names == NULL)
+               return -ENOMEM;
+
+       otx2_nix_xstats_get_names(eth_dev, xstats_names_copy, limit);
+
+       for (i = 0; i < OTX2_NIX_NUM_XSTATS_REG; i++) {
+               if (ids[i] >= OTX2_NIX_NUM_XSTATS_REG) {
+                       otx2_err("Invalid id value");
+                       return -EINVAL;
+               }
+               strncpy(xstats_names[i].name, xstats_names_copy[ids[i]].name,
+                       sizeof(xstats_names[i].name));
+       }
+
+       return limit;
+}
+
+int
+otx2_nix_xstats_get_by_id(struct rte_eth_dev *eth_dev, const uint64_t *ids,
+                         uint64_t *values, unsigned int n)
+{
+       struct rte_eth_xstat xstats[OTX2_NIX_NUM_XSTATS_REG];
+       uint16_t i;
+
+       if (n < OTX2_NIX_NUM_XSTATS_REG && ids == NULL)
+               return OTX2_NIX_NUM_XSTATS_REG;
+
+       if (n > OTX2_NIX_NUM_XSTATS_REG)
+               return -EINVAL;
+
+       if (values == NULL)
+               return -ENOMEM;
+
+       otx2_nix_xstats_get(eth_dev, xstats, n);
+
+       for (i = 0; i < OTX2_NIX_NUM_XSTATS_REG; i++) {
+               if (ids[i] >= OTX2_NIX_NUM_XSTATS_REG) {
+                       otx2_err("Invalid id value");
+                       return -EINVAL;
+               }
+               values[i] = xstats[ids[i]].value;
+       }
+
+       return n;
+}
+
+static int
+nix_queue_stats_reset(struct rte_eth_dev *eth_dev)
+{
+       struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
+       struct otx2_mbox *mbox = dev->mbox;
+       struct nix_aq_enq_rsp *rsp;
+       struct nix_aq_enq_req *aq;
+       uint32_t i;
+       int rc;
+
+       for (i = 0; i < eth_dev->data->nb_rx_queues; i++) {
+               aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
+               aq->qidx = i;
+               aq->ctype = NIX_AQ_CTYPE_RQ;
+               aq->op = NIX_AQ_INSTOP_READ;
+               rc = otx2_mbox_process_msg(mbox, (void *)&rsp);
+               if (rc) {
+                       otx2_err("Failed to read rq context");
+                       return rc;
+               }
+               aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
+               aq->qidx = i;
+               aq->ctype = NIX_AQ_CTYPE_RQ;
+               aq->op = NIX_AQ_INSTOP_WRITE;
+               otx2_mbox_memcpy(&aq->rq, &rsp->rq, sizeof(rsp->rq));
+               otx2_mbox_memset(&aq->rq_mask, 0, sizeof(aq->rq_mask));
+               aq->rq.octs = 0;
+               aq->rq.pkts = 0;
+               aq->rq.drop_octs = 0;
+               aq->rq.drop_pkts = 0;
+               aq->rq.re_pkts = 0;
+
+               aq->rq_mask.octs = ~(aq->rq_mask.octs);
+               aq->rq_mask.pkts = ~(aq->rq_mask.pkts);
+               aq->rq_mask.drop_octs = ~(aq->rq_mask.drop_octs);
+               aq->rq_mask.drop_pkts = ~(aq->rq_mask.drop_pkts);
+               aq->rq_mask.re_pkts = ~(aq->rq_mask.re_pkts);
+               rc = otx2_mbox_process(mbox);
+               if (rc) {
+                       otx2_err("Failed to write rq context");
+                       return rc;
+               }
+       }
+
+       for (i = 0; i < eth_dev->data->nb_tx_queues; i++) {
+               aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
+               aq->qidx = i;
+               aq->ctype = NIX_AQ_CTYPE_SQ;
+               aq->op = NIX_AQ_INSTOP_READ;
+               rc = otx2_mbox_process_msg(mbox, (void *)&rsp);
+               if (rc) {
+                       otx2_err("Failed to read sq context");
+                       return rc;
+               }
+               aq = otx2_mbox_alloc_msg_nix_aq_enq(mbox);
+               aq->qidx = i;
+               aq->ctype = NIX_AQ_CTYPE_SQ;
+               aq->op = NIX_AQ_INSTOP_WRITE;
+               otx2_mbox_memcpy(&aq->sq, &rsp->sq, sizeof(rsp->sq));
+               otx2_mbox_memset(&aq->sq_mask, 0, sizeof(aq->sq_mask));
+               aq->sq.octs = 0;
+               aq->sq.pkts = 0;
+               aq->sq.drop_octs = 0;
+               aq->sq.drop_pkts = 0;
+
+               aq->sq_mask.octs = ~(aq->sq_mask.octs);
+               aq->sq_mask.pkts = ~(aq->sq_mask.pkts);
+               aq->sq_mask.drop_octs = ~(aq->sq_mask.drop_octs);
+               aq->sq_mask.drop_pkts = ~(aq->sq_mask.drop_pkts);
+               rc = otx2_mbox_process(mbox);
+               if (rc) {
+                       otx2_err("Failed to write sq context");
+                       return rc;
+               }
+       }
+
+       return 0;
+}
+
+int
+otx2_nix_xstats_reset(struct rte_eth_dev *eth_dev)
+{
+       struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
+       struct otx2_mbox *mbox = dev->mbox;
+       int ret;
+
+       if (otx2_mbox_alloc_msg_nix_stats_rst(mbox) == NULL)
+               return -ENOMEM;
+
+       ret = otx2_mbox_process(mbox);
+       if (ret != 0)
+               return ret;
+
+       /* Reset queue stats */
+       return nix_queue_stats_reset(eth_dev);
+}