net/bnxt: fix mark id update to mbuf
[dpdk.git] / drivers / net / bnxt / bnxt_rxr.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2014-2018 Broadcom
3  * All rights reserved.
4  */
5
6 #include <inttypes.h>
7 #include <stdbool.h>
8
9 #include <rte_bitmap.h>
10 #include <rte_byteorder.h>
11 #include <rte_malloc.h>
12 #include <rte_memory.h>
13
14 #include "bnxt.h"
15 #include "bnxt_reps.h"
16 #include "bnxt_ring.h"
17 #include "bnxt_rxr.h"
18 #include "bnxt_rxq.h"
19 #include "hsi_struct_def_dpdk.h"
20 #ifdef RTE_LIBRTE_IEEE1588
21 #include "bnxt_hwrm.h"
22 #endif
23
24 #include <bnxt_tf_common.h>
25 #include <ulp_mark_mgr.h>
26
27 /*
28  * RX Ring handling
29  */
30
31 static inline struct rte_mbuf *__bnxt_alloc_rx_data(struct rte_mempool *mb)
32 {
33         struct rte_mbuf *data;
34
35         data = rte_mbuf_raw_alloc(mb);
36
37         return data;
38 }
39
40 static inline int bnxt_alloc_rx_data(struct bnxt_rx_queue *rxq,
41                                      struct bnxt_rx_ring_info *rxr,
42                                      uint16_t prod)
43 {
44         struct rx_prod_pkt_bd *rxbd = &rxr->rx_desc_ring[prod];
45         struct bnxt_sw_rx_bd *rx_buf = &rxr->rx_buf_ring[prod];
46         struct rte_mbuf *mbuf;
47
48         mbuf = __bnxt_alloc_rx_data(rxq->mb_pool);
49         if (!mbuf) {
50                 rte_atomic64_inc(&rxq->rx_mbuf_alloc_fail);
51                 return -ENOMEM;
52         }
53
54         rx_buf->mbuf = mbuf;
55         mbuf->data_off = RTE_PKTMBUF_HEADROOM;
56
57         rxbd->address = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
58
59         return 0;
60 }
61
62 static inline int bnxt_alloc_ag_data(struct bnxt_rx_queue *rxq,
63                                      struct bnxt_rx_ring_info *rxr,
64                                      uint16_t prod)
65 {
66         struct rx_prod_pkt_bd *rxbd = &rxr->ag_desc_ring[prod];
67         struct bnxt_sw_rx_bd *rx_buf = &rxr->ag_buf_ring[prod];
68         struct rte_mbuf *mbuf;
69
70         if (rxbd == NULL) {
71                 PMD_DRV_LOG(ERR, "Jumbo Frame. rxbd is NULL\n");
72                 return -EINVAL;
73         }
74
75         if (rx_buf == NULL) {
76                 PMD_DRV_LOG(ERR, "Jumbo Frame. rx_buf is NULL\n");
77                 return -EINVAL;
78         }
79
80         mbuf = __bnxt_alloc_rx_data(rxq->mb_pool);
81         if (!mbuf) {
82                 rte_atomic64_inc(&rxq->rx_mbuf_alloc_fail);
83                 return -ENOMEM;
84         }
85
86         rx_buf->mbuf = mbuf;
87         mbuf->data_off = RTE_PKTMBUF_HEADROOM;
88
89         rxbd->address = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
90
91         return 0;
92 }
93
94 static inline void bnxt_reuse_rx_mbuf(struct bnxt_rx_ring_info *rxr,
95                                struct rte_mbuf *mbuf)
96 {
97         uint16_t prod = RING_NEXT(rxr->rx_ring_struct, rxr->rx_prod);
98         struct bnxt_sw_rx_bd *prod_rx_buf;
99         struct rx_prod_pkt_bd *prod_bd;
100
101         prod_rx_buf = &rxr->rx_buf_ring[prod];
102
103         RTE_ASSERT(prod_rx_buf->mbuf == NULL);
104         RTE_ASSERT(mbuf != NULL);
105
106         prod_rx_buf->mbuf = mbuf;
107
108         prod_bd = &rxr->rx_desc_ring[prod];
109
110         prod_bd->address = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
111
112         rxr->rx_prod = prod;
113 }
114
115 static inline
116 struct rte_mbuf *bnxt_consume_rx_buf(struct bnxt_rx_ring_info *rxr,
117                                      uint16_t cons)
118 {
119         struct bnxt_sw_rx_bd *cons_rx_buf;
120         struct rte_mbuf *mbuf;
121
122         cons_rx_buf = &rxr->rx_buf_ring[cons];
123         RTE_ASSERT(cons_rx_buf->mbuf != NULL);
124         mbuf = cons_rx_buf->mbuf;
125         cons_rx_buf->mbuf = NULL;
126         return mbuf;
127 }
128
129 static void bnxt_tpa_start(struct bnxt_rx_queue *rxq,
130                            struct rx_tpa_start_cmpl *tpa_start,
131                            struct rx_tpa_start_cmpl_hi *tpa_start1)
132 {
133         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
134         uint16_t agg_id;
135         uint16_t data_cons;
136         struct bnxt_tpa_info *tpa_info;
137         struct rte_mbuf *mbuf;
138
139         agg_id = bnxt_tpa_start_agg_id(rxq->bp, tpa_start);
140
141         data_cons = tpa_start->opaque;
142         tpa_info = &rxr->tpa_info[agg_id];
143
144         mbuf = bnxt_consume_rx_buf(rxr, data_cons);
145
146         bnxt_reuse_rx_mbuf(rxr, tpa_info->mbuf);
147
148         tpa_info->agg_count = 0;
149         tpa_info->mbuf = mbuf;
150         tpa_info->len = rte_le_to_cpu_32(tpa_start->len);
151
152         mbuf->nb_segs = 1;
153         mbuf->next = NULL;
154         mbuf->pkt_len = rte_le_to_cpu_32(tpa_start->len);
155         mbuf->data_len = mbuf->pkt_len;
156         mbuf->port = rxq->port_id;
157         mbuf->ol_flags = PKT_RX_LRO;
158         if (likely(tpa_start->flags_type &
159                    rte_cpu_to_le_32(RX_TPA_START_CMPL_FLAGS_RSS_VALID))) {
160                 mbuf->hash.rss = rte_le_to_cpu_32(tpa_start->rss_hash);
161                 mbuf->ol_flags |= PKT_RX_RSS_HASH;
162         } else {
163                 mbuf->hash.fdir.id = rte_le_to_cpu_16(tpa_start1->cfa_code);
164                 mbuf->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
165         }
166         if (tpa_start1->flags2 &
167             rte_cpu_to_le_32(RX_TPA_START_CMPL_FLAGS2_META_FORMAT_VLAN)) {
168                 mbuf->vlan_tci = rte_le_to_cpu_32(tpa_start1->metadata);
169                 mbuf->ol_flags |= PKT_RX_VLAN | PKT_RX_VLAN_STRIPPED;
170         }
171         if (likely(tpa_start1->flags2 &
172                    rte_cpu_to_le_32(RX_TPA_START_CMPL_FLAGS2_L4_CS_CALC)))
173                 mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
174
175         /* recycle next mbuf */
176         data_cons = RING_NEXT(rxr->rx_ring_struct, data_cons);
177         bnxt_reuse_rx_mbuf(rxr, bnxt_consume_rx_buf(rxr, data_cons));
178 }
179
180 static int bnxt_agg_bufs_valid(struct bnxt_cp_ring_info *cpr,
181                 uint8_t agg_bufs, uint32_t raw_cp_cons)
182 {
183         uint16_t last_cp_cons;
184         struct rx_pkt_cmpl *agg_cmpl;
185
186         raw_cp_cons = ADV_RAW_CMP(raw_cp_cons, agg_bufs);
187         last_cp_cons = RING_CMP(cpr->cp_ring_struct, raw_cp_cons);
188         agg_cmpl = (struct rx_pkt_cmpl *)&cpr->cp_desc_ring[last_cp_cons];
189         cpr->valid = FLIP_VALID(raw_cp_cons,
190                                 cpr->cp_ring_struct->ring_mask,
191                                 cpr->valid);
192         return CMP_VALID(agg_cmpl, raw_cp_cons, cpr->cp_ring_struct);
193 }
194
195 /* TPA consume agg buffer out of order, allocate connected data only */
196 static int bnxt_prod_ag_mbuf(struct bnxt_rx_queue *rxq)
197 {
198         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
199         uint16_t next = RING_NEXT(rxr->ag_ring_struct, rxr->ag_prod);
200
201         /* TODO batch allocation for better performance */
202         while (rte_bitmap_get(rxr->ag_bitmap, next)) {
203                 if (unlikely(bnxt_alloc_ag_data(rxq, rxr, next))) {
204                         PMD_DRV_LOG(ERR,
205                                 "agg mbuf alloc failed: prod=0x%x\n", next);
206                         break;
207                 }
208                 rte_bitmap_clear(rxr->ag_bitmap, next);
209                 rxr->ag_prod = next;
210                 next = RING_NEXT(rxr->ag_ring_struct, next);
211         }
212
213         return 0;
214 }
215
216 static int bnxt_rx_pages(struct bnxt_rx_queue *rxq,
217                          struct rte_mbuf *mbuf, uint32_t *tmp_raw_cons,
218                          uint8_t agg_buf, struct bnxt_tpa_info *tpa_info)
219 {
220         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
221         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
222         int i;
223         uint16_t cp_cons, ag_cons;
224         struct rx_pkt_cmpl *rxcmp;
225         struct rte_mbuf *last = mbuf;
226         bool is_thor_tpa = tpa_info && BNXT_CHIP_THOR(rxq->bp);
227
228         for (i = 0; i < agg_buf; i++) {
229                 struct bnxt_sw_rx_bd *ag_buf;
230                 struct rte_mbuf *ag_mbuf;
231
232                 if (is_thor_tpa) {
233                         rxcmp = (void *)&tpa_info->agg_arr[i];
234                 } else {
235                         *tmp_raw_cons = NEXT_RAW_CMP(*tmp_raw_cons);
236                         cp_cons = RING_CMP(cpr->cp_ring_struct, *tmp_raw_cons);
237                         rxcmp = (struct rx_pkt_cmpl *)
238                                         &cpr->cp_desc_ring[cp_cons];
239                 }
240
241 #ifdef BNXT_DEBUG
242                 bnxt_dump_cmpl(cp_cons, rxcmp);
243 #endif
244
245                 ag_cons = rxcmp->opaque;
246                 RTE_ASSERT(ag_cons <= rxr->ag_ring_struct->ring_mask);
247                 ag_buf = &rxr->ag_buf_ring[ag_cons];
248                 ag_mbuf = ag_buf->mbuf;
249                 RTE_ASSERT(ag_mbuf != NULL);
250
251                 ag_mbuf->data_len = rte_le_to_cpu_16(rxcmp->len);
252
253                 mbuf->nb_segs++;
254                 mbuf->pkt_len += ag_mbuf->data_len;
255
256                 last->next = ag_mbuf;
257                 last = ag_mbuf;
258
259                 ag_buf->mbuf = NULL;
260
261                 /*
262                  * As aggregation buffer consumed out of order in TPA module,
263                  * use bitmap to track freed slots to be allocated and notified
264                  * to NIC
265                  */
266                 rte_bitmap_set(rxr->ag_bitmap, ag_cons);
267         }
268         bnxt_prod_ag_mbuf(rxq);
269         return 0;
270 }
271
272 static inline struct rte_mbuf *bnxt_tpa_end(
273                 struct bnxt_rx_queue *rxq,
274                 uint32_t *raw_cp_cons,
275                 struct rx_tpa_end_cmpl *tpa_end,
276                 struct rx_tpa_end_cmpl_hi *tpa_end1)
277 {
278         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
279         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
280         uint16_t agg_id;
281         struct rte_mbuf *mbuf;
282         uint8_t agg_bufs;
283         uint8_t payload_offset;
284         struct bnxt_tpa_info *tpa_info;
285
286         if (BNXT_CHIP_THOR(rxq->bp)) {
287                 struct rx_tpa_v2_end_cmpl *th_tpa_end;
288                 struct rx_tpa_v2_end_cmpl_hi *th_tpa_end1;
289
290                 th_tpa_end = (void *)tpa_end;
291                 th_tpa_end1 = (void *)tpa_end1;
292                 agg_id = BNXT_TPA_END_AGG_ID_TH(th_tpa_end);
293                 agg_bufs = BNXT_TPA_END_AGG_BUFS_TH(th_tpa_end1);
294                 payload_offset = th_tpa_end1->payload_offset;
295         } else {
296                 agg_id = BNXT_TPA_END_AGG_ID(tpa_end);
297                 agg_bufs = BNXT_TPA_END_AGG_BUFS(tpa_end);
298                 if (!bnxt_agg_bufs_valid(cpr, agg_bufs, *raw_cp_cons))
299                         return NULL;
300                 payload_offset = tpa_end->payload_offset;
301         }
302
303         tpa_info = &rxr->tpa_info[agg_id];
304         mbuf = tpa_info->mbuf;
305         RTE_ASSERT(mbuf != NULL);
306
307         rte_prefetch0(mbuf);
308         if (agg_bufs) {
309                 bnxt_rx_pages(rxq, mbuf, raw_cp_cons, agg_bufs, tpa_info);
310         }
311         mbuf->l4_len = payload_offset;
312
313         struct rte_mbuf *new_data = __bnxt_alloc_rx_data(rxq->mb_pool);
314         RTE_ASSERT(new_data != NULL);
315         if (!new_data) {
316                 rte_atomic64_inc(&rxq->rx_mbuf_alloc_fail);
317                 return NULL;
318         }
319         tpa_info->mbuf = new_data;
320
321         return mbuf;
322 }
323
324 static uint32_t
325 bnxt_parse_pkt_type(struct rx_pkt_cmpl *rxcmp, struct rx_pkt_cmpl_hi *rxcmp1)
326 {
327         uint32_t l3, pkt_type = 0;
328         uint32_t t_ipcs = 0, ip6 = 0, vlan = 0;
329         uint32_t flags_type;
330
331         vlan = !!(rxcmp1->flags2 &
332                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN));
333         pkt_type |= vlan ? RTE_PTYPE_L2_ETHER_VLAN : RTE_PTYPE_L2_ETHER;
334
335         t_ipcs = !!(rxcmp1->flags2 &
336                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_T_IP_CS_CALC));
337         ip6 = !!(rxcmp1->flags2 &
338                  rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_IP_TYPE));
339
340         flags_type = rxcmp->flags_type &
341                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS_ITYPE_MASK);
342
343         if (!t_ipcs && !ip6)
344                 l3 = RTE_PTYPE_L3_IPV4_EXT_UNKNOWN;
345         else if (!t_ipcs && ip6)
346                 l3 = RTE_PTYPE_L3_IPV6_EXT_UNKNOWN;
347         else if (t_ipcs && !ip6)
348                 l3 = RTE_PTYPE_INNER_L3_IPV4_EXT_UNKNOWN;
349         else
350                 l3 = RTE_PTYPE_INNER_L3_IPV6_EXT_UNKNOWN;
351
352         switch (flags_type) {
353         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_ICMP):
354                 if (!t_ipcs)
355                         pkt_type |= l3 | RTE_PTYPE_L4_ICMP;
356                 else
357                         pkt_type |= l3 | RTE_PTYPE_INNER_L4_ICMP;
358                 break;
359
360         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_TCP):
361                 if (!t_ipcs)
362                         pkt_type |= l3 | RTE_PTYPE_L4_TCP;
363                 else
364                         pkt_type |= l3 | RTE_PTYPE_INNER_L4_TCP;
365                 break;
366
367         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_UDP):
368                 if (!t_ipcs)
369                         pkt_type |= l3 | RTE_PTYPE_L4_UDP;
370                 else
371                         pkt_type |= l3 | RTE_PTYPE_INNER_L4_UDP;
372                 break;
373
374         case RTE_LE32(RX_PKT_CMPL_FLAGS_ITYPE_IP):
375                 pkt_type |= l3;
376                 break;
377         }
378
379         return pkt_type;
380 }
381
382 #ifdef RTE_LIBRTE_IEEE1588
383 static void
384 bnxt_get_rx_ts_thor(struct bnxt *bp, uint32_t rx_ts_cmpl)
385 {
386         uint64_t systime_cycles = 0;
387
388         if (!BNXT_CHIP_THOR(bp))
389                 return;
390
391         /* On Thor, Rx timestamps are provided directly in the
392          * Rx completion records to the driver. Only 32 bits of
393          * the timestamp is present in the completion. Driver needs
394          * to read the current 48 bit free running timer using the
395          * HWRM_PORT_TS_QUERY command and combine the upper 16 bits
396          * from the HWRM response with the lower 32 bits in the
397          * Rx completion to produce the 48 bit timestamp for the Rx packet
398          */
399         bnxt_hwrm_port_ts_query(bp, BNXT_PTP_FLAGS_CURRENT_TIME,
400                                 &systime_cycles);
401         bp->ptp_cfg->rx_timestamp = (systime_cycles & 0xFFFF00000000);
402         bp->ptp_cfg->rx_timestamp |= rx_ts_cmpl;
403 }
404 #endif
405
406 static uint32_t
407 bnxt_ulp_set_mark_in_mbuf(struct bnxt *bp, struct rx_pkt_cmpl_hi *rxcmp1,
408                           struct rte_mbuf *mbuf, uint32_t *vfr_flag)
409 {
410         uint32_t cfa_code;
411         uint32_t meta_fmt;
412         uint32_t meta;
413         bool gfid = false;
414         uint32_t mark_id;
415         uint32_t flags2;
416         uint32_t gfid_support = 0;
417         int rc;
418
419         if (BNXT_GFID_ENABLED(bp))
420                 gfid_support = 1;
421
422         cfa_code = rte_le_to_cpu_16(rxcmp1->cfa_code);
423         flags2 = rte_le_to_cpu_32(rxcmp1->flags2);
424         meta = rte_le_to_cpu_32(rxcmp1->metadata);
425
426         /*
427          * The flags field holds extra bits of info from [6:4]
428          * which indicate if the flow is in TCAM or EM or EEM
429          */
430         meta_fmt = (flags2 & BNXT_CFA_META_FMT_MASK) >>
431                 BNXT_CFA_META_FMT_SHFT;
432
433         switch (meta_fmt) {
434         case 0:
435                 if (gfid_support) {
436                         /* Not an LFID or GFID, a flush cmd. */
437                         goto skip_mark;
438                 } else {
439                         /* LFID mode, no vlan scenario */
440                         gfid = false;
441                 }
442                 break;
443         case 4:
444         case 5:
445                 /*
446                  * EM/TCAM case
447                  * Assume that EM doesn't support Mark due to GFID
448                  * collisions with EEM.  Simply return without setting the mark
449                  * in the mbuf.
450                  */
451                 if (BNXT_CFA_META_EM_TEST(meta)) {
452                         /*This is EM hit {EM(1), GFID[27:16], 19'd0 or vtag } */
453                         gfid = true;
454                         meta >>= BNXT_RX_META_CFA_CODE_SHIFT;
455                         cfa_code |= meta << BNXT_CFA_CODE_META_SHIFT;
456                 } else {
457                         /*
458                          * It is a TCAM entry, so it is an LFID.
459                          * The TCAM IDX and Mode can also be determined
460                          * by decoding the meta_data. We are not
461                          * using these for now.
462                          */
463                 }
464                 break;
465         case 6:
466         case 7:
467                 /* EEM Case, only using gfid in EEM for now. */
468                 gfid = true;
469
470                 /*
471                  * For EEM flows, The first part of cfa_code is 16 bits.
472                  * The second part is embedded in the
473                  * metadata field from bit 19 onwards. The driver needs to
474                  * ignore the first 19 bits of metadata and use the next 12
475                  * bits as higher 12 bits of cfa_code.
476                  */
477                 meta >>= BNXT_RX_META_CFA_CODE_SHIFT;
478                 cfa_code |= meta << BNXT_CFA_CODE_META_SHIFT;
479                 break;
480         default:
481                 /* For other values, the cfa_code is assumed to be an LFID. */
482                 break;
483         }
484
485         rc = ulp_mark_db_mark_get(bp->ulp_ctx, gfid,
486                                   cfa_code, vfr_flag, &mark_id);
487         if (!rc) {
488                 /* VF to VFR Rx path. So, skip mark_id injection in mbuf */
489                 if (vfr_flag && *vfr_flag)
490                         return mark_id;
491                 /* Got the mark, write it to the mbuf and return */
492                 mbuf->hash.fdir.hi = mark_id;
493                 mbuf->udata64 = (cfa_code & 0xffffffffull) << 32;
494                 mbuf->hash.fdir.id = rxcmp1->cfa_code;
495                 mbuf->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
496                 return mark_id;
497         }
498
499 skip_mark:
500         mbuf->hash.fdir.hi = 0;
501         mbuf->hash.fdir.id = 0;
502
503         return 0;
504 }
505
506 void bnxt_set_mark_in_mbuf(struct bnxt *bp,
507                            struct rx_pkt_cmpl_hi *rxcmp1,
508                            struct rte_mbuf *mbuf)
509 {
510         uint32_t cfa_code = 0;
511         uint8_t meta_fmt = 0;
512         uint16_t flags2 = 0;
513         uint32_t meta =  0;
514
515         cfa_code = rte_le_to_cpu_16(rxcmp1->cfa_code);
516         if (!cfa_code)
517                 return;
518
519         if (cfa_code && !bp->mark_table[cfa_code].valid)
520                 return;
521
522         flags2 = rte_le_to_cpu_16(rxcmp1->flags2);
523         meta = rte_le_to_cpu_32(rxcmp1->metadata);
524         if (meta) {
525                 meta >>= BNXT_RX_META_CFA_CODE_SHIFT;
526
527                 /* The flags field holds extra bits of info from [6:4]
528                  * which indicate if the flow is in TCAM or EM or EEM
529                  */
530                 meta_fmt = (flags2 & BNXT_CFA_META_FMT_MASK) >>
531                            BNXT_CFA_META_FMT_SHFT;
532
533                 /* meta_fmt == 4 => 'b100 => 'b10x => EM.
534                  * meta_fmt == 5 => 'b101 => 'b10x => EM + VLAN
535                  * meta_fmt == 6 => 'b110 => 'b11x => EEM
536                  * meta_fmt == 7 => 'b111 => 'b11x => EEM + VLAN.
537                  */
538                 meta_fmt >>= BNXT_CFA_META_FMT_EM_EEM_SHFT;
539         }
540
541         mbuf->hash.fdir.hi = bp->mark_table[cfa_code].mark_id;
542         mbuf->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
543 }
544
545 static int bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
546                        struct bnxt_rx_queue *rxq, uint32_t *raw_cons)
547 {
548         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
549         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
550         struct rx_pkt_cmpl *rxcmp;
551         struct rx_pkt_cmpl_hi *rxcmp1;
552         uint32_t tmp_raw_cons = *raw_cons;
553         uint16_t cons, prod, cp_cons =
554             RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
555         struct rte_mbuf *mbuf;
556         int rc = 0;
557         uint8_t agg_buf = 0;
558         uint16_t cmp_type;
559         uint32_t flags2_f = 0, vfr_flag = 0, mark_id = 0;
560         uint16_t flags_type;
561         struct bnxt *bp = rxq->bp;
562
563         rxcmp = (struct rx_pkt_cmpl *)
564             &cpr->cp_desc_ring[cp_cons];
565
566         cmp_type = CMP_TYPE(rxcmp);
567
568         if (cmp_type == RX_TPA_V2_ABUF_CMPL_TYPE_RX_TPA_AGG) {
569                 struct rx_tpa_v2_abuf_cmpl *rx_agg = (void *)rxcmp;
570                 uint16_t agg_id = rte_cpu_to_le_16(rx_agg->agg_id);
571                 struct bnxt_tpa_info *tpa_info;
572
573                 tpa_info = &rxr->tpa_info[agg_id];
574                 RTE_ASSERT(tpa_info->agg_count < 16);
575                 tpa_info->agg_arr[tpa_info->agg_count++] = *rx_agg;
576                 rc = -EINVAL; /* Continue w/o new mbuf */
577                 goto next_rx;
578         }
579
580         tmp_raw_cons = NEXT_RAW_CMP(tmp_raw_cons);
581         cp_cons = RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
582         rxcmp1 = (struct rx_pkt_cmpl_hi *)&cpr->cp_desc_ring[cp_cons];
583
584         if (!CMP_VALID(rxcmp1, tmp_raw_cons, cpr->cp_ring_struct))
585                 return -EBUSY;
586
587         cpr->valid = FLIP_VALID(cp_cons,
588                                 cpr->cp_ring_struct->ring_mask,
589                                 cpr->valid);
590
591         if (cmp_type == RX_TPA_START_CMPL_TYPE_RX_TPA_START) {
592                 bnxt_tpa_start(rxq, (struct rx_tpa_start_cmpl *)rxcmp,
593                                (struct rx_tpa_start_cmpl_hi *)rxcmp1);
594                 rc = -EINVAL; /* Continue w/o new mbuf */
595                 goto next_rx;
596         } else if (cmp_type == RX_TPA_END_CMPL_TYPE_RX_TPA_END) {
597                 mbuf = bnxt_tpa_end(rxq, &tmp_raw_cons,
598                                    (struct rx_tpa_end_cmpl *)rxcmp,
599                                    (struct rx_tpa_end_cmpl_hi *)rxcmp1);
600                 if (unlikely(!mbuf))
601                         return -EBUSY;
602                 *rx_pkt = mbuf;
603                 goto next_rx;
604         } else if (cmp_type != 0x11) {
605                 rc = -EINVAL;
606                 goto next_rx;
607         }
608
609         agg_buf = (rxcmp->agg_bufs_v1 & RX_PKT_CMPL_AGG_BUFS_MASK)
610                         >> RX_PKT_CMPL_AGG_BUFS_SFT;
611         if (agg_buf && !bnxt_agg_bufs_valid(cpr, agg_buf, tmp_raw_cons))
612                 return -EBUSY;
613
614         prod = rxr->rx_prod;
615
616         cons = rxcmp->opaque;
617         mbuf = bnxt_consume_rx_buf(rxr, cons);
618         if (mbuf == NULL)
619                 return -EBUSY;
620
621         rte_prefetch0(mbuf);
622
623         mbuf->data_off = RTE_PKTMBUF_HEADROOM;
624         mbuf->nb_segs = 1;
625         mbuf->next = NULL;
626         mbuf->pkt_len = rxcmp->len;
627         mbuf->data_len = mbuf->pkt_len;
628         mbuf->port = rxq->port_id;
629         mbuf->ol_flags = 0;
630
631         flags_type = rte_le_to_cpu_16(rxcmp->flags_type);
632         if (flags_type & RX_PKT_CMPL_FLAGS_RSS_VALID) {
633                 mbuf->hash.rss = rxcmp->rss_hash;
634                 mbuf->ol_flags |= PKT_RX_RSS_HASH;
635         }
636
637         if (BNXT_TRUFLOW_EN(bp))
638                 mark_id = bnxt_ulp_set_mark_in_mbuf(rxq->bp, rxcmp1, mbuf,
639                                                     &vfr_flag);
640         else
641                 bnxt_set_mark_in_mbuf(rxq->bp, rxcmp1, mbuf);
642
643 #ifdef RTE_LIBRTE_IEEE1588
644         if (unlikely((flags_type & RX_PKT_CMPL_FLAGS_MASK) ==
645                      RX_PKT_CMPL_FLAGS_ITYPE_PTP_W_TIMESTAMP)) {
646                 mbuf->ol_flags |= PKT_RX_IEEE1588_PTP | PKT_RX_IEEE1588_TMST;
647                 bnxt_get_rx_ts_thor(rxq->bp, rxcmp1->reorder);
648         }
649 #endif
650         if (agg_buf)
651                 bnxt_rx_pages(rxq, mbuf, &tmp_raw_cons, agg_buf, NULL);
652
653         if (rxcmp1->flags2 & RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN) {
654                 mbuf->vlan_tci = rxcmp1->metadata &
655                         (RX_PKT_CMPL_METADATA_VID_MASK |
656                         RX_PKT_CMPL_METADATA_DE |
657                         RX_PKT_CMPL_METADATA_PRI_MASK);
658                 mbuf->ol_flags |= PKT_RX_VLAN | PKT_RX_VLAN_STRIPPED;
659         }
660
661         flags2_f = flags2_0xf(rxcmp1);
662         /* IP Checksum */
663         if (likely(IS_IP_NONTUNNEL_PKT(flags2_f))) {
664                 if (unlikely(RX_CMP_IP_CS_ERROR(rxcmp1)))
665                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_BAD;
666                 else if (unlikely(RX_CMP_IP_CS_UNKNOWN(rxcmp1)))
667                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_UNKNOWN;
668                 else
669                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_GOOD;
670         } else if (IS_IP_TUNNEL_PKT(flags2_f)) {
671                 if (unlikely(RX_CMP_IP_OUTER_CS_ERROR(rxcmp1) ||
672                              RX_CMP_IP_CS_ERROR(rxcmp1)))
673                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_BAD;
674                 else if (unlikely(RX_CMP_IP_CS_UNKNOWN(rxcmp1)))
675                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_UNKNOWN;
676                 else
677                         mbuf->ol_flags |= PKT_RX_IP_CKSUM_GOOD;
678         }
679
680         /* L4 Checksum */
681         if (likely(IS_L4_NONTUNNEL_PKT(flags2_f))) {
682                 if (unlikely(RX_CMP_L4_INNER_CS_ERR2(rxcmp1)))
683                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_BAD;
684                 else
685                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
686         } else if (IS_L4_TUNNEL_PKT(flags2_f)) {
687                 if (unlikely(RX_CMP_L4_INNER_CS_ERR2(rxcmp1)))
688                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_BAD;
689                 else
690                         mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
691                 if (unlikely(RX_CMP_L4_OUTER_CS_ERR2(rxcmp1))) {
692                         mbuf->ol_flags |= PKT_RX_OUTER_L4_CKSUM_BAD;
693                 } else if (unlikely(IS_L4_TUNNEL_PKT_ONLY_INNER_L4_CS
694                                     (flags2_f))) {
695                         mbuf->ol_flags |= PKT_RX_OUTER_L4_CKSUM_UNKNOWN;
696                 } else {
697                         mbuf->ol_flags |= PKT_RX_OUTER_L4_CKSUM_GOOD;
698                 }
699         } else if (unlikely(RX_CMP_L4_CS_UNKNOWN(rxcmp1))) {
700                 mbuf->ol_flags |= PKT_RX_L4_CKSUM_UNKNOWN;
701         }
702
703         mbuf->packet_type = bnxt_parse_pkt_type(rxcmp, rxcmp1);
704
705 #ifdef BNXT_DEBUG
706         if (rxcmp1->errors_v2 & RX_CMP_L2_ERRORS) {
707                 /* Re-install the mbuf back to the rx ring */
708                 bnxt_reuse_rx_mbuf(rxr, cons, mbuf);
709
710                 rc = -EIO;
711                 goto next_rx;
712         }
713 #endif
714         /*
715          * TODO: Redesign this....
716          * If the allocation fails, the packet does not get received.
717          * Simply returning this will result in slowly falling behind
718          * on the producer ring buffers.
719          * Instead, "filling up" the producer just before ringing the
720          * doorbell could be a better solution since it will let the
721          * producer ring starve until memory is available again pushing
722          * the drops into hardware and getting them out of the driver
723          * allowing recovery to a full producer ring.
724          *
725          * This could also help with cache usage by preventing per-packet
726          * calls in favour of a tight loop with the same function being called
727          * in it.
728          */
729         prod = RING_NEXT(rxr->rx_ring_struct, prod);
730         if (bnxt_alloc_rx_data(rxq, rxr, prod)) {
731                 PMD_DRV_LOG(ERR, "mbuf alloc failed with prod=0x%x\n", prod);
732                 rc = -ENOMEM;
733                 goto rx;
734         }
735         rxr->rx_prod = prod;
736         /*
737          * All MBUFs are allocated with the same size under DPDK,
738          * no optimization for rx_copy_thresh
739          */
740 rx:
741         *rx_pkt = mbuf;
742
743         if (BNXT_TRUFLOW_EN(bp) &&
744             (BNXT_VF_IS_TRUSTED(bp) || BNXT_PF(bp)) &&
745             vfr_flag) {
746                 if (!bnxt_vfr_recv(mark_id, rxq->queue_id, mbuf)) {
747                         /* Now return an error so that nb_rx_pkts is not
748                          * incremented.
749                          * This packet was meant to be given to the representor.
750                          * So no need to account the packet and give it to
751                          * parent Rx burst function.
752                          */
753                         rc = -ENODEV;
754                 }
755         }
756
757 next_rx:
758
759         *raw_cons = tmp_raw_cons;
760
761         return rc;
762 }
763
764 uint16_t bnxt_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
765                                uint16_t nb_pkts)
766 {
767         struct bnxt_rx_queue *rxq = rx_queue;
768         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
769         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
770         uint32_t raw_cons = cpr->cp_raw_cons;
771         uint32_t cons;
772         int nb_rx_pkts = 0;
773         int nb_rep_rx_pkts = 0;
774         struct rx_pkt_cmpl *rxcmp;
775         uint16_t prod = rxr->rx_prod;
776         uint16_t ag_prod = rxr->ag_prod;
777         int rc = 0;
778         bool evt = false;
779
780         if (unlikely(is_bnxt_in_error(rxq->bp)))
781                 return 0;
782
783         /* If Rx Q was stopped return */
784         if (unlikely(!rxq->rx_started ||
785                      !rte_spinlock_trylock(&rxq->lock)))
786                 return 0;
787
788 #if defined(RTE_ARCH_X86) || defined(RTE_ARCH_ARM64)
789         /*
790          * Replenish buffers if needed when a transition has been made from
791          * vector- to non-vector- receive processing.
792          */
793         while (unlikely(rxq->rxrearm_nb)) {
794                 if (!bnxt_alloc_rx_data(rxq, rxr, rxq->rxrearm_start)) {
795                         rxr->rx_prod = rxq->rxrearm_start;
796                         bnxt_db_write(&rxr->rx_db, rxr->rx_prod);
797                         rxq->rxrearm_start++;
798                         rxq->rxrearm_nb--;
799                 } else {
800                         /* Retry allocation on next call. */
801                         break;
802                 }
803         }
804 #endif
805
806         /* Handle RX burst request */
807         while (1) {
808                 cons = RING_CMP(cpr->cp_ring_struct, raw_cons);
809                 rte_prefetch0(&cpr->cp_desc_ring[cons]);
810                 rxcmp = (struct rx_pkt_cmpl *)&cpr->cp_desc_ring[cons];
811
812                 if (!CMP_VALID(rxcmp, raw_cons, cpr->cp_ring_struct))
813                         break;
814                 cpr->valid = FLIP_VALID(cons,
815                                         cpr->cp_ring_struct->ring_mask,
816                                         cpr->valid);
817
818                 /* TODO: Avoid magic numbers... */
819                 if ((CMP_TYPE(rxcmp) & 0x30) == 0x10) {
820                         rc = bnxt_rx_pkt(&rx_pkts[nb_rx_pkts], rxq, &raw_cons);
821                         if (likely(!rc) || rc == -ENOMEM)
822                                 nb_rx_pkts++;
823                         if (rc == -EBUSY)       /* partial completion */
824                                 break;
825                         if (rc == -ENODEV)      /* completion for representor */
826                                 nb_rep_rx_pkts++;
827                 } else if (!BNXT_NUM_ASYNC_CPR(rxq->bp)) {
828                         evt =
829                         bnxt_event_hwrm_resp_handler(rxq->bp,
830                                                      (struct cmpl_base *)rxcmp);
831                         /* If the async event is Fatal error, return */
832                         if (unlikely(is_bnxt_in_error(rxq->bp)))
833                                 goto done;
834                 }
835
836                 raw_cons = NEXT_RAW_CMP(raw_cons);
837                 if (nb_rx_pkts == nb_pkts || evt)
838                         break;
839                 /* Post some Rx buf early in case of larger burst processing */
840                 if (nb_rx_pkts == BNXT_RX_POST_THRESH)
841                         bnxt_db_write(&rxr->rx_db, rxr->rx_prod);
842         }
843
844         cpr->cp_raw_cons = raw_cons;
845         if (!nb_rx_pkts && !nb_rep_rx_pkts && !evt) {
846                 /*
847                  * For PMD, there is no need to keep on pushing to REARM
848                  * the doorbell if there are no new completions
849                  */
850                 goto done;
851         }
852
853         if (prod != rxr->rx_prod)
854                 bnxt_db_write(&rxr->rx_db, rxr->rx_prod);
855
856         /* Ring the AGG ring DB */
857         if (ag_prod != rxr->ag_prod)
858                 bnxt_db_write(&rxr->ag_db, rxr->ag_prod);
859
860         bnxt_db_cq(cpr);
861
862         /* Attempt to alloc Rx buf in case of a previous allocation failure. */
863         if (rc == -ENOMEM) {
864                 int i = RING_NEXT(rxr->rx_ring_struct, prod);
865                 int cnt = nb_rx_pkts;
866
867                 for (; cnt;
868                         i = RING_NEXT(rxr->rx_ring_struct, i), cnt--) {
869                         struct bnxt_sw_rx_bd *rx_buf = &rxr->rx_buf_ring[i];
870
871                         /* Buffer already allocated for this index. */
872                         if (rx_buf->mbuf != NULL)
873                                 continue;
874
875                         /* This slot is empty. Alloc buffer for Rx */
876                         if (!bnxt_alloc_rx_data(rxq, rxr, i)) {
877                                 rxr->rx_prod = i;
878                                 bnxt_db_write(&rxr->rx_db, rxr->rx_prod);
879                         } else {
880                                 PMD_DRV_LOG(ERR, "Alloc  mbuf failed\n");
881                                 break;
882                         }
883                 }
884         }
885
886 done:
887         rte_spinlock_unlock(&rxq->lock);
888
889         return nb_rx_pkts;
890 }
891
892 /*
893  * Dummy DPDK callback for RX.
894  *
895  * This function is used to temporarily replace the real callback during
896  * unsafe control operations on the queue, or in case of error.
897  */
898 uint16_t
899 bnxt_dummy_recv_pkts(void *rx_queue __rte_unused,
900                      struct rte_mbuf **rx_pkts __rte_unused,
901                      uint16_t nb_pkts __rte_unused)
902 {
903         return 0;
904 }
905
906 void bnxt_free_rx_rings(struct bnxt *bp)
907 {
908         int i;
909         struct bnxt_rx_queue *rxq;
910
911         if (!bp->rx_queues)
912                 return;
913
914         for (i = 0; i < (int)bp->rx_nr_rings; i++) {
915                 rxq = bp->rx_queues[i];
916                 if (!rxq)
917                         continue;
918
919                 bnxt_free_ring(rxq->rx_ring->rx_ring_struct);
920                 rte_free(rxq->rx_ring->rx_ring_struct);
921
922                 /* Free the Aggregator ring */
923                 bnxt_free_ring(rxq->rx_ring->ag_ring_struct);
924                 rte_free(rxq->rx_ring->ag_ring_struct);
925                 rxq->rx_ring->ag_ring_struct = NULL;
926
927                 rte_free(rxq->rx_ring);
928
929                 bnxt_free_ring(rxq->cp_ring->cp_ring_struct);
930                 rte_free(rxq->cp_ring->cp_ring_struct);
931                 rte_free(rxq->cp_ring);
932
933                 rte_free(rxq);
934                 bp->rx_queues[i] = NULL;
935         }
936 }
937
938 int bnxt_init_rx_ring_struct(struct bnxt_rx_queue *rxq, unsigned int socket_id)
939 {
940         struct bnxt_cp_ring_info *cpr;
941         struct bnxt_rx_ring_info *rxr;
942         struct bnxt_ring *ring;
943
944         rxq->rx_buf_size = BNXT_MAX_PKT_LEN + sizeof(struct rte_mbuf);
945
946         rxr = rte_zmalloc_socket("bnxt_rx_ring",
947                                  sizeof(struct bnxt_rx_ring_info),
948                                  RTE_CACHE_LINE_SIZE, socket_id);
949         if (rxr == NULL)
950                 return -ENOMEM;
951         rxq->rx_ring = rxr;
952
953         ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
954                                    sizeof(struct bnxt_ring),
955                                    RTE_CACHE_LINE_SIZE, socket_id);
956         if (ring == NULL)
957                 return -ENOMEM;
958         rxr->rx_ring_struct = ring;
959         ring->ring_size = rte_align32pow2(rxq->nb_rx_desc);
960         ring->ring_mask = ring->ring_size - 1;
961         ring->bd = (void *)rxr->rx_desc_ring;
962         ring->bd_dma = rxr->rx_desc_mapping;
963         ring->vmem_size = ring->ring_size * sizeof(struct bnxt_sw_rx_bd);
964         ring->vmem = (void **)&rxr->rx_buf_ring;
965
966         cpr = rte_zmalloc_socket("bnxt_rx_ring",
967                                  sizeof(struct bnxt_cp_ring_info),
968                                  RTE_CACHE_LINE_SIZE, socket_id);
969         if (cpr == NULL)
970                 return -ENOMEM;
971         rxq->cp_ring = cpr;
972
973         ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
974                                    sizeof(struct bnxt_ring),
975                                    RTE_CACHE_LINE_SIZE, socket_id);
976         if (ring == NULL)
977                 return -ENOMEM;
978         cpr->cp_ring_struct = ring;
979         ring->ring_size = rte_align32pow2(rxr->rx_ring_struct->ring_size *
980                                           (2 + AGG_RING_SIZE_FACTOR));
981         ring->ring_mask = ring->ring_size - 1;
982         ring->bd = (void *)cpr->cp_desc_ring;
983         ring->bd_dma = cpr->cp_desc_mapping;
984         ring->vmem_size = 0;
985         ring->vmem = NULL;
986
987         /* Allocate Aggregator rings */
988         ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
989                                    sizeof(struct bnxt_ring),
990                                    RTE_CACHE_LINE_SIZE, socket_id);
991         if (ring == NULL)
992                 return -ENOMEM;
993         rxr->ag_ring_struct = ring;
994         ring->ring_size = rte_align32pow2(rxq->nb_rx_desc *
995                                           AGG_RING_SIZE_FACTOR);
996         ring->ring_mask = ring->ring_size - 1;
997         ring->bd = (void *)rxr->ag_desc_ring;
998         ring->bd_dma = rxr->ag_desc_mapping;
999         ring->vmem_size = ring->ring_size * sizeof(struct bnxt_sw_rx_bd);
1000         ring->vmem = (void **)&rxr->ag_buf_ring;
1001
1002         return 0;
1003 }
1004
1005 static void bnxt_init_rxbds(struct bnxt_ring *ring, uint32_t type,
1006                             uint16_t len)
1007 {
1008         uint32_t j;
1009         struct rx_prod_pkt_bd *rx_bd_ring = (struct rx_prod_pkt_bd *)ring->bd;
1010
1011         if (!rx_bd_ring)
1012                 return;
1013         for (j = 0; j < ring->ring_size; j++) {
1014                 rx_bd_ring[j].flags_type = rte_cpu_to_le_16(type);
1015                 rx_bd_ring[j].len = rte_cpu_to_le_16(len);
1016                 rx_bd_ring[j].opaque = j;
1017         }
1018 }
1019
1020 int bnxt_init_one_rx_ring(struct bnxt_rx_queue *rxq)
1021 {
1022         struct bnxt_rx_ring_info *rxr;
1023         struct bnxt_ring *ring;
1024         uint32_t prod, type;
1025         unsigned int i;
1026         uint16_t size;
1027
1028         size = rte_pktmbuf_data_room_size(rxq->mb_pool) - RTE_PKTMBUF_HEADROOM;
1029         size = RTE_MIN(BNXT_MAX_PKT_LEN, size);
1030
1031         type = RX_PROD_PKT_BD_TYPE_RX_PROD_PKT | RX_PROD_PKT_BD_FLAGS_EOP_PAD;
1032
1033         rxr = rxq->rx_ring;
1034         ring = rxr->rx_ring_struct;
1035         bnxt_init_rxbds(ring, type, size);
1036
1037         prod = rxr->rx_prod;
1038         for (i = 0; i < ring->ring_size; i++) {
1039                 if (unlikely(!rxr->rx_buf_ring[i].mbuf)) {
1040                         if (bnxt_alloc_rx_data(rxq, rxr, prod) != 0) {
1041                                 PMD_DRV_LOG(WARNING,
1042                                             "init'ed rx ring %d with %d/%d mbufs only\n",
1043                                             rxq->queue_id, i, ring->ring_size);
1044                                 break;
1045                         }
1046                 }
1047                 rxr->rx_prod = prod;
1048                 prod = RING_NEXT(rxr->rx_ring_struct, prod);
1049         }
1050
1051         ring = rxr->ag_ring_struct;
1052         type = RX_PROD_AGG_BD_TYPE_RX_PROD_AGG;
1053         bnxt_init_rxbds(ring, type, size);
1054         prod = rxr->ag_prod;
1055
1056         for (i = 0; i < ring->ring_size; i++) {
1057                 if (unlikely(!rxr->ag_buf_ring[i].mbuf)) {
1058                         if (bnxt_alloc_ag_data(rxq, rxr, prod) != 0) {
1059                                 PMD_DRV_LOG(WARNING,
1060                                             "init'ed AG ring %d with %d/%d mbufs only\n",
1061                                             rxq->queue_id, i, ring->ring_size);
1062                                 break;
1063                         }
1064                 }
1065                 rxr->ag_prod = prod;
1066                 prod = RING_NEXT(rxr->ag_ring_struct, prod);
1067         }
1068         PMD_DRV_LOG(DEBUG, "AGG Done!\n");
1069
1070         if (rxr->tpa_info) {
1071                 unsigned int max_aggs = BNXT_TPA_MAX_AGGS(rxq->bp);
1072
1073                 for (i = 0; i < max_aggs; i++) {
1074                         if (unlikely(!rxr->tpa_info[i].mbuf)) {
1075                                 rxr->tpa_info[i].mbuf =
1076                                         __bnxt_alloc_rx_data(rxq->mb_pool);
1077                                 if (!rxr->tpa_info[i].mbuf) {
1078                                         rte_atomic64_inc(&rxq->rx_mbuf_alloc_fail);
1079                                         return -ENOMEM;
1080                                 }
1081                         }
1082                 }
1083         }
1084         PMD_DRV_LOG(DEBUG, "TPA alloc Done!\n");
1085
1086         return 0;
1087 }