net: fec: parser max queue number from dt file

By default, the tx/rx queue number is 1, user can config the queue number
at DTS file like this:
	fsl,num-tx-queues=<3>;
	fsl,num-rx-queues=<3>

Since i.MX6SX enet-AVB IP support multi queues, so use multi queues
interface to allocate and set up an Ethernet device.

Signed-off-by: Fugang Duan <B38611@freescale.com>
Signed-off-by: Frank Li <Frank.Li@freescale.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/freescale/fec.h b/drivers/net/ethernet/freescale/fec.h
index b2b91f8826a249cca24744a220142be939339b4f..72fb90f6ec18c225f022efd55dedc04d088dbca5 100644 (file)
--- a/drivers/net/ethernet/freescale/fec.h
+++ b/drivers/net/ethernet/freescale/fec.h
@@ -356,6 +356,8 @@ struct fec_enet_private {
 
        bool ptp_clk_on;
        struct mutex ptp_clk_mutex;
+       unsigned int num_tx_queues;
+       unsigned int num_rx_queues;
 
        /* The saved address of a sent-in-place packet/buffer, for skfree(). */
        struct fec_enet_priv_tx_q *tx_queue[FEC_ENET_MAX_TX_QS];

diff --git a/drivers/net/ethernet/freescale/fec_main.c b/drivers/net/ethernet/freescale/fec_main.c
index 4c0d2ee11428995db5c791b33b4d805efba3d999..2240df0abbaa7d3aaefaae7ff2cfbd7ba117c2d9 100644 (file)
--- a/drivers/net/ethernet/freescale/fec_main.c
+++ b/drivers/net/ethernet/freescale/fec_main.c
@@ -2709,6 +2709,42 @@ static void fec_reset_phy(struct platform_device *pdev)
 }
 #endif /* CONFIG_OF */
 
+static void
+fec_enet_get_queue_num(struct platform_device *pdev, int *num_tx, int *num_rx)
+{
+       struct device_node *np = pdev->dev.of_node;
+       int err;
+
+       *num_tx = *num_rx = 1;
+
+       if (!np || !of_device_is_available(np))
+               return;
+
+       /* parse the num of tx and rx queues */
+       err = of_property_read_u32(np, "fsl,num-tx-queues", num_tx);
+       err |= of_property_read_u32(np, "fsl,num-rx-queues", num_rx);
+       if (err) {
+               *num_tx = 1;
+               *num_rx = 1;
+               return;
+       }
+
+       if (*num_tx < 1 || *num_tx > FEC_ENET_MAX_TX_QS) {
+               dev_err(&pdev->dev, "Invalidate num_tx(=%d), fail back to 1\n",
+                       *num_tx);
+               *num_tx = 1;
+               return;
+       }
+
+       if (*num_rx < 1 || *num_rx > FEC_ENET_MAX_RX_QS) {
+               dev_err(&pdev->dev, "Invalidate num_rx(=%d), fail back to 1\n",
+                       *num_rx);
+               *num_rx = 1;
+               return;
+       }
+
+}
+
 static int
 fec_probe(struct platform_device *pdev)
 {
@@ -2720,13 +2756,18 @@ fec_probe(struct platform_device *pdev)
        const struct of_device_id *of_id;
        static int dev_id;
        struct device_node *np = pdev->dev.of_node, *phy_node;
+       int num_tx_qs = 1;
+       int num_rx_qs = 1;
 
        of_id = of_match_device(fec_dt_ids, &pdev->dev);
        if (of_id)
                pdev->id_entry = of_id->data;
 
+       fec_enet_get_queue_num(pdev, &num_tx_qs, &num_rx_qs);
+
        /* Init network device */
-       ndev = alloc_etherdev(sizeof(struct fec_enet_private));
+       ndev = alloc_etherdev_mqs(sizeof(struct fec_enet_private),
+                                 num_tx_qs, num_rx_qs);
        if (!ndev)
                return -ENOMEM;
 
@@ -2735,6 +2776,9 @@ fec_probe(struct platform_device *pdev)
        /* setup board info structure */
        fep = netdev_priv(ndev);
 
+       fep->num_rx_queues = num_rx_qs;
+       fep->num_tx_queues = num_tx_qs;
+
 #if !defined(CONFIG_M5272)
        /* default enable pause frame auto negotiation */
        if (pdev->id_entry &&