net: stmmac: add platform level clocks management

This patch intends to add platform level clocks management. Some
platforms may have their own special clocks, they also need to be
managed dynamically. If you want to manage such clocks, please implement
clks_config callback.

Reviewed-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Joakim Zhang <qiangqing.zhang@nxp.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
index 3c50846..a10704d 100644 (file)
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_main.c
@@ -127,9 +127,19 @@ int stmmac_bus_clks_config(struct stmmac_priv *priv, bool enabled)
                        clk_disable_unprepare(priv->plat->stmmac_clk);
                        return ret;
                }
+               if (priv->plat->clks_config) {
+                       ret = priv->plat->clks_config(priv->plat->bsp_priv, enabled);
+                       if (ret) {
+                               clk_disable_unprepare(priv->plat->stmmac_clk);
+                               clk_disable_unprepare(priv->plat->pclk);
+                               return ret;
+                       }
+               }
        } else {
                clk_disable_unprepare(priv->plat->stmmac_clk);
                clk_disable_unprepare(priv->plat->pclk);
+               if (priv->plat->clks_config)
+                       priv->plat->clks_config(priv->plat->bsp_priv, enabled);
        }
 
        return ret;

diff --git a/include/linux/stmmac.h b/include/linux/stmmac.h
index 722dc16..51004eb 100644 (file)
--- a/include/linux/stmmac.h
+++ b/include/linux/stmmac.h
@@ -184,6 +184,7 @@ struct plat_stmmacenet_data {
        int (*init)(struct platform_device *pdev, void *priv);
        void (*exit)(struct platform_device *pdev, void *priv);
        struct mac_device_info *(*setup)(void *priv);
+       int (*clks_config)(void *priv, bool enabled);
        void *bsp_priv;
        struct clk *stmmac_clk;
        struct clk *pclk;