net/bnxt: support set MTU
[dpdk.git] / drivers / net / bnxt / bnxt_rxr.c
index 5d93de2..8489a1c 100644 (file)
@@ -77,6 +77,32 @@ static inline int bnxt_alloc_rx_data(struct bnxt_rx_queue *rxq,
        return 0;
 }
 
+static inline int bnxt_alloc_ag_data(struct bnxt_rx_queue *rxq,
+                                    struct bnxt_rx_ring_info *rxr,
+                                    uint16_t prod)
+{
+       struct rx_prod_pkt_bd *rxbd = &rxr->ag_desc_ring[prod];
+       struct bnxt_sw_rx_bd *rx_buf = &rxr->ag_buf_ring[prod];
+       struct rte_mbuf *data;
+
+       data = __bnxt_alloc_rx_data(rxq->mb_pool);
+       if (!data)
+               return -ENOMEM;
+
+       if (rxbd == NULL)
+               RTE_LOG(ERR, PMD, "Jumbo Frame. rxbd is NULL\n");
+       if (rx_buf == NULL)
+               RTE_LOG(ERR, PMD, "Jumbo Frame. rx_buf is NULL\n");
+
+
+       rx_buf->mbuf = data;
+
+       rxbd->addr = rte_cpu_to_le_64(RTE_MBUF_DATA_DMA_ADDR(rx_buf->mbuf));
+
+       return 0;
+}
+
+#ifdef BNXT_DEBUG
 static void bnxt_reuse_rx_mbuf(struct bnxt_rx_ring_info *rxr, uint16_t cons,
                               struct rte_mbuf *mbuf)
 {
@@ -94,6 +120,24 @@ static void bnxt_reuse_rx_mbuf(struct bnxt_rx_ring_info *rxr, uint16_t cons,
        prod_bd->addr = cons_bd->addr;
 }
 
+static void bnxt_reuse_ag_mbuf(struct bnxt_rx_ring_info *rxr, uint16_t cons,
+                              struct rte_mbuf *mbuf)
+{
+       uint16_t prod = rxr->ag_prod;
+       struct bnxt_sw_rx_bd *prod_rx_buf;
+       struct rx_prod_pkt_bd *prod_bd, *cons_bd;
+
+       prod_rx_buf = &rxr->ag_buf_ring[prod];
+
+       prod_rx_buf->mbuf = mbuf;
+
+       prod_bd = &rxr->ag_desc_ring[prod];
+       cons_bd = &rxr->ag_desc_ring[cons];
+
+       prod_bd->addr = cons_bd->addr;
+}
+#endif
+
 static uint16_t bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
                            struct bnxt_rx_queue *rxq, uint32_t *raw_cons)
 {
@@ -104,9 +148,12 @@ static uint16_t bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
        uint32_t tmp_raw_cons = *raw_cons;
        uint16_t cons, prod, cp_cons =
            RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
+       uint16_t ag_cons, ag_prod = rxr->ag_prod;
        struct bnxt_sw_rx_bd *rx_buf;
        struct rte_mbuf *mbuf;
        int rc = 0;
+       uint8_t i;
+       uint8_t agg_buf = 0;
 
        rxcmp = (struct rx_pkt_cmpl *)
            &cpr->cp_desc_ring[cp_cons];
@@ -126,6 +173,9 @@ static uint16_t bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
        mbuf = rx_buf->mbuf;
        rte_prefetch0(mbuf);
 
+       if (mbuf == NULL)
+               return -ENOMEM;
+
        mbuf->nb_segs = 1;
        mbuf->next = NULL;
        mbuf->pkt_len = rxcmp->len;
@@ -139,6 +189,63 @@ static uint16_t bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
                mbuf->hash.fdir.id = rxcmp1->cfa_code;
                mbuf->ol_flags |= PKT_RX_FDIR | PKT_RX_FDIR_ID;
        }
