[PATCH v2 44/65] PCI: imx6: Factor out ref clock enable

[Andrey Smirnov]

Port of a Linux commit 4d1821e729b5d2060ef8c9825af1dacc2182da38

  Factor out ref clock enable to make it cleaner to add imx6sx support.  No
  functional change intended.

  Signed-off-by: Bjorn Helgaas <bhelg...@google.com>
  Tested-by: Christoph Fritz <chf.fr...@googlemail.com>

Signed-off-by: Andrey Smirnov <andrew.smir...@gmail.com>
---
 drivers/pci/pci-imx6.c | 43 ++++++++++++++++++++++++++++--------------
 1 file changed, 29 insertions(+), 14 deletions(-)

diff --git a/drivers/pci/pci-imx6.c b/drivers/pci/pci-imx6.c
index fa62aa3a4..447bb72ad 100644
--- a/drivers/pci/pci-imx6.c
+++ b/drivers/pci/pci-imx6.c
@@ -285,6 +285,28 @@ static void imx6_pcie_assert_core_reset(struct imx6_pcie 
*imx6_pcie)
        }
 }
 
+static int imx6_pcie_enable_ref_clk(struct imx6_pcie *imx6_pcie)
+{
+       u32 gpr1;
+
+       /* power up core phy and enable ref clock */
+       gpr1 = readl(imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
+       gpr1 &= ~IMX6Q_GPR1_PCIE_TEST_PD;
+       writel(gpr1, imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
+       /*
+        * the async reset input need ref clock to sync internally,
+        * when the ref clock comes after reset, internal synced
+        * reset time is too short, cannot meet the requirement.
+        * add one ~10us delay here.
+        */
+       udelay(10);
+       gpr1 = readl(imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
+       gpr1 |= IMX6Q_GPR1_PCIE_REF_CLK_EN;
+       writel(gpr1, imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
+
+       return 0;
+}
+
 static void imx6_pcie_deassert_core_reset(struct imx6_pcie *imx6_pcie)
 {
        struct device_d *dev = imx6_pcie->pp.dev;
@@ -309,20 +331,11 @@ static void imx6_pcie_deassert_core_reset(struct 
imx6_pcie *imx6_pcie)
                goto err_pcie;
        }
 
-       /* power up core phy and enable ref clock */
-       gpr1 = readl(imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
-       gpr1 &= ~IMX6Q_GPR1_PCIE_TEST_PD;
-       writel(gpr1, imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
-       /*
-        * the async reset input need ref clock to sync internally,
-        * when the ref clock comes after reset, internal synced
-        * reset time is too short, cannot meet the requirement.
-        * add one ~10us delay here.
-        */
-       udelay(10);
-       gpr1 = readl(imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
-       gpr1 |= IMX6Q_GPR1_PCIE_REF_CLK_EN;
-       writel(gpr1, imx6_pcie->iomuxc_gpr + IOMUXC_GPR1);
+       ret = imx6_pcie_enable_ref_clk(imx6_pcie);
+       if (ret) {
+               dev_err(dev, "unable to enable pcie ref clock\n");
+               goto err_ref_clk;
+       }
 
        /* allow the clocks to stabilize */
        udelay(200);
@@ -351,6 +364,8 @@ static void imx6_pcie_deassert_core_reset(struct imx6_pcie 
*imx6_pcie)
 
        return;
 
+err_ref_clk:
+       clk_disable(imx6_pcie->pcie);
 err_pcie:
        clk_disable(imx6_pcie->pcie_bus);
 err_pcie_bus:
-- 
2.19.1


_______________________________________________
barebox mailing list
barebox@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/barebox