drivers/net/bnxt/bnxt_rxr.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright(c) Broadcom Limited.
   5  *   All rights reserved.
   6  *
   7  *   Redistribution and use in source and binary forms, with or without
   8  *   modification, are permitted provided that the following conditions
   9  *   are met:
  10  *
  11  *     * Redistributions of source code must retain the above copyright
  12  *       notice, this list of conditions and the following disclaimer.
  13  *     * Redistributions in binary form must reproduce the above copyright
  14  *       notice, this list of conditions and the following disclaimer in
  15  *       the documentation and/or other materials provided with the
  16  *       distribution.
  17  *     * Neither the name of Broadcom Corporation nor the names of its
  18  *       contributors may be used to endorse or promote products derived
  19  *       from this software without specific prior written permission.
  20  *
  21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  */
  33
  34 #include <inttypes.h>
  35 #include <stdbool.h>
  36
  37 #include <rte_bitmap.h>
  38 #include <rte_byteorder.h>
  39 #include <rte_malloc.h>
  40 #include <rte_memory.h>
  41
  42 #include "bnxt.h"
  43 #include "bnxt_cpr.h"
  44 #include "bnxt_ring.h"
  45 #include "bnxt_rxr.h"
  46 #include "bnxt_rxq.h"
  47 #include "hsi_struct_def_dpdk.h"
  48
  49 /*
  50  * RX Ring handling
  51  */
  52
  53 static inline struct rte_mbuf *__bnxt_alloc_rx_data(struct rte_mempool *mb)
  54 {
  55         struct rte_mbuf *data;
  56
  57         data = rte_mbuf_raw_alloc(mb);
  58
  59         return data;
  60 }
  61
  62 static inline int bnxt_alloc_rx_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->rx_desc_ring[prod];
  67         struct bnxt_sw_rx_bd *rx_buf = &rxr->rx_buf_ring[prod];
  68         struct rte_mbuf *mbuf;
  69
  70         mbuf = __bnxt_alloc_rx_data(rxq->mb_pool);
  71         if (!mbuf) {
  72                 rte_atomic64_inc(&rxq->bp->rx_mbuf_alloc_fail);
  73                 return -ENOMEM;
  74         }
  75
  76         rx_buf->mbuf = mbuf;
  77
  78         rxbd->addr = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
  79
  80         return 0;
  81 }
  82
  83 static inline int bnxt_alloc_ag_data(struct bnxt_rx_queue *rxq,
  84                                      struct bnxt_rx_ring_info *rxr,
  85                                      uint16_t prod)
  86 {
  87         struct rx_prod_pkt_bd *rxbd = &rxr->ag_desc_ring[prod];
  88         struct bnxt_sw_rx_bd *rx_buf = &rxr->ag_buf_ring[prod];
  89         struct rte_mbuf *mbuf;
  90
  91         mbuf = __bnxt_alloc_rx_data(rxq->mb_pool);
  92         if (!mbuf) {
  93                 rte_atomic64_inc(&rxq->bp->rx_mbuf_alloc_fail);
  94                 return -ENOMEM;
  95         }
  96
  97         if (rxbd == NULL)
  98                 PMD_DRV_LOG(ERR, "Jumbo Frame. rxbd is NULL\n");
  99         if (rx_buf == NULL)
 100                 PMD_DRV_LOG(ERR, "Jumbo Frame. rx_buf is NULL\n");
 101
 102
 103         rx_buf->mbuf = mbuf;
 104
 105         rxbd->addr = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
 106
 107         return 0;
 108 }
 109
 110 static inline void bnxt_reuse_rx_mbuf(struct bnxt_rx_ring_info *rxr,
 111                                struct rte_mbuf *mbuf)
 112 {
 113         uint16_t prod = RING_NEXT(rxr->rx_ring_struct, rxr->rx_prod);
 114         struct bnxt_sw_rx_bd *prod_rx_buf;
 115         struct rx_prod_pkt_bd *prod_bd;
 116
 117         prod_rx_buf = &rxr->rx_buf_ring[prod];
 118
 119         RTE_ASSERT(prod_rx_buf->mbuf == NULL);
 120         RTE_ASSERT(mbuf != NULL);
 121
 122         prod_rx_buf->mbuf = mbuf;
 123
 124         prod_bd = &rxr->rx_desc_ring[prod];
 125
 126         prod_bd->addr = rte_cpu_to_le_64(rte_mbuf_data_iova_default(mbuf));
 127
 128         rxr->rx_prod = prod;
 129 }
 130
 131 #ifdef BNXT_DEBUG
 132 static void bnxt_reuse_ag_mbuf(struct bnxt_rx_ring_info *rxr, uint16_t cons,
 133                                struct rte_mbuf *mbuf)
 134 {
 135         uint16_t prod = rxr->ag_prod;
 136         struct bnxt_sw_rx_bd *prod_rx_buf;
 137         struct rx_prod_pkt_bd *prod_bd, *cons_bd;
 138
 139         prod_rx_buf = &rxr->ag_buf_ring[prod];
 140
 141         prod_rx_buf->mbuf = mbuf;
 142
 143         prod_bd = &rxr->ag_desc_ring[prod];
 144         cons_bd = &rxr->ag_desc_ring[cons];
 145
 146         prod_bd->addr = cons_bd->addr;
 147 }
 148 #endif
 149
 150 static inline
 151 struct rte_mbuf *bnxt_consume_rx_buf(struct bnxt_rx_ring_info *rxr,
 152                                      uint16_t cons)
 153 {
 154         struct bnxt_sw_rx_bd *cons_rx_buf;
 155         struct rte_mbuf *mbuf;
 156
 157         cons_rx_buf = &rxr->rx_buf_ring[cons];
 158         RTE_ASSERT(cons_rx_buf->mbuf != NULL);
 159         mbuf = cons_rx_buf->mbuf;
 160         cons_rx_buf->mbuf = NULL;
 161         return mbuf;
 162 }
 163
 164 static void bnxt_tpa_start(struct bnxt_rx_queue *rxq,
 165                            struct rx_tpa_start_cmpl *tpa_start,
 166                            struct rx_tpa_start_cmpl_hi *tpa_start1)
 167 {
 168         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 169         uint8_t agg_id = rte_le_to_cpu_32(tpa_start->agg_id &
 170                 RX_TPA_START_CMPL_AGG_ID_MASK) >> RX_TPA_START_CMPL_AGG_ID_SFT;
 171         uint16_t data_cons;
 172         struct bnxt_tpa_info *tpa_info;
 173         struct rte_mbuf *mbuf;
 174
 175         data_cons = tpa_start->opaque;
 176         tpa_info = &rxr->tpa_info[agg_id];
 177
 178         mbuf = bnxt_consume_rx_buf(rxr, data_cons);
 179
 180         bnxt_reuse_rx_mbuf(rxr, tpa_info->mbuf);
 181
 182         tpa_info->mbuf = mbuf;
 183         tpa_info->len = rte_le_to_cpu_32(tpa_start->len);
 184
 185         mbuf->nb_segs = 1;
 186         mbuf->next = NULL;
 187         mbuf->pkt_len = rte_le_to_cpu_32(tpa_start->len);
 188         mbuf->data_len = mbuf->pkt_len;
 189         mbuf->port = rxq->port_id;
 190         mbuf->ol_flags = PKT_RX_LRO;
 191         if (likely(tpa_start->flags_type &
 192                    rte_cpu_to_le_32(RX_TPA_START_CMPL_FLAGS_RSS_VALID))) {
 193                 mbuf->hash.rss = rte_le_to_cpu_32(tpa_start->rss_hash);
 194                 mbuf->ol_flags |= PKT_RX_RSS_HASH;
 195         } else {
 196                 mbuf->hash.fdir.id = rte_le_to_cpu_16(tpa_start1->cfa_code);
 197                 mbuf->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
 198         }
 199         if (tpa_start1->flags2 &
 200             rte_cpu_to_le_32(RX_TPA_START_CMPL_FLAGS2_META_FORMAT_VLAN)) {
 201                 mbuf->vlan_tci = rte_le_to_cpu_32(tpa_start1->metadata);
 202                 mbuf->ol_flags |= PKT_RX_VLAN;
 203         }
 204         if (likely(tpa_start1->flags2 &
 205                    rte_cpu_to_le_32(RX_TPA_START_CMPL_FLAGS2_L4_CS_CALC)))
 206                 mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
 207
 208         /* recycle next mbuf */
 209         data_cons = RING_NEXT(rxr->rx_ring_struct, data_cons);
 210         bnxt_reuse_rx_mbuf(rxr, bnxt_consume_rx_buf(rxr, data_cons));
 211 }
 212
 213 static int bnxt_agg_bufs_valid(struct bnxt_cp_ring_info *cpr,
 214                 uint8_t agg_bufs, uint32_t raw_cp_cons)
 215 {
 216         uint16_t last_cp_cons;
 217         struct rx_pkt_cmpl *agg_cmpl;
 218
 219         raw_cp_cons = ADV_RAW_CMP(raw_cp_cons, agg_bufs);
 220         last_cp_cons = RING_CMP(cpr->cp_ring_struct, raw_cp_cons);
 221         agg_cmpl = (struct rx_pkt_cmpl *)&cpr->cp_desc_ring[last_cp_cons];
 222         cpr->valid = FLIP_VALID(raw_cp_cons,
 223                                 cpr->cp_ring_struct->ring_mask,
 224                                 cpr->valid);
 225         return CMP_VALID(agg_cmpl, raw_cp_cons, cpr->cp_ring_struct);
 226 }
 227
 228 /* TPA consume agg buffer out of order, allocate connected data only */
 229 static int bnxt_prod_ag_mbuf(struct bnxt_rx_queue *rxq)
 230 {
 231         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 232         uint16_t next = RING_NEXT(rxr->ag_ring_struct, rxr->ag_prod);
 233
 234         /* TODO batch allocation for better performance */
 235         while (rte_bitmap_get(rxr->ag_bitmap, next)) {
 236                 if (unlikely(bnxt_alloc_ag_data(rxq, rxr, next))) {
 237                         PMD_DRV_LOG(ERR,
 238                                 "agg mbuf alloc failed: prod=0x%x\n", next);
 239                         break;
 240                 }
 241                 rte_bitmap_clear(rxr->ag_bitmap, next);
 242                 rxr->ag_prod = next;
 243                 next = RING_NEXT(rxr->ag_ring_struct, next);
 244         }
 245
 246         return 0;
 247 }
 248
 249 static int bnxt_rx_pages(struct bnxt_rx_queue *rxq,
 250                          struct rte_mbuf *mbuf, uint32_t *tmp_raw_cons,
 251                          uint8_t agg_buf)
 252 {
 253         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
 254         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 255         int i;
 256         uint16_t cp_cons, ag_cons;
 257         struct rx_pkt_cmpl *rxcmp;
 258         struct rte_mbuf *last = mbuf;
 259
 260         for (i = 0; i < agg_buf; i++) {
 261                 struct bnxt_sw_rx_bd *ag_buf;
 262                 struct rte_mbuf *ag_mbuf;
 263                 *tmp_raw_cons = NEXT_RAW_CMP(*tmp_raw_cons);
 264                 cp_cons = RING_CMP(cpr->cp_ring_struct, *tmp_raw_cons);
 265                 rxcmp = (struct rx_pkt_cmpl *)
 266                                         &cpr->cp_desc_ring[cp_cons];
 267
 268 #ifdef BNXT_DEBUG
 269                 bnxt_dump_cmpl(cp_cons, rxcmp);
 270 #endif
 271
 272                 ag_cons = rxcmp->opaque;
 273                 RTE_ASSERT(ag_cons <= rxr->ag_ring_struct->ring_mask);
 274                 ag_buf = &rxr->ag_buf_ring[ag_cons];
 275                 ag_mbuf = ag_buf->mbuf;
 276                 RTE_ASSERT(ag_mbuf != NULL);
 277
 278                 ag_mbuf->data_len = rte_le_to_cpu_16(rxcmp->len);
 279
 280                 mbuf->nb_segs++;
 281                 mbuf->pkt_len += ag_mbuf->data_len;
 282
 283                 last->next = ag_mbuf;
 284                 last = ag_mbuf;
 285
 286                 ag_buf->mbuf = NULL;
 287
 288                 /*
 289                  * As aggregation buffer consumed out of order in TPA module,
 290                  * use bitmap to track freed slots to be allocated and notified
 291                  * to NIC
 292                  */
 293                 rte_bitmap_set(rxr->ag_bitmap, ag_cons);
 294         }
 295         bnxt_prod_ag_mbuf(rxq);
 296         return 0;
 297 }
 298
 299 static inline struct rte_mbuf *bnxt_tpa_end(
 300                 struct bnxt_rx_queue *rxq,
 301                 uint32_t *raw_cp_cons,
 302                 struct rx_tpa_end_cmpl *tpa_end,
 303                 struct rx_tpa_end_cmpl_hi *tpa_end1 __rte_unused)
 304 {
 305         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
 306         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 307         uint8_t agg_id = (tpa_end->agg_id & RX_TPA_END_CMPL_AGG_ID_MASK)
 308                         >> RX_TPA_END_CMPL_AGG_ID_SFT;
 309         struct rte_mbuf *mbuf;
 310         uint8_t agg_bufs;
 311         struct bnxt_tpa_info *tpa_info;
 312
 313         tpa_info = &rxr->tpa_info[agg_id];
 314         mbuf = tpa_info->mbuf;
 315         RTE_ASSERT(mbuf != NULL);
 316
 317         rte_prefetch0(mbuf);
 318         agg_bufs = (rte_le_to_cpu_32(tpa_end->agg_bufs_v1) &
 319                 RX_TPA_END_CMPL_AGG_BUFS_MASK) >> RX_TPA_END_CMPL_AGG_BUFS_SFT;
 320         if (agg_bufs) {
 321                 if (!bnxt_agg_bufs_valid(cpr, agg_bufs, *raw_cp_cons))
 322                         return NULL;
 323                 bnxt_rx_pages(rxq, mbuf, raw_cp_cons, agg_bufs);
 324         }
 325         mbuf->l4_len = tpa_end->payload_offset;
 326
 327         struct rte_mbuf *new_data = __bnxt_alloc_rx_data(rxq->mb_pool);
 328         RTE_ASSERT(new_data != NULL);
 329         if (!new_data) {
 330                 rte_atomic64_inc(&rxq->bp->rx_mbuf_alloc_fail);
 331                 return NULL;
 332         }
 333         tpa_info->mbuf = new_data;
 334
 335         return mbuf;
 336 }
 337
 338 static uint32_t
 339 bnxt_parse_pkt_type(struct rx_pkt_cmpl *rxcmp, struct rx_pkt_cmpl_hi *rxcmp1)
 340 {
 341         uint32_t pkt_type = 0;
 342         uint32_t t_ipcs = 0, ip = 0, ip6 = 0;
 343         uint32_t tcp = 0, udp = 0, icmp = 0;
 344         uint32_t vlan = 0;
 345
 346         vlan = !!(rxcmp1->flags2 &
 347                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN));
 348         t_ipcs = !!(rxcmp1->flags2 &
 349                 rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_T_IP_CS_CALC));
 350         ip6 = !!(rxcmp1->flags2 &
 351                  rte_cpu_to_le_32(RX_PKT_CMPL_FLAGS2_IP_TYPE));
 352         icmp = !!(rxcmp->flags_type &
 353                   rte_cpu_to_le_16(RX_PKT_CMPL_FLAGS_ITYPE_ICMP));
 354         tcp = !!(rxcmp->flags_type &
 355                  rte_cpu_to_le_16(RX_PKT_CMPL_FLAGS_ITYPE_TCP));
 356         udp = !!(rxcmp->flags_type &
 357                  rte_cpu_to_le_16(RX_PKT_CMPL_FLAGS_ITYPE_UDP));
 358         ip = !!(rxcmp->flags_type &
 359                 rte_cpu_to_le_16(RX_PKT_CMPL_FLAGS_ITYPE_IP));
 360
 361         pkt_type |= ((ip || tcp || udp || icmp) && !t_ipcs && !ip6) ?
 362                 RTE_PTYPE_L3_IPV4_EXT_UNKNOWN : 0;
 363         pkt_type |= ((ip || tcp || udp || icmp) && !t_ipcs && ip6) ?
 364                 RTE_PTYPE_L3_IPV6_EXT_UNKNOWN : 0;
 365         pkt_type |= (!t_ipcs &&  icmp) ? RTE_PTYPE_L4_ICMP : 0;
 366         pkt_type |= (!t_ipcs &&  udp) ? RTE_PTYPE_L4_UDP : 0;
 367         pkt_type |= (!t_ipcs &&  tcp) ? RTE_PTYPE_L4_TCP : 0;
 368         pkt_type |= ((ip || tcp || udp || icmp) && t_ipcs && !ip6) ?
 369                 RTE_PTYPE_INNER_L3_IPV4_EXT_UNKNOWN : 0;
 370         pkt_type |= ((ip || tcp || udp || icmp) && t_ipcs && ip6) ?
 371                 RTE_PTYPE_INNER_L3_IPV6_EXT_UNKNOWN : 0;
 372         pkt_type |= (t_ipcs &&  icmp) ? RTE_PTYPE_INNER_L4_ICMP : 0;
 373         pkt_type |= (t_ipcs &&  udp) ? RTE_PTYPE_INNER_L4_UDP : 0;
 374         pkt_type |= (t_ipcs &&  tcp) ? RTE_PTYPE_INNER_L4_TCP : 0;
 375         pkt_type |= vlan ? RTE_PTYPE_L2_ETHER_VLAN : 0;
 376
 377         return pkt_type;
 378 }
 379
 380 static int bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
 381                             struct bnxt_rx_queue *rxq, uint32_t *raw_cons)
 382 {
 383         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
 384         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 385         struct rx_pkt_cmpl *rxcmp;
 386         struct rx_pkt_cmpl_hi *rxcmp1;
 387         uint32_t tmp_raw_cons = *raw_cons;
 388         uint16_t cons, prod, cp_cons =
 389             RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
 390 #ifdef BNXT_DEBUG
 391         uint16_t ag_cons;
 392 #endif
 393         struct rte_mbuf *mbuf;
 394         int rc = 0;
 395         uint8_t agg_buf = 0;
 396         uint16_t cmp_type;
 397
 398         rxcmp = (struct rx_pkt_cmpl *)
 399             &cpr->cp_desc_ring[cp_cons];
 400
 401         tmp_raw_cons = NEXT_RAW_CMP(tmp_raw_cons);
 402         cp_cons = RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
 403         rxcmp1 = (struct rx_pkt_cmpl_hi *)&cpr->cp_desc_ring[cp_cons];
 404
 405         if (!CMP_VALID(rxcmp1, tmp_raw_cons, cpr->cp_ring_struct))
 406                 return -EBUSY;
 407
 408         cpr->valid = FLIP_VALID(cp_cons,
 409                                 cpr->cp_ring_struct->ring_mask,
 410                                 cpr->valid);
 411
 412         cmp_type = CMP_TYPE(rxcmp);
 413         if (cmp_type == RX_TPA_START_CMPL_TYPE_RX_TPA_START) {
 414                 bnxt_tpa_start(rxq, (struct rx_tpa_start_cmpl *)rxcmp,
 415                                (struct rx_tpa_start_cmpl_hi *)rxcmp1);
 416                 rc = -EINVAL; /* Continue w/o new mbuf */
 417                 goto next_rx;
 418         } else if (cmp_type == RX_TPA_END_CMPL_TYPE_RX_TPA_END) {
 419                 mbuf = bnxt_tpa_end(rxq, &tmp_raw_cons,
 420                                    (struct rx_tpa_end_cmpl *)rxcmp,
 421                                    (struct rx_tpa_end_cmpl_hi *)rxcmp1);
 422                 if (unlikely(!mbuf))
 423                         return -EBUSY;
 424                 *rx_pkt = mbuf;
 425                 goto next_rx;
 426         } else if (cmp_type != 0x11) {
 427                 rc = -EINVAL;
 428                 goto next_rx;
 429         }
 430
 431         agg_buf = (rxcmp->agg_bufs_v1 & RX_PKT_CMPL_AGG_BUFS_MASK)
 432                         >> RX_PKT_CMPL_AGG_BUFS_SFT;
 433         if (agg_buf && !bnxt_agg_bufs_valid(cpr, agg_buf, tmp_raw_cons))
 434                 return -EBUSY;
 435
 436         prod = rxr->rx_prod;
 437
 438         cons = rxcmp->opaque;
 439         mbuf = bnxt_consume_rx_buf(rxr, cons);
 440         if (mbuf == NULL)
 441                 return -EBUSY;
 442
 443         rte_prefetch0(mbuf);
 444
 445         mbuf->data_off = RTE_PKTMBUF_HEADROOM;
 446         mbuf->nb_segs = 1;
 447         mbuf->next = NULL;
 448         mbuf->pkt_len = rxcmp->len;
 449         mbuf->data_len = mbuf->pkt_len;
 450         mbuf->port = rxq->port_id;
 451         mbuf->ol_flags = 0;
 452         if (rxcmp->flags_type & RX_PKT_CMPL_FLAGS_RSS_VALID) {
 453                 mbuf->hash.rss = rxcmp->rss_hash;
 454                 mbuf->ol_flags |= PKT_RX_RSS_HASH;
 455         } else {
 456                 mbuf->hash.fdir.id = rxcmp1->cfa_code;
 457                 mbuf->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
 458         }
 459
 460         if ((rxcmp->flags_type & rte_cpu_to_le_16(RX_PKT_CMPL_FLAGS_MASK)) ==
 461              RX_PKT_CMPL_FLAGS_ITYPE_PTP_W_TIMESTAMP)
 462                 mbuf->ol_flags |= PKT_RX_IEEE1588_PTP | PKT_RX_IEEE1588_TMST;
 463
 464         if (agg_buf)
 465                 bnxt_rx_pages(rxq, mbuf, &tmp_raw_cons, agg_buf);
 466
 467         if (rxcmp1->flags2 & RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN) {
 468                 mbuf->vlan_tci = rxcmp1->metadata &
 469                         (RX_PKT_CMPL_METADATA_VID_MASK |
 470                         RX_PKT_CMPL_METADATA_DE |
 471                         RX_PKT_CMPL_METADATA_PRI_MASK);
 472                 mbuf->ol_flags |= PKT_RX_VLAN;
 473         }
 474
 475         if (likely(RX_CMP_IP_CS_OK(rxcmp1)))
 476                 mbuf->ol_flags |= PKT_RX_IP_CKSUM_GOOD;
 477         else
 478                 mbuf->ol_flags |= PKT_RX_IP_CKSUM_BAD;
 479
 480         if (likely(RX_CMP_L4_CS_OK(rxcmp1)))
 481                 mbuf->ol_flags |= PKT_RX_L4_CKSUM_GOOD;
 482         else
 483                 mbuf->ol_flags |= PKT_RX_L4_CKSUM_BAD;
 484
 485         mbuf->packet_type = bnxt_parse_pkt_type(rxcmp, rxcmp1);
 486
 487 #ifdef BNXT_DEBUG
 488         if (rxcmp1->errors_v2 & RX_CMP_L2_ERRORS) {
 489                 /* Re-install the mbuf back to the rx ring */
 490                 bnxt_reuse_rx_mbuf(rxr, cons, mbuf);
 491                 if (agg_buf)
 492                         bnxt_reuse_ag_mbuf(rxr, ag_cons, mbuf);
 493
 494                 rc = -EIO;
 495                 goto next_rx;
 496         }
 497 #endif
 498         /*
 499          * TODO: Redesign this....
 500          * If the allocation fails, the packet does not get received.
 501          * Simply returning this will result in slowly falling behind
 502          * on the producer ring buffers.
 503          * Instead, "filling up" the producer just before ringing the
 504          * doorbell could be a better solution since it will let the
 505          * producer ring starve until memory is available again pushing
 506          * the drops into hardware and getting them out of the driver
 507          * allowing recovery to a full producer ring.
 508          *
 509          * This could also help with cache usage by preventing per-packet
 510          * calls in favour of a tight loop with the same function being called
 511          * in it.
 512          */
 513         prod = RING_NEXT(rxr->rx_ring_struct, prod);
 514         if (bnxt_alloc_rx_data(rxq, rxr, prod)) {
 515                 PMD_DRV_LOG(ERR, "mbuf alloc failed with prod=0x%x\n", prod);
 516                 rc = -ENOMEM;
 517                 goto rx;
 518         }
 519         rxr->rx_prod = prod;
 520         /*
 521          * All MBUFs are allocated with the same size under DPDK,
 522          * no optimization for rx_copy_thresh
 523          */
 524 rx:
 525         *rx_pkt = mbuf;
 526
 527 next_rx:
 528
 529         *raw_cons = tmp_raw_cons;
 530
 531         return rc;
 532 }
 533
 534 uint16_t bnxt_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
 535                                uint16_t nb_pkts)
 536 {
 537         struct bnxt_rx_queue *rxq = rx_queue;
 538         struct bnxt_cp_ring_info *cpr = rxq->cp_ring;
 539         struct bnxt_rx_ring_info *rxr = rxq->rx_ring;
 540         uint32_t raw_cons = cpr->cp_raw_cons;
 541         uint32_t cons;
 542         int nb_rx_pkts = 0;
 543         struct rx_pkt_cmpl *rxcmp;
 544         uint16_t prod = rxr->rx_prod;
 545         uint16_t ag_prod = rxr->ag_prod;
 546         int rc = 0;
 547
 548         /* If Rx Q was stopped return */
 549         if (rxq->rx_deferred_start)
 550                 return 0;
 551
 552         /* Handle RX burst request */
 553         while (1) {
 554                 cons = RING_CMP(cpr->cp_ring_struct, raw_cons);
 555                 rte_prefetch0(&cpr->cp_desc_ring[cons]);
 556                 rxcmp = (struct rx_pkt_cmpl *)&cpr->cp_desc_ring[cons];
 557
 558                 if (!CMP_VALID(rxcmp, raw_cons, cpr->cp_ring_struct))
 559                         break;
 560                 cpr->valid = FLIP_VALID(cons,
 561                                         cpr->cp_ring_struct->ring_mask,
 562                                         cpr->valid);
 563
 564                 /* TODO: Avoid magic numbers... */
 565                 if ((CMP_TYPE(rxcmp) & 0x30) == 0x10) {
 566                         rc = bnxt_rx_pkt(&rx_pkts[nb_rx_pkts], rxq, &raw_cons);
 567                         if (likely(!rc) || rc == -ENOMEM)
 568                                 nb_rx_pkts++;
 569                         if (rc == -EBUSY)       /* partial completion */
 570                                 break;
 571                 }
 572                 raw_cons = NEXT_RAW_CMP(raw_cons);
 573                 if (nb_rx_pkts == nb_pkts)
 574                         break;
 575         }
 576
 577         cpr->cp_raw_cons = raw_cons;
 578         if (prod == rxr->rx_prod && ag_prod == rxr->ag_prod) {
 579                 /*
 580                  * For PMD, there is no need to keep on pushing to REARM
 581                  * the doorbell if there are no new completions
 582                  */
 583                 return nb_rx_pkts;
 584         }
 585
 586         B_CP_DIS_DB(cpr, cpr->cp_raw_cons);
 587         B_RX_DB(rxr->rx_doorbell, rxr->rx_prod);
 588         /* Ring the AGG ring DB */
 589         B_RX_DB(rxr->ag_doorbell, rxr->ag_prod);
 590
 591         /* Attempt to alloc Rx buf in case of a previous allocation failure. */
 592         if (rc == -ENOMEM) {
 593                 int i;
 594
 595                 for (i = prod; i <= nb_rx_pkts;
 596                         i = RING_NEXT(rxr->rx_ring_struct, i)) {
 597                         struct bnxt_sw_rx_bd *rx_buf = &rxr->rx_buf_ring[i];
 598
 599                         /* Buffer already allocated for this index. */
 600                         if (rx_buf->mbuf != NULL)
 601                                 continue;
 602
 603                         /* This slot is empty. Alloc buffer for Rx */
 604                         if (!bnxt_alloc_rx_data(rxq, rxr, i)) {
 605                                 rxr->rx_prod = i;
 606                                 B_RX_DB(rxr->rx_doorbell, rxr->rx_prod);
 607                         } else {
 608                                 PMD_DRV_LOG(ERR, "Alloc  mbuf failed\n");
 609                                 break;
 610                         }
 611                 }
 612         }
 613
 614         return nb_rx_pkts;
 615 }
 616
 617 void bnxt_free_rx_rings(struct bnxt *bp)
 618 {
 619         int i;
 620
 621         for (i = 0; i < (int)bp->rx_nr_rings; i++) {
 622                 struct bnxt_rx_queue *rxq = bp->rx_queues[i];
 623
 624                 if (!rxq)
 625                         continue;
 626
 627                 bnxt_free_ring(rxq->rx_ring->rx_ring_struct);
 628                 rte_free(rxq->rx_ring->rx_ring_struct);
 629
 630                 /* Free the Aggregator ring */
 631                 bnxt_free_ring(rxq->rx_ring->ag_ring_struct);
 632                 rte_free(rxq->rx_ring->ag_ring_struct);
 633                 rxq->rx_ring->ag_ring_struct = NULL;
 634
 635                 rte_free(rxq->rx_ring);
 636
 637                 bnxt_free_ring(rxq->cp_ring->cp_ring_struct);
 638                 rte_free(rxq->cp_ring->cp_ring_struct);
 639                 rte_free(rxq->cp_ring);
 640
 641                 rte_free(rxq);
 642                 bp->rx_queues[i] = NULL;
 643         }
 644 }
 645
 646 int bnxt_init_rx_ring_struct(struct bnxt_rx_queue *rxq, unsigned int socket_id)
 647 {
 648         struct bnxt_cp_ring_info *cpr;
 649         struct bnxt_rx_ring_info *rxr;
 650         struct bnxt_ring *ring;
 651
 652         rxq->rx_buf_use_size = BNXT_MAX_MTU + ETHER_HDR_LEN + ETHER_CRC_LEN +
 653                                (2 * VLAN_TAG_SIZE);
 654         rxq->rx_buf_size = rxq->rx_buf_use_size + sizeof(struct rte_mbuf);
 655
 656         rxr = rte_zmalloc_socket("bnxt_rx_ring",
 657                                  sizeof(struct bnxt_rx_ring_info),
 658                                  RTE_CACHE_LINE_SIZE, socket_id);
 659         if (rxr == NULL)
 660                 return -ENOMEM;
 661         rxq->rx_ring = rxr;
 662
 663         ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
 664                                    sizeof(struct bnxt_ring),
 665                                    RTE_CACHE_LINE_SIZE, socket_id);
 666         if (ring == NULL)
 667                 return -ENOMEM;
 668         rxr->rx_ring_struct = ring;
 669         ring->ring_size = rte_align32pow2(rxq->nb_rx_desc);
 670         ring->ring_mask = ring->ring_size - 1;
 671         ring->bd = (void *)rxr->rx_desc_ring;
 672         ring->bd_dma = rxr->rx_desc_mapping;
 673         ring->vmem_size = ring->ring_size * sizeof(struct bnxt_sw_rx_bd);
 674         ring->vmem = (void **)&rxr->rx_buf_ring;
 675
 676         cpr = rte_zmalloc_socket("bnxt_rx_ring",
 677                                  sizeof(struct bnxt_cp_ring_info),
 678                                  RTE_CACHE_LINE_SIZE, socket_id);
 679         if (cpr == NULL)
 680                 return -ENOMEM;
 681         rxq->cp_ring = cpr;
 682
 683         ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
 684                                    sizeof(struct bnxt_ring),
 685                                    RTE_CACHE_LINE_SIZE, socket_id);
 686         if (ring == NULL)
 687                 return -ENOMEM;
 688         cpr->cp_ring_struct = ring;
 689         ring->ring_size = rte_align32pow2(rxr->rx_ring_struct->ring_size *
 690                                           (2 + AGG_RING_SIZE_FACTOR));
 691         ring->ring_mask = ring->ring_size - 1;
 692         ring->bd = (void *)cpr->cp_desc_ring;
 693         ring->bd_dma = cpr->cp_desc_mapping;
 694         ring->vmem_size = 0;
 695         ring->vmem = NULL;
 696
 697         /* Allocate Aggregator rings */
 698         ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
 699                                    sizeof(struct bnxt_ring),
 700                                    RTE_CACHE_LINE_SIZE, socket_id);
 701         if (ring == NULL)
 702                 return -ENOMEM;
 703         rxr->ag_ring_struct = ring;
 704         ring->ring_size = rte_align32pow2(rxq->nb_rx_desc *
 705                                           AGG_RING_SIZE_FACTOR);
 706         ring->ring_mask = ring->ring_size - 1;
 707         ring->bd = (void *)rxr->ag_desc_ring;
 708         ring->bd_dma = rxr->ag_desc_mapping;
 709         ring->vmem_size = ring->ring_size * sizeof(struct bnxt_sw_rx_bd);
 710         ring->vmem = (void **)&rxr->ag_buf_ring;
 711
 712         return 0;
 713 }
 714
 715 static void bnxt_init_rxbds(struct bnxt_ring *ring, uint32_t type,
 716                             uint16_t len)
 717 {
 718         uint32_t j;
 719         struct rx_prod_pkt_bd *rx_bd_ring = (struct rx_prod_pkt_bd *)ring->bd;
 720
 721         if (!rx_bd_ring)
 722                 return;
 723         for (j = 0; j < ring->ring_size; j++) {
 724                 rx_bd_ring[j].flags_type = rte_cpu_to_le_16(type);
 725                 rx_bd_ring[j].len = rte_cpu_to_le_16(len);
 726                 rx_bd_ring[j].opaque = j;
 727         }
 728 }
 729
 730 int bnxt_init_one_rx_ring(struct bnxt_rx_queue *rxq)
 731 {
 732         struct bnxt_rx_ring_info *rxr;
 733         struct bnxt_ring *ring;
 734         uint32_t prod, type;
 735         unsigned int i;
 736         uint16_t size;
 737
 738         size = rte_pktmbuf_data_room_size(rxq->mb_pool) - RTE_PKTMBUF_HEADROOM;
 739         if (rxq->rx_buf_use_size <= size)
 740                 size = rxq->rx_buf_use_size;
 741
 742         type = RX_PROD_PKT_BD_TYPE_RX_PROD_PKT;
 743
 744         rxr = rxq->rx_ring;
 745         ring = rxr->rx_ring_struct;
 746         bnxt_init_rxbds(ring, type, size);
 747
 748         prod = rxr->rx_prod;
 749         for (i = 0; i < ring->ring_size; i++) {
 750                 if (bnxt_alloc_rx_data(rxq, rxr, prod) != 0) {
 751                         PMD_DRV_LOG(WARNING,
 752                                 "init'ed rx ring %d with %d/%d mbufs only\n",
 753                                 rxq->queue_id, i, ring->ring_size);
 754                         break;
 755                 }
 756                 rxr->rx_prod = prod;
 757                 prod = RING_NEXT(rxr->rx_ring_struct, prod);
 758         }
 759
 760         ring = rxr->ag_ring_struct;
 761         type = RX_PROD_AGG_BD_TYPE_RX_PROD_AGG;
 762         bnxt_init_rxbds(ring, type, size);
 763         prod = rxr->ag_prod;
 764
 765         for (i = 0; i < ring->ring_size; i++) {
 766                 if (bnxt_alloc_ag_data(rxq, rxr, prod) != 0) {
 767                         PMD_DRV_LOG(WARNING,
 768                         "init'ed AG ring %d with %d/%d mbufs only\n",
 769                         rxq->queue_id, i, ring->ring_size);
 770                         break;
 771                 }
 772                 rxr->ag_prod = prod;
 773                 prod = RING_NEXT(rxr->ag_ring_struct, prod);
 774         }
 775         PMD_DRV_LOG(DEBUG, "AGG Done!\n");
 776
 777         if (rxr->tpa_info) {
 778                 for (i = 0; i < BNXT_TPA_MAX; i++) {
 779                         rxr->tpa_info[i].mbuf =
 780                                 __bnxt_alloc_rx_data(rxq->mb_pool);
 781                         if (!rxr->tpa_info[i].mbuf) {
 782                                 rte_atomic64_inc(&rxq->bp->rx_mbuf_alloc_fail);
 783                                 return -ENOMEM;
 784                         }
 785                 }
 786         }
 787         PMD_DRV_LOG(DEBUG, "TPA alloc Done!\n");
 788
 789         return 0;
 790 }