+
+       agg_buf = (rxcmp->agg_bufs_v1 & RX_PKT_CMPL_AGG_BUFS_MASK)
+                       >> RX_PKT_CMPL_AGG_BUFS_SFT;
+       if (agg_buf) {
+               cp_cons = RING_CMP(cpr->cp_ring_struct, tmp_raw_cons + agg_buf);
+               rxcmp = (struct rx_pkt_cmpl *)
+                                       &cpr->cp_desc_ring[cp_cons];
+               if (!CMP_VALID(rxcmp, tmp_raw_cons + agg_buf,
+                              cpr->cp_ring_struct))
+                       return -EBUSY;
+               RTE_LOG(DEBUG, PMD, "JUMBO Frame %d. %x, agg_buf %x,\n",
+                       mbuf->pkt_len, rxcmp->agg_bufs_v1,  agg_buf);
+       }
+
+       for (i = 0; i < agg_buf; i++) {
+               struct bnxt_sw_rx_bd *ag_buf;
+               struct rte_mbuf *ag_mbuf;
+               tmp_raw_cons = NEXT_RAW_CMP(tmp_raw_cons);
+               cp_cons = RING_CMP(cpr->cp_ring_struct, tmp_raw_cons);
+               rxcmp = (struct rx_pkt_cmpl *)
+                                       &cpr->cp_desc_ring[cp_cons];
+               ag_cons = rxcmp->opaque;
+               ag_buf = &rxr->ag_buf_ring[ag_cons];
+               ag_mbuf = ag_buf->mbuf;
+               ag_mbuf->nb_segs = 1;
+               ag_mbuf->data_len = rxcmp->len;
+
+               mbuf->nb_segs++;
+               mbuf->pkt_len += ag_mbuf->data_len;
+               if (mbuf->next == NULL) {
+                       mbuf->next = ag_mbuf;
+               } else {
+                       struct rte_mbuf *temp_mbuf = mbuf;
+
+                       while (temp_mbuf->next != NULL)
+                               temp_mbuf = temp_mbuf->next;
+                       temp_mbuf->next = ag_mbuf;
+               }
+               ag_buf->mbuf = NULL;
+
+               ag_prod = RING_NEXT(rxr->ag_ring_struct, ag_prod);
+               if (bnxt_alloc_ag_data(rxq, rxr, ag_prod)) {
+                       RTE_LOG(ERR, PMD,
+                               "agg mbuf alloc failed: prod=0x%x\n",
+                               ag_prod);
+                       rc = -ENOMEM;
+               }
+               rxr->ag_prod = ag_prod;
+
+#ifdef BNXT_DEBUG
+               if (!CMP_VALID((struct cmpl_base *)
+                       &cpr->cp_desc_ring[cp_cons], tmp_raw_cons,
+                       cpr->cp_ring_struct))
+                       return -EBUSY;
+#endif
+       }
+
        if (rxcmp1->flags2 & RX_PKT_CMPL_FLAGS2_META_FORMAT_VLAN) {
                mbuf->vlan_tci = rxcmp1->metadata &
                        (RX_PKT_CMPL_METADATA_VID_MASK |
@@ -148,13 +255,17 @@ static uint16_t bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
        }
 
        rx_buf->mbuf = NULL;
+#ifdef BNXT_DEBUG
        if (rxcmp1->errors_v2 & RX_CMP_L2_ERRORS) {
                /* Re-install the mbuf back to the rx ring */
                bnxt_reuse_rx_mbuf(rxr, cons, mbuf);
+               if (agg_buf)
+                       bnxt_reuse_ag_mbuf(rxr, ag_cons, mbuf);
 
                rc = -EIO;
                goto next_rx;
        }
+#endif
        /*
         * TODO: Redesign this....
         * If the allocation fails, the packet does not get received.
@@ -170,25 +281,21 @@ static uint16_t bnxt_rx_pkt(struct rte_mbuf **rx_pkt,
         * calls in favour of a tight loop with the same function being called
         * in it.
         */
+       prod = RING_NEXT(rxr->rx_ring_struct, prod);
        if (bnxt_alloc_rx_data(rxq, rxr, prod)) {
                RTE_LOG(ERR, PMD, "mbuf alloc failed with prod=0x%x\n", prod);
                rc = -ENOMEM;
-               goto next_rx;
        }
-
+       rxr->rx_prod = prod;
        /*
         * All MBUFs are allocated with the same size under DPDK,
         * no optimization for rx_copy_thresh
         */
 
-       /* AGG buf operation is deferred */
-
-       /* EW - VLAN reception.  Must compare against the ol_flags */
-
        *rx_pkt = mbuf;
+#ifdef BNXT_DEBUG
 next_rx:
-       rxr->rx_prod = RING_NEXT(rxr->rx_ring_struct, prod);
-
+#endif
        *raw_cons = tmp_raw_cons;
 
        return rc;
@@ -203,8 +310,9 @@ uint16_t bnxt_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
        uint32_t raw_cons = cpr->cp_raw_cons;
        uint32_t cons;
        int nb_rx_pkts = 0;
-       bool rx_event = false;
        struct rx_pkt_cmpl *rxcmp;
+       uint16_t prod = rxr->rx_prod;
+       uint16_t ag_prod = rxr->ag_prod;
 
        /* Handle RX burst request */
        while (1) {
@@ -224,13 +332,13 @@ uint16_t bnxt_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
                                nb_rx_pkts++;
                        else if (rc == -EBUSY)  /* partial completion */
                                break;
-                       rx_event = true;
                }
                raw_cons = NEXT_RAW_CMP(raw_cons);
                if (nb_rx_pkts == nb_pkts)
                        break;
        }
