net/cnxk: get PTP status
[dpdk.git] / drivers / net / cnxk / cn9k_rx.h
index 92f3c7c..f4b3282 100644 (file)
@@ -6,12 +6,14 @@
 #define __CN9K_RX_H__
 
 #include <rte_ether.h>
+#include <rte_vect.h>
 
 #define NIX_RX_OFFLOAD_NONE         (0)
 #define NIX_RX_OFFLOAD_RSS_F        BIT(0)
 #define NIX_RX_OFFLOAD_PTYPE_F      BIT(1)
 #define NIX_RX_OFFLOAD_CHECKSUM_F    BIT(2)
 #define NIX_RX_OFFLOAD_MARK_UPDATE_F BIT(3)
+#define NIX_RX_OFFLOAD_TSTAMP_F             BIT(4)
 
 /* Flags to control cqe_to_mbuf conversion function.
  * Defining it from backwards to denote its been
@@ -103,6 +105,53 @@ nix_update_match_id(const uint16_t match_id, uint64_t ol_flags,
        return ol_flags;
 }
 
+static __rte_always_inline void
+nix_cqe_xtract_mseg(const union nix_rx_parse_u *rx, struct rte_mbuf *mbuf,
+                   uint64_t rearm)
+{
+       const rte_iova_t *iova_list;
+       struct rte_mbuf *head;
+       const rte_iova_t *eol;
+       uint8_t nb_segs;
+       uint64_t sg;
+
+       sg = *(const uint64_t *)(rx + 1);
+       nb_segs = (sg >> 48) & 0x3;
+       mbuf->nb_segs = nb_segs;
+       mbuf->data_len = sg & 0xFFFF;
+       sg = sg >> 16;
+
+       eol = ((const rte_iova_t *)(rx + 1) +
+              ((rx->cn9k.desc_sizem1 + 1) << 1));
+       /* Skip SG_S and first IOVA*/
+       iova_list = ((const rte_iova_t *)(rx + 1)) + 2;
+       nb_segs--;
+
+       rearm = rearm & ~0xFFFF;
+
+       head = mbuf;
+       while (nb_segs) {
+               mbuf->next = ((struct rte_mbuf *)*iova_list) - 1;
+               mbuf = mbuf->next;
+
+               __mempool_check_cookies(mbuf->pool, (void **)&mbuf, 1, 1);
+
+               mbuf->data_len = sg & 0xFFFF;
+               sg = sg >> 16;
+               *(uint64_t *)(&mbuf->rearm_data) = rearm;
+               nb_segs--;
+               iova_list++;
+
+               if (!nb_segs && (iova_list + 1 < eol)) {
+                       sg = *(const uint64_t *)(iova_list);
+                       nb_segs = (sg >> 48) & 0x3;
+                       head->nb_segs += nb_segs;
+                       iova_list = (const rte_iova_t *)(iova_list + 1);
+               }
+       }
+       mbuf->next = NULL;
+}
+
 static __rte_always_inline void
 cn9k_nix_cqe_to_mbuf(const struct nix_cqe_hdr_s *cq, const uint32_t tag,
                     struct rte_mbuf *mbuf, const void *lookup_mem,
@@ -138,8 +187,12 @@ cn9k_nix_cqe_to_mbuf(const struct nix_cqe_hdr_s *cq, const uint32_t tag,
        *(uint64_t *)(&mbuf->rearm_data) = val;
        mbuf->pkt_len = len;
 
-       mbuf->data_len = len;
-       mbuf->next = NULL;
+       if (flag & NIX_RX_MULTI_SEG_F) {
+               nix_cqe_xtract_mseg(rx, mbuf, val);
+       } else {
+               mbuf->data_len = len;
+               mbuf->next = NULL;
+       }
 }
 
 static inline uint16_t
@@ -215,6 +268,223 @@ cn9k_nix_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t pkts,
        return nb_pkts;
 }
 
