net: sun8i_emac: Add CLK and RESET support
authorJagan Teki <jagan@amarulasolutions.com>
Wed, 27 Feb 2019 18:56:58 +0000 (00:26 +0530)
committerJagan Teki <jagan@amarulasolutions.com>
Tue, 16 Apr 2019 10:59:01 +0000 (16:29 +0530)
Add CLK and RESET support for sun8i_emac driver to
enable TX clock and reset pins via CLK and RESET
framework.

Cc: Joe Hershberger <joe.hershberger@ni.com>
Cc: Lothar Felten <lothar.felten@gmail.com>
Signed-off-by: Jagan Teki <jagan@amarulasolutions.com>
Acked-by: Joe Hershberger <joe.hershberger@ni.com>
drivers/net/sun8i_emac.c

index a7fb7ac4055fad6aadd959d46768b7d347aeb68a..98bd7a58232fd0e9416529e67bd835f8949202a0 100644 (file)
 #include <asm/arch/clock.h>
 #include <asm/arch/gpio.h>
 #include <common.h>
+#include <clk.h>
 #include <dm.h>
 #include <fdt_support.h>
 #include <linux/err.h>
 #include <malloc.h>
 #include <miiphy.h>
 #include <net.h>
+#include <reset.h>
 #include <dt-bindings/pinctrl/sun4i-a10.h>
 #ifdef CONFIG_DM_GPIO
 #include <asm-generic/gpio.h>
@@ -135,6 +137,8 @@ struct emac_eth_dev {
        phys_addr_t sysctl_reg;
        struct phy_device *phydev;
        struct mii_dev *bus;
+       struct clk tx_clk;
+       struct reset_ctl tx_rst;
 #ifdef CONFIG_DM_GPIO
        struct gpio_desc reset_gpio;
 #endif
@@ -647,9 +651,24 @@ static int sun8i_eth_write_hwaddr(struct udevice *dev)
        return _sun8i_write_hwaddr(priv, pdata->enetaddr);
 }
 
-static void sun8i_emac_board_setup(struct emac_eth_dev *priv)
+static int sun8i_emac_board_setup(struct emac_eth_dev *priv)
 {
        struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
+       int ret;
+
+       ret = clk_enable(&priv->tx_clk);
+       if (ret) {
+               dev_err(dev, "failed to enable TX clock\n");
+               return ret;
+       }
+
+       if (reset_valid(&priv->tx_rst)) {
+               ret = reset_deassert(&priv->tx_rst);
+               if (ret) {
+                       dev_err(dev, "failed to deassert TX reset\n");
+                       goto err_tx_clk;
+               }
+       }
 
        if (priv->variant == H3_EMAC) {
                /* Only H3/H5 have clock controls for internal EPHY */
@@ -664,19 +683,11 @@ static void sun8i_emac_board_setup(struct emac_eth_dev *priv)
                }
        }
 
-       if (priv->variant == R40_GMAC) {
-               /* Set clock gating for emac */
-               setbits_le32(&ccm->ahb_reset1_cfg, BIT(AHB_RESET_OFFSET_GMAC));
-
-               /* De-assert EMAC */
-               setbits_le32(&ccm->ahb_gate1, BIT(AHB_GATE_OFFSET_GMAC));
-       } else {
-               /* Set clock gating for emac */
-               setbits_le32(&ccm->ahb_gate0, BIT(AHB_GATE_OFFSET_GMAC));
+       return 0;
 
-               /* De-assert EMAC */
-               setbits_le32(&ccm->ahb_reset0_cfg, BIT(AHB_RESET_OFFSET_GMAC));
-       }
+err_tx_clk:
+       clk_disable(&priv->tx_clk);
+       return ret;
 }
 
 #if defined(CONFIG_DM_GPIO)
@@ -803,10 +814,14 @@ static int sun8i_emac_eth_probe(struct udevice *dev)
        struct sun8i_eth_pdata *sun8i_pdata = dev_get_platdata(dev);
        struct eth_pdata *pdata = &sun8i_pdata->eth_pdata;
        struct emac_eth_dev *priv = dev_get_priv(dev);
+       int ret;
 
        priv->mac_reg = (void *)pdata->iobase;
 
-       sun8i_emac_board_setup(priv);
+       ret = sun8i_emac_board_setup(priv);
+       if (ret)
+               return ret;
+
        sun8i_emac_set_syscon(sun8i_pdata, priv);
 
        sun8i_mdio_init(dev->name, dev);
@@ -835,8 +850,8 @@ static int sun8i_emac_eth_ofdata_to_platdata(struct udevice *dev)
        int offset = 0;
 #ifdef CONFIG_DM_GPIO
        int reset_flags = GPIOD_IS_OUT;
-       int ret = 0;
 #endif
+       int ret;
 
        pdata->iobase = devfdt_get_addr(dev);
        if (pdata->iobase == FDT_ADDR_T_NONE) {
@@ -851,6 +866,18 @@ static int sun8i_emac_eth_ofdata_to_platdata(struct udevice *dev)
                return -EINVAL;
        }
 
+       ret = clk_get_by_name(dev, "stmmaceth", &priv->tx_clk);
+       if (ret) {
+               dev_err(dev, "failed to get TX clock\n");
+               return ret;
+       }
+
+       ret = reset_get_by_name(dev, "stmmaceth", &priv->tx_rst);
+       if (ret && ret != -ENOENT) {
+               dev_err(dev, "failed to get TX reset\n");
+               return ret;
+       }
+
        offset = fdtdec_lookup_phandle(gd->fdt_blob, node, "syscon");
        if (offset < 0) {
                debug("%s: cannot find syscon node\n", __func__);