drivers/net/bnxt/bnxt_rxtx_vec_sse.c

   1 /* SPDX-License-Identifier: BSD-3-Clause */
   2 /* Copyright(c) 2019-2021 Broadcom All rights reserved. */
   3
   4 #include <inttypes.h>
   5 #include <stdbool.h>
   6
   7 #include <rte_bitmap.h>
   8 #include <rte_byteorder.h>
   9 #include <rte_malloc.h>
  10 #include <rte_memory.h>
  11 #include <rte_vect.h>
  12
  13 #include "bnxt.h"
  14 #include "bnxt_cpr.h"
  15 #include "bnxt_ring.h"
  16
  17 #include "bnxt_txq.h"
  18 #include "bnxt_txr.h"
  19 #include "bnxt_rxtx_vec_common.h"
  20
  21 /*
  22  * RX Ring handling
  23  */
  24
  25 #define GET_OL_FLAGS(rss_flags, ol_index, errors, pi, ol_flags)                \
  26 {                                                                              \
  27         uint32_t tmp, of;                                                      \
  28                                                                                \
  29         of = _mm_extract_epi32((rss_flags), (pi)) |                            \
  30                 rxr->ol_flags_table[_mm_extract_epi32((ol_index), (pi))];      \
  31                                                                                \
  32         tmp = _mm_extract_epi32((errors), (pi));                               \
  33         if (tmp)                                                               \
  34                 of |= rxr->ol_flags_err_table[tmp];                            \
  35         (ol_flags) = of;                                                       \
  36 }
  37
  38 #define GET_DESC_FIELDS(rxcmp, rxcmp1, shuf_msk, ptype_idx, pi, ret)           \
  39 {                                                                              \
  40         uint32_t ptype;                                                        \
  41         __m128i r;                                                             \
  42                                                                                \
  43         /* Set mbuf pkt_len, data_len, and rss_hash fields. */                 \
  44         r = _mm_shuffle_epi8((rxcmp), (shuf_msk));                             \
  45                                                                                \
  46         /* Set packet type. */                                                 \
  47         ptype = bnxt_ptype_table[_mm_extract_epi32((ptype_idx), (pi))];        \
  48         r = _mm_blend_epi16(r, _mm_set_epi32(0, 0, 0, ptype), 0x3);            \
  49                                                                                \
  50         /* Set vlan_tci. */                                                    \
  51         r = _mm_blend_epi16(r, _mm_slli_si128((rxcmp1), 6), 0x20);             \
  52         (ret) = r;                                                             \
  53 }
  54
  55 static inline void
  56 descs_to_mbufs(__m128i mm_rxcmp[4], __m128i mm_rxcmp1[4],
  57                __m128i mbuf_init, struct rte_mbuf **mbuf,
  58                struct bnxt_rx_ring_info *rxr)
  59 {
  60         const __m128i shuf_msk =
  61                 _mm_set_epi8(15, 14, 13, 12,          /* rss */
  62                              0xFF, 0xFF,              /* vlan_tci (zeroes) */
  63                              3, 2,                    /* data_len */
  64                              0xFF, 0xFF, 3, 2,        /* pkt_len */
  65                              0xFF, 0xFF, 0xFF, 0xFF); /* pkt_type (zeroes) */
  66         const __m128i flags_type_mask =
  67                 _mm_set1_epi32(RX_PKT_CMPL_FLAGS_ITYPE_MASK);
  68         const __m128i flags2_mask1 =
  69                 _mm_set1_epi32(CMPL_FLAGS2_VLAN_TUN_MSK);
  70         const __m128i flags2_mask2 =
  71                 _mm_set1_epi32(RX_PKT_CMPL_FLAGS2_IP_TYPE);
  72         const __m128i rss_mask =
  73                 _mm_set1_epi32(RX_PKT_CMPL_FLAGS_RSS_VALID);
  74         __m128i t0, t1, flags_type, flags2, index, errors, rss_flags;
  75         __m128i ptype_idx, is_tunnel;
  76         uint32_t ol_flags;
  77
  78         /* Validate ptype table indexing at build time. */
  79         bnxt_check_ptype_constants();
  80
  81         /* Compute packet type table indexes for four packets */
  82         t0 = _mm_unpacklo_epi32(mm_rxcmp[0], mm_rxcmp[1]);
  83         t1 = _mm_unpacklo_epi32(mm_rxcmp[2], mm_rxcmp[3]);
  84         flags_type = _mm_unpacklo_epi64(t0, t1);
  85         ptype_idx = _mm_srli_epi32(_mm_and_si128(flags_type, flags_type_mask),
  86                         RX_PKT_CMPL_FLAGS_ITYPE_SFT - BNXT_PTYPE_TBL_TYPE_SFT);
  87
  88         t0 = _mm_unpacklo_epi32(mm_rxcmp1[0], mm_rxcmp1[1]);
  89         t1 = _mm_unpacklo_epi32(mm_rxcmp1[2], mm_rxcmp1[3]);
  90         flags2 = _mm_unpacklo_epi64(t0, t1);
  91
  92         ptype_idx = _mm_or_si128(ptype_idx,
  93                         _mm_srli_epi32(_mm_and_si128(flags2, flags2_mask1),
  94                                        RX_PKT_CMPL_FLAGS2_META_FORMAT_SFT -
  95                                        BNXT_PTYPE_TBL_VLAN_SFT));
  96         ptype_idx = _mm_or_si128(ptype_idx,
  97                         _mm_srli_epi32(_mm_and_si128(flags2, flags2_mask2),
  98                                        RX_PKT_CMPL_FLAGS2_IP_TYPE_SFT -
  99                                        BNXT_PTYPE_TBL_IP_VER_SFT));
 100
 101         /* Extract RSS valid flags for four packets. */
 102         rss_flags = _mm_srli_epi32(_mm_and_si128(flags_type, rss_mask), 9);
 103
 104         /* Extract errors_v2 fields for four packets. */
 105         t0 = _mm_unpackhi_epi32(mm_rxcmp1[0], mm_rxcmp1[1]);
 106         t1 = _mm_unpackhi_epi32(mm_rxcmp1[2], mm_rxcmp1[3]);
 107
 108         /* Compute ol_flags and checksum error indexes for four packets. */
 109         is_tunnel = _mm_and_si128(flags2, _mm_set1_epi32(4));
 110         is_tunnel = _mm_slli_epi32(is_tunnel, 3);
 111         flags2 = _mm_and_si128(flags2, _mm_set1_epi32(0x1F));
 112
 113         errors = _mm_srli_epi32(_mm_unpacklo_epi64(t0, t1), 4);
 114         errors = _mm_and_si128(errors, _mm_set1_epi32(0xF));
 115         errors = _mm_and_si128(errors, flags2);
 116
 117         index = _mm_andnot_si128(errors, flags2);
 118         errors = _mm_or_si128(errors, _mm_srli_epi32(is_tunnel, 1));
 119         index = _mm_or_si128(index, is_tunnel);
 120
 121         /* Update mbuf rearm_data for four packets. */
 122         GET_OL_FLAGS(rss_flags, index, errors, 0, ol_flags);
 123         _mm_store_si128((void *)&mbuf[0]->rearm_data,
 124                         _mm_or_si128(mbuf_init, _mm_set_epi64x(ol_flags, 0)));
 125
 126         GET_OL_FLAGS(rss_flags, index, errors, 1, ol_flags);
 127         _mm_store_si128((void *)&mbuf[1]->rearm_data,
 128                         _mm_or_si128(mbuf_init, _mm_set_epi64x(ol_flags, 0)));
 129
 130         GET_OL_FLAGS(rss_flags, index, errors, 2, ol_flags);
 131         _mm_store_si128((void *)&mbuf[2]->rearm_data,
 132                         _mm_or_si128(mbuf_init, _mm_set_epi64x(ol_flags, 0)));
 133
 134         GET_OL_FLAGS(rss_flags, index, errors, 3, ol_flags);
 135         _mm_store_si128((void *)&mbuf[3]->rearm_data,
 136                         _mm_or_si128(mbuf_init, _mm_set_epi64x(ol_flags, 0)));
 137
 138         /* Update mbuf rx_descriptor_fields1 for four packes. */
 139         GET_DESC_FIELDS(mm_rxcmp[0], mm_rxcmp1[0], shuf_msk, ptype_idx, 0, t0);
 140         _mm_store_si128((void *)&mbuf[0]->rx_descriptor_fields1, t0);
 141
 142         GET_DESC_FIELDS(mm_rxcmp[1], mm_rxcmp1[1], shuf_msk, ptype_idx, 1, t0);
 143         _mm_store_si128((void *)&mbuf[1]->rx_descriptor_fields1, t0);
 144
 145         GET_DESC_FIELDS(mm_rxcmp[2], mm_rxcmp1[2], shuf_msk, ptype_idx, 2, t0);
 146         _mm_store_si128((void *)&mbuf[2]->rx_descriptor_fields1, t0);
 147
 148         GET_DESC_FIELDS(mm_rxcmp[3], mm_rxcmp1[3], shuf_msk, ptype_idx, 3, t0);
 149         _mm_store_si128((void *)&mbuf[3]->rx_descriptor_fields1, t0);
 150 }
 151
 152 static uint16_t
 153 recv_burst_vec_sse(void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
 154 {
 155         struct bnxt_rx_queue *rxq = rx_queue;
 156         const __m128i mbuf_init = _mm_set_epi64x(0, rxq->mbuf_initializer);
 157         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
 158         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 159         uint16_t cp_ring_size = cpr->cp_ring_struct->ring_size;
 160         uint16_t rx_ring_size = rxr->rx_ring_struct->ring_size;
 161         struct cmpl_base *cp_desc_ring = cpr->cp_desc_ring;
 162         uint64_t valid, desc_valid_mask = ~0ULL;
 163         const __m128i info3_v_mask = _mm_set1_epi32(CMPL_BASE_V);
 164         uint32_t raw_cons = cpr->cp_raw_cons;
 165         uint32_t cons, mbcons;
 166         int nb_rx_pkts = 0;
 167         const __m128i valid_target =
 168                 _mm_set1_epi32(!!(raw_cons & cp_ring_size));
 169         int i;
 170
 171         /* If Rx Q was stopped return */
 172         if (unlikely(!rxq->rx_started))
 173                 return 0;
 174
 175         if (rxq->rxrearm_nb >= rxq->rx_free_thresh)
 176                 bnxt_rxq_rearm(rxq, rxr);
 177
 178         cons = raw_cons & (cp_ring_size - 1);
 179         mbcons = (raw_cons / 2) & (rx_ring_size - 1);
 180
 181         /* Prefetch first four descriptor pairs. */
 182         rte_prefetch0(&cp_desc_ring[cons]);
 183         rte_prefetch0(&cp_desc_ring[cons + 4]);
 184
 185         /* Ensure that we do not go past the ends of the rings. */
 186         nb_pkts = RTE_MIN(nb_pkts, RTE_MIN(rx_ring_size - mbcons,
 187                                            (cp_ring_size - cons) / 2));
 188         /*
 189          * If we are at the end of the ring, ensure that descriptors after the
 190          * last valid entry are not treated as valid. Otherwise, force the
 191          * maximum number of packets to receive to be a multiple of the per-
 192          * loop count.
 193          */
 194         if (nb_pkts < BNXT_RX_DESCS_PER_LOOP_VEC128) {
 195                 desc_valid_mask >>=
 196                         16 * (BNXT_RX_DESCS_PER_LOOP_VEC128 - nb_pkts);
 197         } else {
 198                 nb_pkts =
 199                         RTE_ALIGN_FLOOR(nb_pkts, BNXT_RX_DESCS_PER_LOOP_VEC128);
 200         }
 201
 202         /* Handle RX burst request */
 203         for (i = 0; i < nb_pkts; i += BNXT_RX_DESCS_PER_LOOP_VEC128,
 204                                   cons += BNXT_RX_DESCS_PER_LOOP_VEC128 * 2,
 205                                   mbcons += BNXT_RX_DESCS_PER_LOOP_VEC128) {
 206                 __m128i rxcmp1[BNXT_RX_DESCS_PER_LOOP_VEC128];
 207                 __m128i rxcmp[BNXT_RX_DESCS_PER_LOOP_VEC128];
 208                 __m128i tmp0, tmp1, info3_v;
 209                 uint32_t num_valid;
 210
 211                 /* Copy four mbuf pointers to output array. */
 212                 tmp0 = _mm_loadu_si128((void *)&rxr->rx_buf_ring[mbcons]);
 213 #ifdef RTE_ARCH_X86_64
 214                 tmp1 = _mm_loadu_si128((void *)&rxr->rx_buf_ring[mbcons + 2]);
 215 #endif
 216                 _mm_storeu_si128((void *)&rx_pkts[i], tmp0);
 217 #ifdef RTE_ARCH_X86_64
 218                 _mm_storeu_si128((void *)&rx_pkts[i + 2], tmp1);
 219 #endif
 220
 221                 /* Prefetch four descriptor pairs for next iteration. */
 222                 if (i + BNXT_RX_DESCS_PER_LOOP_VEC128 < nb_pkts) {
 223                         rte_prefetch0(&cp_desc_ring[cons + 8]);
 224                         rte_prefetch0(&cp_desc_ring[cons + 12]);
 225                 }
 226
 227                 /*
 228                  * Load the four current descriptors into SSE registers in
 229                  * reverse order to ensure consistent state.
 230                  */
 231                 rxcmp1[3] = _mm_load_si128((void *)&cp_desc_ring[cons + 7]);
 232                 rte_compiler_barrier();
 233                 rxcmp[3] = _mm_load_si128((void *)&cp_desc_ring[cons + 6]);
 234
 235                 rxcmp1[2] = _mm_load_si128((void *)&cp_desc_ring[cons + 5]);
 236                 rte_compiler_barrier();
 237                 rxcmp[2] = _mm_load_si128((void *)&cp_desc_ring[cons + 4]);
 238
 239                 tmp1 = _mm_unpackhi_epi32(rxcmp1[2], rxcmp1[3]);
 240
 241                 rxcmp1[1] = _mm_load_si128((void *)&cp_desc_ring[cons + 3]);
 242                 rte_compiler_barrier();
 243                 rxcmp[1] = _mm_load_si128((void *)&cp_desc_ring[cons + 2]);
 244
 245                 rxcmp1[0] = _mm_load_si128((void *)&cp_desc_ring[cons + 1]);
 246                 rte_compiler_barrier();
 247                 rxcmp[0] = _mm_load_si128((void *)&cp_desc_ring[cons + 0]);
 248
 249                 tmp0 = _mm_unpackhi_epi32(rxcmp1[0], rxcmp1[1]);
 250
 251                 /* Isolate descriptor valid flags. */
 252                 info3_v = _mm_and_si128(_mm_unpacklo_epi64(tmp0, tmp1),
 253                                         info3_v_mask);
 254                 info3_v = _mm_xor_si128(info3_v, valid_target);
 255
 256                 /*
 257                  * Pack the 128-bit array of valid descriptor flags into 64
 258                  * bits and count the number of set bits in order to determine
 259                  * the number of valid descriptors.
 260                  */
 261                 valid = _mm_cvtsi128_si64(_mm_packs_epi32(info3_v, info3_v));
 262                 num_valid = __builtin_popcountll(valid & desc_valid_mask);
 263
 264                 if (num_valid == 0)
 265                         break;
 266
 267                 descs_to_mbufs(rxcmp, rxcmp1, mbuf_init, &rx_pkts[nb_rx_pkts],
 268                                rxr);
 269                 nb_rx_pkts += num_valid;
 270
 271                 if (num_valid < BNXT_RX_DESCS_PER_LOOP_VEC128)
 272                         break;
 273         }
 274
 275         if (nb_rx_pkts) {
 276                 rxr->rx_raw_prod = RING_ADV(rxr->rx_raw_prod, nb_rx_pkts);
 277
 278                 rxq->rxrearm_nb += nb_rx_pkts;
 279                 cpr->cp_raw_cons += 2 * nb_rx_pkts;
 280                 bnxt_db_cq(cpr);
 281         }
 282
 283         return nb_rx_pkts;
 284 }
 285
 286 uint16_t
 287 bnxt_recv_pkts_vec(void *rx_queue, struct rte_mbuf **rx_pkts, uint16_t nb_pkts)
 288 {
 289         uint16_t cnt = 0;
 290
 291         while (nb_pkts > RTE_BNXT_MAX_RX_BURST) {
 292                 uint16_t burst;
 293
 294                 burst = recv_burst_vec_sse(rx_queue, rx_pkts + cnt,
 295                                            RTE_BNXT_MAX_RX_BURST);
 296
 297                 cnt += burst;
 298                 nb_pkts -= burst;
 299
 300                 if (burst < RTE_BNXT_MAX_RX_BURST)
 301                         return cnt;
 302         }
 303
 304         return cnt + recv_burst_vec_sse(rx_queue, rx_pkts + cnt, nb_pkts);
 305 }
 306
 307 static void
 308 bnxt_handle_tx_cp_vec(struct bnxt_tx_queue *txq)
 309 {
 310         struct bnxt_cp_ring_info *cpr = txq->cp_ring;
 311         uint32_t raw_cons = cpr->cp_raw_cons;
 312         uint32_t cons;
 313         uint32_t nb_tx_pkts = 0;
 314         struct tx_cmpl *txcmp;
 315         struct cmpl_base *cp_desc_ring = cpr->cp_desc_ring;
 316         struct bnxt_ring *cp_ring_struct = cpr->cp_ring_struct;
 317         uint32_t ring_mask = cp_ring_struct->ring_mask;
 318
 319         do {
 320                 cons = RING_CMPL(ring_mask, raw_cons);
 321                 txcmp = (struct tx_cmpl *)&cp_desc_ring[cons];
 322
 323                 if (!bnxt_cpr_cmp_valid(txcmp, raw_cons, ring_mask + 1))
 324                         break;
 325
 326                 if (likely(CMP_TYPE(txcmp) == TX_CMPL_TYPE_TX_L2))
 327                         nb_tx_pkts += txcmp->opaque;
 328                 else
 329                         RTE_LOG_DP(ERR, PMD,
 330                                    "Unhandled CMP type %02x\n",
 331                                    CMP_TYPE(txcmp));
 332                 raw_cons = NEXT_RAW_CMP(raw_cons);
 333         } while (nb_tx_pkts < ring_mask);
 334
 335         if (nb_tx_pkts) {
 336                 if (txq->offloads & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
 337                         bnxt_tx_cmp_vec_fast(txq, nb_tx_pkts);
 338                 else
 339                         bnxt_tx_cmp_vec(txq, nb_tx_pkts);
 340                 cpr->cp_raw_cons = raw_cons;
 341                 bnxt_db_cq(cpr);
 342         }
 343 }
 344
 345 static inline void
 346 bnxt_xmit_one(struct rte_mbuf *mbuf, struct tx_bd_long *txbd,
 347               struct rte_mbuf **tx_buf)
 348 {
 349         __m128i desc;
 350
 351         *tx_buf = mbuf;
 352
 353         desc = _mm_set_epi64x(mbuf->buf_iova + mbuf->data_off,
 354                               bnxt_xmit_flags_len(mbuf->data_len,
 355                                                   TX_BD_FLAGS_NOCMPL));
 356         desc = _mm_blend_epi16(desc, _mm_set_epi16(0, 0, 0, 0, 0, 0,
 357                                                    mbuf->data_len, 0), 0x02);
 358         _mm_store_si128((void *)txbd, desc);
 359 }
 360
 361 static uint16_t
 362 bnxt_xmit_fixed_burst_vec(struct bnxt_tx_queue *txq, struct rte_mbuf **tx_pkts,
 363                           uint16_t nb_pkts)
 364 {
 365         struct bnxt_tx_ring_info *txr = txq->tx_ring;
 366         uint16_t tx_prod, tx_raw_prod = txr->tx_raw_prod;
 367         struct tx_bd_long *txbd;
 368         struct rte_mbuf **tx_buf;
 369         uint16_t to_send;
 370
 371         tx_prod = RING_IDX(txr->tx_ring_struct, tx_raw_prod);
 372         txbd = &txr->tx_desc_ring[tx_prod];
 373         tx_buf = &txr->tx_buf_ring[tx_prod];
 374
 375         /* Prefetch next transmit buffer descriptors. */
 376         rte_prefetch0(txbd);
 377         rte_prefetch0(txbd + 3);
 378
 379         nb_pkts = RTE_MIN(nb_pkts, bnxt_tx_avail(txq));
 380
 381         if (unlikely(nb_pkts == 0))
 382                 return 0;
 383
 384         /* Handle TX burst request */
 385         to_send = nb_pkts;
 386         while (to_send >= BNXT_TX_DESCS_PER_LOOP) {
 387                 /* Prefetch next transmit buffer descriptors. */
 388                 rte_prefetch0(txbd + 4);
 389                 rte_prefetch0(txbd + 7);
 390
 391                 bnxt_xmit_one(tx_pkts[0], txbd++, tx_buf++);
 392                 bnxt_xmit_one(tx_pkts[1], txbd++, tx_buf++);
 393                 bnxt_xmit_one(tx_pkts[2], txbd++, tx_buf++);
 394                 bnxt_xmit_one(tx_pkts[3], txbd++, tx_buf++);
 395
 396                 to_send -= BNXT_TX_DESCS_PER_LOOP;
 397                 tx_pkts += BNXT_TX_DESCS_PER_LOOP;
 398         }
 399
 400         while (to_send) {
 401                 bnxt_xmit_one(tx_pkts[0], txbd++, tx_buf++);
 402                 to_send--;
 403                 tx_pkts++;
 404         }
 405
 406         /* Request a completion for the final packet of burst. */
 407         rte_compiler_barrier();
 408         txbd[-1].opaque = nb_pkts;
 409         txbd[-1].flags_type &= ~TX_BD_LONG_FLAGS_NO_CMPL;
 410
 411         tx_raw_prod += nb_pkts;
 412         bnxt_db_write(&txr->tx_db, tx_raw_prod);
 413
 414         txr->tx_raw_prod = tx_raw_prod;
 415
 416         return nb_pkts;
 417 }
 418
 419 uint16_t
 420 bnxt_xmit_pkts_vec(void *tx_queue, struct rte_mbuf **tx_pkts,
 421                    uint16_t nb_pkts)
 422 {
 423         int nb_sent = 0;
 424         struct bnxt_tx_queue *txq = tx_queue;
 425         struct bnxt_tx_ring_info *txr = txq->tx_ring;
 426         uint16_t ring_size = txr->tx_ring_struct->ring_size;
 427
 428         /* Tx queue was stopped; wait for it to be restarted */
 429         if (unlikely(!txq->tx_started)) {
 430                 PMD_DRV_LOG(DEBUG, "Tx q stopped;return\n");
 431                 return 0;
 432         }
 433
 434         /* Handle TX completions */
 435         if (bnxt_tx_bds_in_hw(txq) >= txq->tx_free_thresh)
 436                 bnxt_handle_tx_cp_vec(txq);
 437
 438         while (nb_pkts) {
 439                 uint16_t ret, num;
 440
 441                 /*
 442                  * Ensure that no more than RTE_BNXT_MAX_TX_BURST packets
 443                  * are transmitted before the next completion.
 444                  */
 445                 num = RTE_MIN(nb_pkts, RTE_BNXT_MAX_TX_BURST);
 446
 447                 /*
 448                  * Ensure that a ring wrap does not occur within a call to
 449                  * bnxt_xmit_fixed_burst_vec().
 450                  */
 451                 num = RTE_MIN(num, ring_size -
 452                                    (txr->tx_raw_prod & (ring_size - 1)));
 453                 ret = bnxt_xmit_fixed_burst_vec(txq, &tx_pkts[nb_sent], num);
 454                 nb_sent += ret;
 455                 nb_pkts -= ret;
 456                 if (ret < num)
 457                         break;
 458         }
 459
 460         return nb_sent;
 461 }
 462
 463 int __rte_cold
 464 bnxt_rxq_vec_setup(struct bnxt_rx_queue *rxq)
 465 {
 466         return bnxt_rxq_vec_setup_common(rxq);
 467 }