net: macb: add function to disable all macb clocks
authorClaudiu Beznea <claudiu.beznea@microchip.com>
Wed, 9 Dec 2020 13:03:34 +0000 (15:03 +0200)
committerDavid S. Miller <davem@davemloft.net>
Thu, 10 Dec 2020 00:19:20 +0000 (16:19 -0800)
Add function to disable all macb clocks.

Signed-off-by: Claudiu Beznea <claudiu.beznea@microchip.com>
Suggested-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: David S. Miller <davem@davemloft.net>
drivers/net/ethernet/cadence/macb_main.c

index b23e986..8170498 100644 (file)
@@ -3694,6 +3694,20 @@ static void macb_probe_queues(void __iomem *mem,
        *num_queues = hweight32(*queue_mask);
 }
 
+static void macb_clks_disable(struct clk *pclk, struct clk *hclk, struct clk *tx_clk,
+                             struct clk *rx_clk, struct clk *tsu_clk)
+{
+       struct clk_bulk_data clks[] = {
+               { .clk = tsu_clk, },
+               { .clk = rx_clk, },
+               { .clk = pclk, },
+               { .clk = hclk, },
+               { .clk = tx_clk },
+       };
+
+       clk_bulk_disable_unprepare(ARRAY_SIZE(clks), clks);
+}
+
 static int macb_clk_init(struct platform_device *pdev, struct clk **pclk,
                         struct clk **hclk, struct clk **tx_clk,
                         struct clk **rx_clk, struct clk **tsu_clk)
@@ -4755,11 +4769,7 @@ err_out_free_netdev:
        free_netdev(dev);
 
 err_disable_clocks:
-       clk_disable_unprepare(tx_clk);
-       clk_disable_unprepare(hclk);
-       clk_disable_unprepare(pclk);
-       clk_disable_unprepare(rx_clk);
-       clk_disable_unprepare(tsu_clk);
+       macb_clks_disable(pclk, hclk, tx_clk, rx_clk, tsu_clk);
        pm_runtime_disable(&pdev->dev);
        pm_runtime_set_suspended(&pdev->dev);
        pm_runtime_dont_use_autosuspend(&pdev->dev);
@@ -4784,11 +4794,8 @@ static int macb_remove(struct platform_device *pdev)
                pm_runtime_disable(&pdev->dev);
                pm_runtime_dont_use_autosuspend(&pdev->dev);
                if (!pm_runtime_suspended(&pdev->dev)) {
-                       clk_disable_unprepare(bp->tx_clk);
-                       clk_disable_unprepare(bp->hclk);
-                       clk_disable_unprepare(bp->pclk);
-                       clk_disable_unprepare(bp->rx_clk);
-                       clk_disable_unprepare(bp->tsu_clk);
+                       macb_clks_disable(bp->pclk, bp->hclk, bp->tx_clk,
+                                         bp->rx_clk, bp->tsu_clk);
                        pm_runtime_set_suspended(&pdev->dev);
                }
                phylink_destroy(bp->phylink);
@@ -4967,13 +4974,10 @@ static int __maybe_unused macb_runtime_suspend(struct device *dev)
        struct net_device *netdev = dev_get_drvdata(dev);
        struct macb *bp = netdev_priv(netdev);
 
-       if (!(device_may_wakeup(dev))) {
-               clk_disable_unprepare(bp->tx_clk);
-               clk_disable_unprepare(bp->hclk);
-               clk_disable_unprepare(bp->pclk);
-               clk_disable_unprepare(bp->rx_clk);
-       }
-       clk_disable_unprepare(bp->tsu_clk);
+       if (!(device_may_wakeup(dev)))
+               macb_clks_disable(bp->pclk, bp->hclk, bp->tx_clk, bp->rx_clk, bp->tsu_clk);
+       else
+               macb_clks_disable(NULL, NULL, NULL, NULL, bp->tsu_clk);
 
        return 0;
 }