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