Implement support for qcfg provided rx page sizes. For that, implement
the ndo_default_qcfg callback and validate the config on restart. Also,
use the current config's value in bnxt_init_ring_struct to retain the
correct size across resets.

Signed-off-by: Pavel Begunkov <[email protected]>
---
 drivers/net/ethernet/broadcom/bnxt/bnxt.c | 36 ++++++++++++++++++++++-
 drivers/net/ethernet/broadcom/bnxt/bnxt.h |  1 +
 2 files changed, 36 insertions(+), 1 deletion(-)

diff --git a/drivers/net/ethernet/broadcom/bnxt/bnxt.c 
b/drivers/net/ethernet/broadcom/bnxt/bnxt.c
index 137e348d2b9c..3ffe4fe159d3 100644
--- a/drivers/net/ethernet/broadcom/bnxt/bnxt.c
+++ b/drivers/net/ethernet/broadcom/bnxt/bnxt.c
@@ -4325,6 +4325,7 @@ static void bnxt_init_ring_struct(struct bnxt *bp)
                struct bnxt_rx_ring_info *rxr;
                struct bnxt_tx_ring_info *txr;
                struct bnxt_ring_struct *ring;
+               struct netdev_rx_queue *rxq;
 
                if (!bnapi)
                        continue;
@@ -4342,7 +4343,8 @@ static void bnxt_init_ring_struct(struct bnxt *bp)
                if (!rxr)
                        goto skip_rx;
 
-               rxr->rx_page_size = BNXT_RX_PAGE_SIZE;
+               rxq = __netif_get_rx_queue(bp->dev, i);
+               rxr->rx_page_size = rxq->qcfg.rx_page_size;
 
                ring = &rxr->rx_ring_struct;
                rmem = &ring->ring_mem;
@@ -15932,6 +15934,29 @@ static const struct netdev_stat_ops bnxt_stat_ops = {
        .get_base_stats         = bnxt_get_base_stats,
 };
 
+static void bnxt_queue_default_qcfg(struct net_device *dev,
+                                   struct netdev_queue_config *qcfg)
+{
+       qcfg->rx_page_size = BNXT_RX_PAGE_SIZE;
+}
+
+static int bnxt_validate_qcfg(struct bnxt *bp, struct netdev_queue_config 
*qcfg)
+{
+       /* Older chips need MSS calc so rx_page_size is not supported */
+       if (!(bp->flags & BNXT_FLAG_CHIP_P5_PLUS) &&
+            qcfg->rx_page_size != BNXT_RX_PAGE_SIZE)
+               return -EINVAL;
+
+       if (!is_power_of_2(qcfg->rx_page_size))
+               return -ERANGE;
+
+       if (qcfg->rx_page_size < BNXT_RX_PAGE_SIZE ||
+           qcfg->rx_page_size > BNXT_MAX_RX_PAGE_SIZE)
+               return -ERANGE;
+
+       return 0;
+}
+
 static int bnxt_queue_mem_alloc(struct net_device *dev,
                                struct netdev_queue_config *qcfg,
                                void *qmem, int idx)
@@ -15944,6 +15969,10 @@ static int bnxt_queue_mem_alloc(struct net_device *dev,
        if (!bp->rx_ring)
                return -ENETDOWN;
 
+       rc = bnxt_validate_qcfg(bp, qcfg);
+       if (rc < 0)
+               return rc;
+
        rxr = &bp->rx_ring[idx];
        clone = qmem;
        memcpy(clone, rxr, sizeof(*rxr));
@@ -15955,6 +15984,7 @@ static int bnxt_queue_mem_alloc(struct net_device *dev,
        clone->rx_sw_agg_prod = 0;
        clone->rx_next_cons = 0;
        clone->need_head_pool = false;
+       clone->rx_page_size = qcfg->rx_page_size;
 
        rc = bnxt_alloc_rx_page_pool(bp, clone, rxr->page_pool->p.nid);
        if (rc)
@@ -16081,6 +16111,8 @@ static void bnxt_copy_rx_ring(struct bnxt *bp,
        src_ring = &src->rx_agg_ring_struct;
        src_rmem = &src_ring->ring_mem;
 
+       dst->rx_page_size = src->rx_page_size;
+
        WARN_ON(dst_rmem->nr_pages != src_rmem->nr_pages);
        WARN_ON(dst_rmem->page_size != src_rmem->page_size);
        WARN_ON(dst_rmem->flags != src_rmem->flags);
@@ -16235,6 +16267,8 @@ static const struct netdev_queue_mgmt_ops 
bnxt_queue_mgmt_ops = {
        .ndo_queue_mem_free     = bnxt_queue_mem_free,
        .ndo_queue_start        = bnxt_queue_start,
        .ndo_queue_stop         = bnxt_queue_stop,
+       .ndo_default_qcfg       = bnxt_queue_default_qcfg,
+       .supported_params       = QCFG_RX_PAGE_SIZE,
 };
 
 static void bnxt_remove_one(struct pci_dev *pdev)
diff --git a/drivers/net/ethernet/broadcom/bnxt/bnxt.h 
b/drivers/net/ethernet/broadcom/bnxt/bnxt.h
index 4c880a9fba92..d245eefbbdda 100644
--- a/drivers/net/ethernet/broadcom/bnxt/bnxt.h
+++ b/drivers/net/ethernet/broadcom/bnxt/bnxt.h
@@ -760,6 +760,7 @@ struct nqe_cn {
 #endif
 
 #define BNXT_RX_PAGE_SIZE (1 << BNXT_RX_PAGE_SHIFT)
+#define BNXT_MAX_RX_PAGE_SIZE BIT(15)
 
 #define BNXT_MAX_MTU           9500
 
-- 
2.52.0


Reply via email to