From: Gagandeep Singh <[email protected]>

For default RSS distribution, the mbuf is marked with
RTE_MBUF_F_RX_RSS_HASH and the hash value is taken from the high
word of FLC.

Configure flow steering actions with FLC enabled to align the
stashing settings with the RSS configuration. The TC ID and flow ID
are packed into the FLC low word by the hardware. An Rx mbuf received
from the FS table has the FS_MARK bit set in the FLC low word; such
mbufs are marked with RTE_MBUF_F_RX_FDIR and the TC and flow ID are
encoded in hash.fdir.hi.

Signed-off-by: Gagandeep Singh <[email protected]>
---
 drivers/net/dpaa2/dpaa2_ethdev.h | 12 +++++++++
 drivers/net/dpaa2/dpaa2_flow.c   | 42 ++++++++++++++++++++++++++++++++
 drivers/net/dpaa2/dpaa2_rxtx.c   | 18 ++++++++++++--
 3 files changed, 70 insertions(+), 2 deletions(-)

diff --git a/drivers/net/dpaa2/dpaa2_ethdev.h b/drivers/net/dpaa2/dpaa2_ethdev.h
index 149954fb6b..2569b2bd83 100644
--- a/drivers/net/dpaa2/dpaa2_ethdev.h
+++ b/drivers/net/dpaa2/dpaa2_ethdev.h
@@ -282,6 +282,18 @@ enum dpaa2_ecpri_fafe_type {
 /* ECPRI shares SP context with VXLAN*/
 #define DPAA2_ECPRI_MSG_OFFSET DPAA2_VXLAN_VNI_OFFSET
 
+#define DPAA2_FS_FLC_FS_MARK_OFFSET \
+       (DPAA2_FLC_DATA_STASHING + DPAA2_FLC_STASHING_MAX_BIT_SIZE)
+
+#define DPAA2_FS_FLC_TC_OFFSET \
+       (DPAA2_FS_FLC_FS_MARK_OFFSET + DPAA2_FLC_STASHING_MAX_BIT_SIZE)
+
+#define DPAA2_FS_FLC_TC_BIT_SIZE (sizeof(uint8_t) * 8)
+#define DPAA2_FS_FLC_TC_MASK ((1 << DPAA2_FS_FLC_TC_BIT_SIZE) - 1)
+
+#define DPAA2_FS_FLC_FLOW_OFFSET \
+       (DPAA2_FS_FLC_TC_OFFSET + DPAA2_FS_FLC_TC_BIT_SIZE)
+
 #define DPAA2_ECPRI_MAX_EXTRACT_NB 8
 
 struct ipv4_sd_addr_extract_rule {
diff --git a/drivers/net/dpaa2/dpaa2_flow.c b/drivers/net/dpaa2/dpaa2_flow.c
index 48f2861f83..4f7716ab66 100644
--- a/drivers/net/dpaa2/dpaa2_flow.c
+++ b/drivers/net/dpaa2/dpaa2_flow.c
@@ -4383,6 +4383,13 @@ dpaa2_flow_verify_action(struct dpaa2_dev_priv *priv,
                switch (actions[j].type) {
                case RTE_FLOW_ACTION_TYPE_QUEUE:
                        dest_queue = actions[j].conf;
+                       if (dest_queue->index >= MAX_RX_QUEUES ||
+                               !priv->rx_vq[dest_queue->index]) {
+                               DPAA2_PMD_ERR("Invalid FSQ index(%d)",
+                                       dest_queue->index);
+
+                               return -EINVAL;
+                       }
                        rxq = priv->rx_vq[dest_queue->index];
                        if (attr->group != rxq->tc_index) {
                                DPAA2_PMD_ERR("FSQ(%d.%d) not in TC[%d]",
@@ -4445,6 +4452,7 @@ dpaa2_configure_flow_fs_action(struct dpaa2_dev_priv 
*priv,
        struct dpaa2_dev_priv *dest_priv;
        const struct rte_flow_action_queue *dest_queue;
        struct dpaa2_queue *dest_q;
+       uint64_t flc = 0;
 
        memset(&flow->fs_action_cfg, 0,
                sizeof(struct dpni_fs_action_cfg));
@@ -4452,7 +4460,41 @@ dpaa2_configure_flow_fs_action(struct dpaa2_dev_priv 
*priv,
 
        if (flow->action_type == RTE_FLOW_ACTION_TYPE_QUEUE) {
                dest_queue = rte_action->conf;
+               if (dest_queue->index >= MAX_RX_QUEUES ||
+                       !priv->rx_vq[dest_queue->index]) {
+                       DPAA2_PMD_ERR("Invalid FSQ index(%d)",
+                               dest_queue->index);
+
+                       return -EINVAL;
+               }
                dest_q = priv->rx_vq[dest_queue->index];
+               if (flow->tc_id != dest_q->tc_index) {
+                       DPAA2_PMD_ERR("RXQ[%d](%d.%d) not in TC[%d]",
+                               dest_queue->index,
+                               dest_q->tc_index, dest_q->flow_id,
+                               flow->tc_id);
+
+                       return -EINVAL;
+               }
+               flow->fs_action_cfg.options =
+                       DPNI_FS_OPT_SET_FLC | DPNI_FS_OPT_SET_STASH_CONTROL;
+
+               if (dest_q->data_stashing_off) {
+                       dpaa2_flc_stashing_set(DPAA2_FLC_DATA_STASHING,
+                               0, &flc);
+               } else {
+                       dpaa2_flc_stashing_set(DPAA2_FLC_DATA_STASHING,
+                               1, &flc);
+               }
+               if ((dpaa2_svr_family & 0xffff0000) != SVR_LX2160A) {
+                       dpaa2_flc_stashing_set(DPAA2_FLC_ANNO_STASHING,
+                               1, &flc);
+               }
+
+               flc |= ((uint64_t)1) << DPAA2_FS_FLC_FS_MARK_OFFSET;
+               flc |= ((uint64_t)dest_q->tc_index) << DPAA2_FS_FLC_TC_OFFSET;
+               flc |= ((uint64_t)dest_q->flow_id) << DPAA2_FS_FLC_FLOW_OFFSET;
+               flow->fs_action_cfg.flc = flc;
                flow->fs_action_cfg.flow_id = dest_q->flow_id;
        } else if (flow->action_type == RTE_FLOW_ACTION_TYPE_PORT_ID ||
                   flow->action_type == RTE_FLOW_ACTION_TYPE_REPRESENTED_PORT) {
diff --git a/drivers/net/dpaa2/dpaa2_rxtx.c b/drivers/net/dpaa2/dpaa2_rxtx.c
index c31d6556ad..71e292fea6 100644
--- a/drivers/net/dpaa2/dpaa2_rxtx.c
+++ b/drivers/net/dpaa2/dpaa2_rxtx.c
@@ -58,6 +58,7 @@ dpaa2_dev_rx_parse_new(struct rte_mbuf *m, const struct 
qbman_fd *fd,
        uint16_t frc = DPAA2_GET_FD_FRC_PARSE_SUM(fd);
        struct dpaa2_annot_hdr *annotation =
                        (struct dpaa2_annot_hdr *)hw_annot_addr;
+       uint32_t flc_lo, tc, flow;
 
        if (unlikely(dpaa2_print_parser_result))
                dpaa2_print_parse_result(annotation);
@@ -118,8 +119,21 @@ dpaa2_dev_rx_parse_new(struct rte_mbuf *m, const struct 
qbman_fd *fd,
        default:
                m->packet_type = dpaa2_dev_rx_parse_slow(m, annotation);
        }
-       m->hash.rss = fd->simple.flc_hi;
-       m->ol_flags |= RTE_MBUF_F_RX_RSS_HASH;
+       flc_lo = fd->simple.flc_lo;
+       if (flc_lo & (1 << DPAA2_FS_FLC_FS_MARK_OFFSET)) {
+               tc = (flc_lo >> DPAA2_FS_FLC_TC_OFFSET) &
+                       DPAA2_FS_FLC_TC_MASK;
+               flow = flc_lo >> DPAA2_FS_FLC_FLOW_OFFSET;
+               m->ol_flags |= RTE_MBUF_F_RX_FDIR;
+               m->hash.fdir.hi = (tc << 16) | flow;
+               DPAA2_PMD_DP_DEBUG("FS frame received from TC[%d]->flow%d",
+                       tc, flow);
+       } else {
+               m->hash.rss = fd->simple.flc_hi;
+               m->ol_flags |= RTE_MBUF_F_RX_RSS_HASH;
+               DPAA2_PMD_DP_DEBUG("Hash frame received with RSS(%08x)",
+                       m->hash.rss);
+       }
 
        if (dpaa2_enable_ts[m->port]) {
                *dpaa2_timestamp_dynfield(m) = annotation->word2;
-- 
2.43.0

Reply via email to