-       if (raw_cons == cpr->cp_raw_cons) {
+
+       if (prod == rxr->rx_prod && ag_prod == rxr->ag_prod) {
                /*
                 * For PMD, there is no need to keep on pushing to REARM
                 * the doorbell if there are no new completions
@@ -240,8 +348,9 @@ uint16_t bnxt_recv_pkts(void *rx_queue, struct rte_mbuf **rx_pkts,
        cpr->cp_raw_cons = raw_cons;
 
        B_CP_DIS_DB(cpr, cpr->cp_raw_cons);
-       if (rx_event)
-               B_RX_DB(rxr->rx_doorbell, rxr->rx_prod);
+       B_RX_DB(rxr->rx_doorbell, rxr->rx_prod);
+       /* Ring the AGG ring DB */
+       B_RX_DB(rxr->ag_doorbell, rxr->ag_prod);
        return nb_rx_pkts;
 }
 
@@ -257,6 +366,12 @@ void bnxt_free_rx_rings(struct bnxt *bp)
 
                bnxt_free_ring(rxq->rx_ring->rx_ring_struct);
                rte_free(rxq->rx_ring->rx_ring_struct);
+
+               /* Free the Aggregator ring */
+               bnxt_free_ring(rxq->rx_ring->ag_ring_struct);
+               rte_free(rxq->rx_ring->ag_ring_struct);
+               rxq->rx_ring->ag_ring_struct = NULL;
+
                rte_free(rxq->rx_ring);
 
                bnxt_free_ring(rxq->cp_ring->cp_ring_struct);
@@ -270,13 +385,11 @@ void bnxt_free_rx_rings(struct bnxt *bp)
 
 int bnxt_init_rx_ring_struct(struct bnxt_rx_queue *rxq, unsigned int socket_id)
 {
-       struct bnxt *bp = rxq->bp;
        struct bnxt_cp_ring_info *cpr;
        struct bnxt_rx_ring_info *rxr;
        struct bnxt_ring *ring;
 
-       rxq->rx_buf_use_size = bp->eth_dev->data->mtu +
-                              ETHER_HDR_LEN + ETHER_CRC_LEN +
+       rxq->rx_buf_use_size = BNXT_MAX_MTU + ETHER_HDR_LEN + ETHER_CRC_LEN +
                               (2 * VLAN_TAG_SIZE);
        rxq->rx_buf_size = rxq->rx_buf_use_size + sizeof(struct rte_mbuf);
 
@@ -313,13 +426,29 @@ int bnxt_init_rx_ring_struct(struct bnxt_rx_queue *rxq, unsigned int socket_id)
        if (ring == NULL)
                return -ENOMEM;
        cpr->cp_ring_struct = ring;
-       ring->ring_size = rxr->rx_ring_struct->ring_size * 2;
+       ring->ring_size = rte_align32pow2(rxr->rx_ring_struct->ring_size *
+                                         (2 + AGG_RING_SIZE_FACTOR));
        ring->ring_mask = ring->ring_size - 1;
        ring->bd = (void *)cpr->cp_desc_ring;
        ring->bd_dma = cpr->cp_desc_mapping;
        ring->vmem_size = 0;
        ring->vmem = NULL;
 
+       /* Allocate Aggregator rings */
+       ring = rte_zmalloc_socket("bnxt_rx_ring_struct",
+                                  sizeof(struct bnxt_ring),
+                                  RTE_CACHE_LINE_SIZE, socket_id);
+       if (ring == NULL)
+               return -ENOMEM;
+       rxr->ag_ring_struct = ring;
+       ring->ring_size = rte_align32pow2(rxq->nb_rx_desc *
+                                         AGG_RING_SIZE_FACTOR);
+       ring->ring_mask = ring->ring_size - 1;
+       ring->bd = (void *)rxr->ag_desc_ring;
+       ring->bd_dma = rxr->ag_desc_mapping;
+       ring->vmem_size = ring->ring_size * sizeof(struct bnxt_sw_rx_bd);
+       ring->vmem = (void **)&rxr->ag_buf_ring;
+
        return 0;
 }
 
@@ -332,8 +461,8 @@ static void bnxt_init_rxbds(struct bnxt_ring *ring, uint32_t type,
        if (!rx_bd_ring)
                return;
        for (j = 0; j < ring->ring_size; j++) {
-               rx_bd_ring[j].flags_type = type;
-               rx_bd_ring[j].len = len;
+               rx_bd_ring[j].flags_type = rte_cpu_to_le_16(type);
+               rx_bd_ring[j].len = rte_cpu_to_le_16(len);
                rx_bd_ring[j].opaque = j;
        }
 }
@@ -344,12 +473,17 @@ int bnxt_init_one_rx_ring(struct bnxt_rx_queue *rxq)
        struct bnxt_ring *ring;
        uint32_t prod, type;
        unsigned int i;
+       uint16_t size;
 
-       type = RX_PROD_PKT_BD_TYPE_RX_PROD_PKT | RX_PROD_PKT_BD_FLAGS_EOP_PAD;
+       size = rte_pktmbuf_data_room_size(rxq->mb_pool) - RTE_PKTMBUF_HEADROOM;
+       if (rxq->rx_buf_use_size <= size)
+               size = rxq->rx_buf_use_size;
+
+       type = RX_PROD_PKT_BD_TYPE_RX_PROD_PKT;
 
        rxr = rxq->rx_ring;
        ring = rxr->rx_ring_struct;
-       bnxt_init_rxbds(ring, type, rxq->rx_buf_use_size);
+       bnxt_init_rxbds(ring, type, size);
 
        prod = rxr->rx_prod;
        for (i = 0; i < ring->ring_size; i++) {
@@ -362,6 +496,24 @@ int bnxt_init_one_rx_ring(struct bnxt_rx_queue *rxq)
                rxr->rx_prod = prod;
                prod = RING_NEXT(rxr->rx_ring_struct, prod);
        }
+       RTE_LOG(DEBUG, PMD, "%s\n", __func__);
+
+       ring = rxr->ag_ring_struct;
+       type = RX_PROD_AGG_BD_TYPE_RX_PROD_AGG;
+       bnxt_init_rxbds(ring, type, size);
+       prod = rxr->ag_prod;
+
+       for (i = 0; i < ring->ring_size; i++) {
+               if (bnxt_alloc_ag_data(rxq, rxr, prod) != 0) {
+                       RTE_LOG(WARNING, PMD,
+                       "init'ed AG ring %d with %d/%d mbufs only\n",
+                       rxq->queue_id, i, ring->ring_size);
+                       break;
+               }
+               rxr->ag_prod = prod;
+               prod = RING_NEXT(rxr->ag_ring_struct, prod);
+       }
+       RTE_LOG(DEBUG, PMD, "%s AGG Done!\n", __func__);
 
        return 0;
 }