+#if defined(RTE_ARCH_ARM64)
+
+static __rte_always_inline uint16_t
+cn9k_nix_recv_pkts_vector(void *rx_queue, struct rte_mbuf **rx_pkts,
+                         uint16_t pkts, const uint16_t flags)
+{
+       struct cn9k_eth_rxq *rxq = rx_queue;
+       uint16_t packets = 0;
+       uint64x2_t cq0_w8, cq1_w8, cq2_w8, cq3_w8, mbuf01, mbuf23;
+       const uint64_t mbuf_initializer = rxq->mbuf_initializer;
+       const uint64x2_t data_off = vdupq_n_u64(rxq->data_off);
+       uint64_t ol_flags0, ol_flags1, ol_flags2, ol_flags3;
+       uint64x2_t rearm0 = vdupq_n_u64(mbuf_initializer);
+       uint64x2_t rearm1 = vdupq_n_u64(mbuf_initializer);
+       uint64x2_t rearm2 = vdupq_n_u64(mbuf_initializer);
+       uint64x2_t rearm3 = vdupq_n_u64(mbuf_initializer);
+       struct rte_mbuf *mbuf0, *mbuf1, *mbuf2, *mbuf3;
+       const uint16_t *lookup_mem = rxq->lookup_mem;
+       const uint32_t qmask = rxq->qmask;
+       const uint64_t wdata = rxq->wdata;
+       const uintptr_t desc = rxq->desc;
+       uint8x16_t f0, f1, f2, f3;
+       uint32_t head = rxq->head;
+       uint16_t pkts_left;
+
+       pkts = nix_rx_nb_pkts(rxq, wdata, pkts, qmask);
+       pkts_left = pkts & (NIX_DESCS_PER_LOOP - 1);
+
+       /* Packets has to be floor-aligned to NIX_DESCS_PER_LOOP */
+       pkts = RTE_ALIGN_FLOOR(pkts, NIX_DESCS_PER_LOOP);
+
+       while (packets < pkts) {
+               /* Exit loop if head is about to wrap and become unaligned */
+               if (((head + NIX_DESCS_PER_LOOP - 1) & qmask) <
+                   NIX_DESCS_PER_LOOP) {
+                       pkts_left += (pkts - packets);
+                       break;
+               }
+
+               const uintptr_t cq0 = desc + CQE_SZ(head);
+
+               /* Prefetch N desc ahead */
+               rte_prefetch_non_temporal((void *)(cq0 + CQE_SZ(8)));
+               rte_prefetch_non_temporal((void *)(cq0 + CQE_SZ(9)));
+               rte_prefetch_non_temporal((void *)(cq0 + CQE_SZ(10)));
+               rte_prefetch_non_temporal((void *)(cq0 + CQE_SZ(11)));
+
+               /* Get NIX_RX_SG_S for size and buffer pointer */
+               cq0_w8 = vld1q_u64((uint64_t *)(cq0 + CQE_SZ(0) + 64));
+               cq1_w8 = vld1q_u64((uint64_t *)(cq0 + CQE_SZ(1) + 64));
+               cq2_w8 = vld1q_u64((uint64_t *)(cq0 + CQE_SZ(2) + 64));
+               cq3_w8 = vld1q_u64((uint64_t *)(cq0 + CQE_SZ(3) + 64));
+
+               /* Extract mbuf from NIX_RX_SG_S */
+               mbuf01 = vzip2q_u64(cq0_w8, cq1_w8);
+               mbuf23 = vzip2q_u64(cq2_w8, cq3_w8);
+               mbuf01 = vqsubq_u64(mbuf01, data_off);
+               mbuf23 = vqsubq_u64(mbuf23, data_off);
+
+               /* Move mbufs to scalar registers for future use */
+               mbuf0 = (struct rte_mbuf *)vgetq_lane_u64(mbuf01, 0);
+               mbuf1 = (struct rte_mbuf *)vgetq_lane_u64(mbuf01, 1);
+               mbuf2 = (struct rte_mbuf *)vgetq_lane_u64(mbuf23, 0);
+               mbuf3 = (struct rte_mbuf *)vgetq_lane_u64(mbuf23, 1);
+
+               /* Mask to get packet len from NIX_RX_SG_S */
+               const uint8x16_t shuf_msk = {
+                       0xFF, 0xFF, /* pkt_type set as unknown */
+                       0xFF, 0xFF, /* pkt_type set as unknown */
+                       0,    1,    /* octet 1~0, low 16 bits pkt_len */
+                       0xFF, 0xFF, /* skip high 16 bits pkt_len, zero out */
+                       0,    1,    /* octet 1~0, 16 bits data_len */
+                       0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
+
+               /* Form the rx_descriptor_fields1 with pkt_len and data_len */
+               f0 = vqtbl1q_u8(cq0_w8, shuf_msk);
+               f1 = vqtbl1q_u8(cq1_w8, shuf_msk);
+               f2 = vqtbl1q_u8(cq2_w8, shuf_msk);
+               f3 = vqtbl1q_u8(cq3_w8, shuf_msk);
+
+               /* Load CQE word0 and word 1 */
+               uint64_t cq0_w0 = ((uint64_t *)(cq0 + CQE_SZ(0)))[0];
+               uint64_t cq0_w1 = ((uint64_t *)(cq0 + CQE_SZ(0)))[1];
+               uint64_t cq1_w0 = ((uint64_t *)(cq0 + CQE_SZ(1)))[0];
+               uint64_t cq1_w1 = ((uint64_t *)(cq0 + CQE_SZ(1)))[1];
+               uint64_t cq2_w0 = ((uint64_t *)(cq0 + CQE_SZ(2)))[0];
+               uint64_t cq2_w1 = ((uint64_t *)(cq0 + CQE_SZ(2)))[1];
+               uint64_t cq3_w0 = ((uint64_t *)(cq0 + CQE_SZ(3)))[0];
+               uint64_t cq3_w1 = ((uint64_t *)(cq0 + CQE_SZ(3)))[1];
+
+               if (flags & NIX_RX_OFFLOAD_RSS_F) {
+                       /* Fill rss in the rx_descriptor_fields1 */
+                       f0 = vsetq_lane_u32(cq0_w0, f0, 3);
+                       f1 = vsetq_lane_u32(cq1_w0, f1, 3);
+                       f2 = vsetq_lane_u32(cq2_w0, f2, 3);
+                       f3 = vsetq_lane_u32(cq3_w0, f3, 3);
+                       ol_flags0 = PKT_RX_RSS_HASH;
+                       ol_flags1 = PKT_RX_RSS_HASH;
+                       ol_flags2 = PKT_RX_RSS_HASH;
+                       ol_flags3 = PKT_RX_RSS_HASH;
+               } else {
+                       ol_flags0 = 0;
+                       ol_flags1 = 0;
+                       ol_flags2 = 0;
+                       ol_flags3 = 0;
+               }
+
+               if (flags & NIX_RX_OFFLOAD_PTYPE_F) {
+                       /* Fill packet_type in the rx_descriptor_fields1 */
+                       f0 = vsetq_lane_u32(nix_ptype_get(lookup_mem, cq0_w1),
+                                           f0, 0);
+                       f1 = vsetq_lane_u32(nix_ptype_get(lookup_mem, cq1_w1),
+                                           f1, 0);
+                       f2 = vsetq_lane_u32(nix_ptype_get(lookup_mem, cq2_w1),
+                                           f2, 0);
+                       f3 = vsetq_lane_u32(nix_ptype_get(lookup_mem, cq3_w1),
+                                           f3, 0);
+               }
+
+               if (flags & NIX_RX_OFFLOAD_CHECKSUM_F) {
+                       ol_flags0 |= nix_rx_olflags_get(lookup_mem, cq0_w1);
+                       ol_flags1 |= nix_rx_olflags_get(lookup_mem, cq1_w1);
+                       ol_flags2 |= nix_rx_olflags_get(lookup_mem, cq2_w1);
+                       ol_flags3 |= nix_rx_olflags_get(lookup_mem, cq3_w1);
+               }
+
+               if (flags & NIX_RX_OFFLOAD_MARK_UPDATE_F) {
+                       ol_flags0 = nix_update_match_id(
+                               *(uint16_t *)(cq0 + CQE_SZ(0) + 38), ol_flags0,
+                               mbuf0);
+                       ol_flags1 = nix_update_match_id(
+                               *(uint16_t *)(cq0 + CQE_SZ(1) + 38), ol_flags1,
+                               mbuf1);
+                       ol_flags2 = nix_update_match_id(
+                               *(uint16_t *)(cq0 + CQE_SZ(2) + 38), ol_flags2,
+                               mbuf2);
+                       ol_flags3 = nix_update_match_id(
+                               *(uint16_t *)(cq0 + CQE_SZ(3) + 38), ol_flags3,
+                               mbuf3);
+               }
+
+               /* Form rearm_data with ol_flags */
+               rearm0 = vsetq_lane_u64(ol_flags0, rearm0, 1);
+               rearm1 = vsetq_lane_u64(ol_flags1, rearm1, 1);
+               rearm2 = vsetq_lane_u64(ol_flags2, rearm2, 1);
+               rearm3 = vsetq_lane_u64(ol_flags3, rearm3, 1);
+
+               /* Update rx_descriptor_fields1 */
+               vst1q_u64((uint64_t *)mbuf0->rx_descriptor_fields1, f0);
+               vst1q_u64((uint64_t *)mbuf1->rx_descriptor_fields1, f1);
+               vst1q_u64((uint64_t *)mbuf2->rx_descriptor_fields1, f2);
+               vst1q_u64((uint64_t *)mbuf3->rx_descriptor_fields1, f3);
+
+               /* Update rearm_data */
+               vst1q_u64((uint64_t *)mbuf0->rearm_data, rearm0);
+               vst1q_u64((uint64_t *)mbuf1->rearm_data, rearm1);
+               vst1q_u64((uint64_t *)mbuf2->rearm_data, rearm2);
+               vst1q_u64((uint64_t *)mbuf3->rearm_data, rearm3);
+
+               /* Update that no more segments */
+               mbuf0->next = NULL;
+               mbuf1->next = NULL;
+               mbuf2->next = NULL;
+               mbuf3->next = NULL;
+
+               /* Store the mbufs to rx_pkts */
+               vst1q_u64((uint64_t *)&rx_pkts[packets], mbuf01);
+               vst1q_u64((uint64_t *)&rx_pkts[packets + 2], mbuf23);
+
+               /* Prefetch mbufs */
+               roc_prefetch_store_keep(mbuf0);
+               roc_prefetch_store_keep(mbuf1);
+               roc_prefetch_store_keep(mbuf2);
+               roc_prefetch_store_keep(mbuf3);
+
+               /* Mark mempool obj as "get" as it is alloc'ed by NIX */
+               __mempool_check_cookies(mbuf0->pool, (void **)&mbuf0, 1, 1);
+               __mempool_check_cookies(mbuf1->pool, (void **)&mbuf1, 1, 1);
+               __mempool_check_cookies(mbuf2->pool, (void **)&mbuf2, 1, 1);
+               __mempool_check_cookies(mbuf3->pool, (void **)&mbuf3, 1, 1);
+
+               /* Advance head pointer and packets */
+               head += NIX_DESCS_PER_LOOP;
+               head &= qmask;
+               packets += NIX_DESCS_PER_LOOP;
+       }
+
+       rxq->head = head;
+       rxq->available -= packets;
+
+       rte_io_wmb();
+       /* Free all the CQs that we've processed */
+       plt_write64((rxq->wdata | packets), rxq->cq_door);
+
+       if (unlikely(pkts_left))
+               packets += cn9k_nix_recv_pkts(rx_queue, &rx_pkts[packets],
+                                             pkts_left, flags);
+
+       return packets;
+}
+
+#else
+
+static inline uint16_t
+cn9k_nix_recv_pkts_vector(void *rx_queue, struct rte_mbuf **rx_pkts,
+                         uint16_t pkts, const uint16_t flags)
+{
+       RTE_SET_USED(rx_queue);
+       RTE_SET_USED(rx_pkts);
+       RTE_SET_USED(pkts);
+       RTE_SET_USED(flags);
+
+       return 0;
+}
+
+#endif
+
 #define RSS_F    NIX_RX_OFFLOAD_RSS_F
 #define PTYPE_F          NIX_RX_OFFLOAD_PTYPE_F
 #define CKSUM_F          NIX_RX_OFFLOAD_CHECKSUM_F
@@ -239,8 +509,14 @@ R(mark_cksum_rss,          1, 1, 0, 1, MARK_F | CKSUM_F | RSS_F)  \
 R(mark_cksum_ptype,            1, 1, 1, 0, MARK_F | CKSUM_F | PTYPE_F)\
 R(mark_cksum_ptype_rss,                1, 1, 1, 1, MARK_F | CKSUM_F | PTYPE_F | RSS_F)
 
-#define R(name, f3, f2, f1, f0, flags)                                        \
+#define R(name, f3, f2, f1, f0, flags)                                         \
        uint16_t __rte_noinline __rte_hot cn9k_nix_recv_pkts_##name(           \
+               void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t pkts);     \
+                                                                              \
+       uint16_t __rte_noinline __rte_hot cn9k_nix_recv_pkts_mseg_##name(      \
+               void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t pkts);     \
+                                                                              \
+       uint16_t __rte_noinline __rte_hot cn9k_nix_recv_pkts_vec_##name(       \
                void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t pkts);
 
 NIX_RX_FASTPATH_MODES