8f73add9be3b30fdf7b056750f8e527bbeecc70e
[dpdk.git] / drivers / net / bnxt / bnxt_rxtx_vec_sse.c
1 // SPDX-License-Identifier: BSD-3-Clause
2 /* Copyright(c) 2019 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 #if defined(RTE_ARCH_X86)
12 #include <tmmintrin.h>
13 #else
14 #error "bnxt vector pmd: unsupported target."
15 #endif
16
17 #include "bnxt.h"
18 #include "bnxt_cpr.h"
19 #include "bnxt_ring.h"
20 #include "bnxt_rxr.h"
21 #include "bnxt_rxq.h"
22 #include "hsi_struct_def_dpdk.h"
23
24 #include "bnxt_txq.h"
25 #include "bnxt_txr.h"
26
27 /*
28  * RX Ring handling
29  */
30
31 #define RTE_BNXT_MAX_RX_BURST           32
32 #define RTE_BNXT_MAX_TX_BURST           32
33 #define RTE_BNXT_RXQ_REARM_THRESH       32
34 #define RTE_BNXT_DESCS_PER_LOOP         4
35
36 static inline void
37 bnxt_rxq_rearm(struct bnxt_rx_queue *rxq, struct bnxt_rx_ring_info *rxr)
38 {
39         struct rx_prod_pkt_bd *rxbds = &rxr->rx_desc_ring[rxq->rxrearm_start];
40         struct bnxt_sw_rx_bd *rx_bufs = &rxr->rx_buf_ring[rxq->rxrearm_start];
41         struct rte_mbuf *mb0, *mb1;
42         int i;
43
44         const __m128i hdr_room = _mm_set_epi64x(RTE_PKTMBUF_HEADROOM, 0);
45         const __m128i addrmask = _mm_set_epi64x(UINT64_MAX, 0);
46
47         /* Pull RTE_BNXT_RXQ_REARM_THRESH more mbufs into the software ring */
48         if (rte_mempool_get_bulk(rxq->mb_pool,
49                                  (void *)rx_bufs,
50                                  RTE_BNXT_RXQ_REARM_THRESH) < 0) {
51                 rte_eth_devices[rxq->port_id].data->rx_mbuf_alloc_failed +=
52                         RTE_BNXT_RXQ_REARM_THRESH;
53
54                 return;
55         }
56
57         /* Initialize the mbufs in vector, process 2 mbufs in one loop */
58         for (i = 0; i < RTE_BNXT_RXQ_REARM_THRESH; i += 2, rx_bufs += 2) {
59                 __m128i buf_addr0, buf_addr1;
60                 __m128i rxbd0, rxbd1;
61
62                 mb0 = rx_bufs[0].mbuf;
63                 mb1 = rx_bufs[1].mbuf;
64
65                 /* Load address fields from both mbufs */
66                 buf_addr0 = _mm_loadu_si128((__m128i *)&mb0->buf_addr);
67                 buf_addr1 = _mm_loadu_si128((__m128i *)&mb1->buf_addr);
68
69                 /* Load both rx descriptors (preserving some existing fields) */
70                 rxbd0 = _mm_loadu_si128((__m128i *)(rxbds + 0));
71                 rxbd1 = _mm_loadu_si128((__m128i *)(rxbds + 1));
72
73                 /* Add default offset to buffer address. */
74                 buf_addr0 = _mm_add_epi64(buf_addr0, hdr_room);
75                 buf_addr1 = _mm_add_epi64(buf_addr1, hdr_room);
76
77                 /* Clear all fields except address. */
78                 buf_addr0 =  _mm_and_si128(buf_addr0, addrmask);
79                 buf_addr1 =  _mm_and_si128(buf_addr1, addrmask);
80
81                 /* Clear address field in descriptor. */
82                 rxbd0 = _mm_andnot_si128(addrmask, rxbd0);
83                 rxbd1 = _mm_andnot_si128(addrmask, rxbd1);
84
85                 /* Set address field in descriptor. */
86                 rxbd0 = _mm_add_epi64(rxbd0, buf_addr0);
87                 rxbd1 = _mm_add_epi64(rxbd1, buf_addr1);
88
89                 /* Store descriptors to memory. */
90                 _mm_store_si128((__m128i *)(rxbds++), rxbd0);
91                 _mm_store_si128((__m128i *)(rxbds++), rxbd1);
92         }
93
94         rxq->rxrearm_start += RTE_BNXT_RXQ_REARM_THRESH;
95         bnxt_db_write(&rxr->rx_db, rxq->rxrearm_start - 1);
96         if (rxq->rxrearm_start >= rxq->nb_rx_desc)
97                 rxq->rxrearm_start = 0;
98
99         rxq->rxrearm_nb -= RTE_BNXT_RXQ_REARM_THRESH;
100 }
101
102 static uint32_t
103 bnxt_parse_pkt_type(struct rx_pkt_cmpl *rxcmp, struct rx_pkt_cmpl_hi *rxcmp1)
104 {
105         uint32_t l3, pkt_type = 0;
106         uint32_t t_ipcs = 0, ip6 = 0, vlan = 0;
107         uint32_t flags_type;
108
109         vlan = !!(rxcmp1->flags2 &
110                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN));
111         pkt_type |= vlan ? RTE_PTYPE_L2_ETHER_VLAN : RTE_PTYPE_L2_ETHER;
112
113         t_ipcs = !!(rxcmp1->flags2 &
114                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_T_IP_CS_CALC));
115         ip6 = !!(rxcmp1->flags2 &
116                  rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_IP_TYPE));
117
118         flags_type = rxcmp->flags_type &
119                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS_ITYPE_MASK);
120
121         if (!t_ipcs && !ip6)
122                 l3 = RTE_PTYPE_L3_IPV4_EXT_UNKNOWN;
123         else if (!t_ipcs && ip6)
124                 l3 = RTE_PTYPE_L3_IPV6_EXT_UNKNOWN;
125         else if (t_ipcs && !ip6)
126                 l3 = RTE_PTYPE_INNER_L3_IPV4_EXT_UNKNOWN;
127         else
128                 l3 = RTE_PTYPE_INNER_L3_IPV6_EXT_UNKNOWN;
129
130         switch (flags_type) {
131         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_ICMP):
132                 if (!t_ipcs)
133                         pkt_type |= l3 | RTE_PTYPE_L4_ICMP;
134                 else
135                         pkt_type |= l3 | RTE_PTYPE_INNER_L4_ICMP;
136                 break;
137
138         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_TCP):
139                 if (!t_ipcs)
140                         pkt_type |= l3 | RTE_PTYPE_L4_TCP;
141                 else
142                         pkt_type |= l3 | RTE_PTYPE_INNER_L4_TCP;
143                 break;
144
145         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_UDP):
146                 if (!t_ipcs)
147                         pkt_type |= l3 | RTE_PTYPE_L4_UDP;
148                 else
149                         pkt_type |= l3 | RTE_PTYPE_INNER_L4_UDP;
150                 break;
151
152         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_IP):
153                 pkt_type |= l3;
154                 break;
155         }
156
157         return pkt_type;
158 }
159
160 static void
161 bnxt_parse_csum(struct rte_mbuf *mbuf, struct rx_pkt_cmpl_hi *rxcmp1)
162 {
163         uint32_t flags;
164
165         flags = flags2_0xf(rxcmp1);
166         /* IP Checksum */
167         if (likely(IS_IP_NONTUNNEL_PKT(flags))) {
168                 if (unlikely(RX_CMP_IP_CS_ERROR(rxcmp1)))
169                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_BAD;
170                 else
171                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_GOOD;
172         } else if (IS_IP_TUNNEL_PKT(flags)) {
173                 if (unlikely(RX_CMP_IP_OUTER_CS_ERROR(rxcmp1) ||
174                              RX_CMP_IP_CS_ERROR(rxcmp1)))
175                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_BAD;
176                 else
177                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_GOOD;
178         } else if (unlikely(RX_CMP_IP_CS_UNKNOWN(rxcmp1))) {
179                 mbuf->ol_flags |= PKT_RX_IP_CKSUM_UNKNOWN;
180         }
181
182         /* L4 Checksum */
183         if (likely(IS_L4_NONTUNNEL_PKT(flags))) {
184                 if (unlikely(RX_CMP_L4_INNER_CS_ERR2(rxcmp1)))
185                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_BAD;
186                 else
187                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
188         } else if (IS_L4_TUNNEL_PKT(flags)) {
189                 if (unlikely(RX_CMP_L4_INNER_CS_ERR2(rxcmp1)))
190                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_BAD;
191                 else
192                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
193                 if (unlikely(RX_CMP_L4_OUTER_CS_ERR2(rxcmp1))) {
194                         mbuf->ol_flags |= PKT_RX_OUTER_L4_CKSUM_BAD;
195                 } else if (unlikely(IS_L4_TUNNEL_PKT_ONLY_INNER_L4_CS
196                                     (flags))) {
197                         mbuf->ol_flags |= PKT_RX_OUTER_L4_CKSUM_UNKNOWN;
198                 } else {
199                         mbuf->ol_flags |= PKT_RX_OUTER_L4_CKSUM_GOOD;
200                 }
201         } else if (unlikely(RX_CMP_L4_CS_UNKNOWN(rxcmp1))) {
202                 mbuf->ol_flags |= PKT_RX_L4_CKSUM_UNKNOWN;
203         }
204 }
205
206 uint16_t
207 bnxt_recv_pkts_vec(void *rx_queue, struct rte_mbuf **rx_pkts,
208                    uint16_t nb_pkts)
209 {
210         struct bnxt_rx_queue *rxq = rx_queue;
211         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
212         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
213         uint32_t raw_cons = cpr->cp_raw_cons;
214         uint32_t cons;
215         int nb_rx_pkts = 0;
216         struct rx_pkt_cmpl *rxcmp;
217         bool evt = false;
218         const __m128i mbuf_init = _mm_set_epi64x(0, rxq->mbuf_initializer);
219         const __m128i shuf_msk =
220                 _mm_set_epi8(15, 14, 13, 12,          /* rss */
221                              0xFF, 0xFF,              /* vlan_tci (zeroes) */
222                              3, 2,                    /* data_len */
223                              0xFF, 0xFF, 3, 2,        /* pkt_len */
224                              0xFF, 0xFF, 0xFF, 0xFF); /* pkt_type (zeroes) */
225
226         /* If Rx Q was stopped return */
227         if (unlikely(!rxq->rx_started))
228                 return 0;
229
230         if (rxq->rxrearm_nb >= RTE_BNXT_RXQ_REARM_THRESH)
231                 bnxt_rxq_rearm(rxq, rxr);
232
233         /* Return no more than RTE_BNXT_MAX_RX_BURST per call. */
234         nb_pkts = RTE_MIN(nb_pkts, RTE_BNXT_MAX_RX_BURST);
235
236         /*
237          * Make nb_pkts an integer multiple of RTE_BNXT_DESCS_PER_LOOP.
238          * nb_pkts < RTE_BNXT_DESCS_PER_LOOP, just return no packet
239          */
240         nb_pkts = RTE_ALIGN_FLOOR(nb_pkts, RTE_BNXT_DESCS_PER_LOOP);
241         if (!nb_pkts)
242                 return 0;
243
244         /* Handle RX burst request */
245         while (1) {
246                 cons = RING_CMP(cpr->cp_ring_struct, raw_cons);
247
248                 rxcmp = (struct rx_pkt_cmpl *)&cpr->cp_desc_ring[cons];
249
250                 if (!CMP_VALID(rxcmp, raw_cons, cpr->cp_ring_struct))
251                         break;
252
253                 if (likely(CMP_TYPE(rxcmp) == RX_PKT_CMPL_TYPE_RX_L2)) {
254                         struct rx_pkt_cmpl_hi *rxcmp1;
255                         uint32_t tmp_raw_cons;
256                         uint16_t cp_cons;
257                         struct rte_mbuf *mbuf;
258                         __m128i mm_rxcmp, pkt_mb;
259
260                         tmp_raw_cons = NEXT_RAW_CMP(raw_cons);
261                         cp_cons = RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
262                         rxcmp1 = (struct rx_pkt_cmpl_hi *)
263                                                 &cpr->cp_desc_ring[cp_cons];
264
265                         if (!CMP_VALID(rxcmp1, tmp_raw_cons,
266                                        cpr->cp_ring_struct))
267                                 break;
268
269                         raw_cons = tmp_raw_cons;
270                         cons = rxcmp->opaque;
271
272                         mbuf = rxr->rx_buf_ring[cons].mbuf;
273                         rte_prefetch0(mbuf);
274                         rxr->rx_buf_ring[cons].mbuf = NULL;
275
276                         /* Set constant fields from mbuf initializer. */
277                         _mm_store_si128((__m128i *)&mbuf->rearm_data,
278                                         mbuf_init);
279
280                         /* Set mbuf pkt_len, data_len, and rss_hash fields. */
281                         mm_rxcmp = _mm_load_si128((__m128i *)rxcmp);
282                         pkt_mb = _mm_shuffle_epi8(mm_rxcmp, shuf_msk);
283                         _mm_storeu_si128((void *)&mbuf->rx_descriptor_fields1,
284                                          pkt_mb);
285
286                         rte_compiler_barrier();
287
288                         if (rxcmp->flags_type & RX_PKT_CMPL_FLAGS_RSS_VALID)
289                                 mbuf->ol_flags |= PKT_RX_RSS_HASH;
290
291                         if (rxcmp1->flags2 &
292                             RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN) {
293                                 mbuf->vlan_tci = rxcmp1->metadata &
294                                         (RX_PKT_CMPL_METADATA_VID_MASK |
295                                         RX_PKT_CMPL_METADATA_DE |
296                                         RX_PKT_CMPL_METADATA_PRI_MASK);
297                                 mbuf->ol_flags |=
298                                         PKT_RX_VLAN | PKT_RX_VLAN_STRIPPED;
299                         }
300
301                         bnxt_parse_csum(mbuf, rxcmp1);
302                         mbuf->packet_type = bnxt_parse_pkt_type(rxcmp, rxcmp1);
303
304                         rx_pkts[nb_rx_pkts++] = mbuf;
305                 } else if (!BNXT_NUM_ASYNC_CPR(rxq->bp)) {
306                         evt =
307                         bnxt_event_hwrm_resp_handler(rxq->bp,
308                                                      (struct cmpl_base *)rxcmp);
309                 }
310
311                 raw_cons = NEXT_RAW_CMP(raw_cons);
312                 if (nb_rx_pkts == nb_pkts || evt)
313                         break;
314         }
315         rxr->rx_prod = RING_ADV(rxr->rx_ring_struct, rxr->rx_prod, nb_rx_pkts);
316
317         rxq->rxrearm_nb += nb_rx_pkts;
318         cpr->cp_raw_cons = raw_cons;
319         cpr->valid = !!(cpr->cp_raw_cons & cpr->cp_ring_struct->ring_size);
320         if (nb_rx_pkts || evt)
321                 bnxt_db_cq(cpr);
322
323         return nb_rx_pkts;
324 }
325
326 static void
327 bnxt_tx_cmp_vec(struct bnxt_tx_queue *txq, int nr_pkts)
328 {
329         struct bnxt_tx_ring_info *txr = txq->tx_ring;
330         struct rte_mbuf **free = txq->free;
331         uint16_t cons = txr->tx_cons;
332         unsigned int blk = 0;
333
334         while (nr_pkts--) {
335                 struct bnxt_sw_tx_bd *tx_buf;
336                 struct rte_mbuf *mbuf;
337
338                 tx_buf = &txr->tx_buf_ring[cons];
339                 cons = RING_NEXT(txr->tx_ring_struct, cons);
340                 mbuf = rte_pktmbuf_prefree_seg(tx_buf->mbuf);
341                 tx_buf->mbuf = NULL;
342
343                 if (blk && mbuf->pool != free[0]->pool) {
344                         rte_mempool_put_bulk(free[0]->pool, (void **)free, blk);
345                         blk = 0;
346                 }
347                 free[blk++] = mbuf;
348         }
349         if (blk)
350                 rte_mempool_put_bulk(free[0]->pool, (void **)free, blk);
351
352         txr->tx_cons = cons;
353 }
354
355 static void
356 bnxt_handle_tx_cp_vec(struct bnxt_tx_queue *txq)
357 {
358         struct bnxt_cp_ring_info *cpr = txq->cp_ring;
359         uint32_t raw_cons = cpr->cp_raw_cons;
360         uint32_t cons;
361         uint32_t nb_tx_pkts = 0;
362         struct tx_cmpl *txcmp;
363         struct cmpl_base *cp_desc_ring = cpr->cp_desc_ring;
364         struct bnxt_ring *cp_ring_struct = cpr->cp_ring_struct;
365         uint32_t ring_mask = cp_ring_struct->ring_mask;
366
367         do {
368                 cons = RING_CMPL(ring_mask, raw_cons);
369                 txcmp = (struct tx_cmpl *)&cp_desc_ring[cons];
370
371                 if (!CMP_VALID(txcmp, raw_cons, cp_ring_struct))
372                         break;
373
374                 if (likely(CMP_TYPE(txcmp) == TX_CMPL_TYPE_TX_L2))
375                         nb_tx_pkts += txcmp->opaque;
376                 else
377                         RTE_LOG_DP(ERR, PMD,
378                                    "Unhandled CMP type %02x\n",
379                                    CMP_TYPE(txcmp));
380                 raw_cons = NEXT_RAW_CMP(raw_cons);
381         } while (nb_tx_pkts < ring_mask);
382
383         cpr->valid = !!(raw_cons & cp_ring_struct->ring_size);
384         if (nb_tx_pkts) {
385                 bnxt_tx_cmp_vec(txq, nb_tx_pkts);
386                 cpr->cp_raw_cons = raw_cons;
387                 bnxt_db_cq(cpr);
388         }
389 }
390
391 #define TX_BD_FLAGS_CMPL ((1 << TX_BD_LONG_FLAGS_BD_CNT_SFT) | \
392                           TX_BD_SHORT_FLAGS_COAL_NOW | \
393                           TX_BD_SHORT_TYPE_TX_BD_SHORT | \
394                           TX_BD_LONG_FLAGS_PACKET_END)
395
396 #define TX_BD_FLAGS_NOCMPL (TX_BD_FLAGS_CMPL | TX_BD_LONG_FLAGS_NO_CMPL)
397
398 static inline uint32_t
399 bnxt_xmit_flags_len(uint16_t len, uint16_t flags)
400 {
401         switch (len >> 9) {
402         case 0:
403                 return flags | TX_BD_LONG_FLAGS_LHINT_LT512;
404         case 1:
405                 return flags | TX_BD_LONG_FLAGS_LHINT_LT1K;
406         case 2:
407                 return flags | TX_BD_LONG_FLAGS_LHINT_LT2K;
408         case 3:
409                 return flags | TX_BD_LONG_FLAGS_LHINT_LT2K;
410         default:
411                 return flags | TX_BD_LONG_FLAGS_LHINT_GTE2K;
412         }
413 }
414
415 static uint16_t
416 bnxt_xmit_fixed_burst_vec(void *tx_queue, struct rte_mbuf **tx_pkts,
417                           uint16_t nb_pkts)
418 {
419         struct bnxt_tx_queue *txq = tx_queue;
420         struct bnxt_tx_ring_info *txr = txq->tx_ring;
421         uint16_t prod = txr->tx_prod;
422         struct rte_mbuf *tx_mbuf;
423         struct tx_bd_long *txbd = NULL;
424         struct bnxt_sw_tx_bd *tx_buf;
425         uint16_t to_send;
426
427         nb_pkts = RTE_MIN(nb_pkts, bnxt_tx_avail(txq));
428
429         if (unlikely(nb_pkts == 0))
430                 return 0;
431
432         /* Handle TX burst request */
433         to_send = nb_pkts;
434         while (to_send) {
435                 tx_mbuf = *tx_pkts++;
436                 rte_prefetch0(tx_mbuf);
437
438                 tx_buf = &txr->tx_buf_ring[prod];
439                 tx_buf->mbuf = tx_mbuf;
440                 tx_buf->nr_bds = 1;
441
442                 txbd = &txr->tx_desc_ring[prod];
443                 txbd->address = tx_mbuf->buf_iova + tx_mbuf->data_off;
444                 txbd->len = tx_mbuf->data_len;
445                 txbd->flags_type = bnxt_xmit_flags_len(tx_mbuf->data_len,
446                                                        TX_BD_FLAGS_NOCMPL);
447                 prod = RING_NEXT(txr->tx_ring_struct, prod);
448                 to_send--;
449         }
450
451         /* Request a completion for last packet in burst */
452         if (txbd) {
453                 txbd->opaque = nb_pkts;
454                 txbd->flags_type &= ~TX_BD_LONG_FLAGS_NO_CMPL;
455         }
456
457         rte_compiler_barrier();
458         bnxt_db_write(&txr->tx_db, prod);
459
460         txr->tx_prod = prod;
461
462         return nb_pkts;
463 }
464
465 uint16_t
466 bnxt_xmit_pkts_vec(void *tx_queue, struct rte_mbuf **tx_pkts,
467                    uint16_t nb_pkts)
468 {
469         int nb_sent = 0;
470         struct bnxt_tx_queue *txq = tx_queue;
471
472         /* Tx queue was stopped; wait for it to be restarted */
473         if (unlikely(!txq->tx_started)) {
474                 PMD_DRV_LOG(DEBUG, "Tx q stopped;return\n");
475                 return 0;
476         }
477
478         /* Handle TX completions */
479         if (bnxt_tx_bds_in_hw(txq) >= txq->tx_free_thresh)
480                 bnxt_handle_tx_cp_vec(txq);
481
482         while (nb_pkts) {
483                 uint16_t ret, num;
484
485                 num = RTE_MIN(nb_pkts, RTE_BNXT_MAX_TX_BURST);
486                 ret = bnxt_xmit_fixed_burst_vec(tx_queue,
487                                                 &tx_pkts[nb_sent],
488                                                 num);
489                 nb_sent += ret;
490                 nb_pkts -= ret;
491                 if (ret < num)
492                         break;
493         }
494
495         return nb_sent;
496 }
497
498 int __rte_cold
499 bnxt_rxq_vec_setup(struct bnxt_rx_queue *rxq)
500 {
501         uintptr_t p;
502         struct rte_mbuf mb_def = { .buf_addr = 0 }; /* zeroed mbuf */
503
504         mb_def.nb_segs = 1;
505         mb_def.data_off = RTE_PKTMBUF_HEADROOM;
506         mb_def.port = rxq->port_id;
507         rte_mbuf_refcnt_set(&mb_def, 1);
508
509         /* prevent compiler reordering: rearm_data covers previous fields */
510         rte_compiler_barrier();
511         p = (uintptr_t)&mb_def.rearm_data;
512         rxq->mbuf_initializer = *(uint64_t *)p;
513         rxq->rxrearm_nb = 0;
514         rxq->rxrearm_start = 0;
515         return 0;
516 }