1 files changed, 32 insertions, 1 deletions

diff --git a/drivers/clk/tegra/clk-pll.c b/drivers/clk/tegra/clk-pll.c
index 6aad8abc69a2..637b62ccc91e 100644
--- a/drivers/clk/tegra/clk-pll.c
+++ b/drivers/clk/tegra/clk-pll.c
@@ -96,10 +96,20 @@
         (PLLE_SS_MAX_VAL | PLLE_SS_INC_VAL | PLLE_SS_INCINTRV_VAL)
 
 #define PLLE_AUX_PLLP_SEL       BIT(2)
+#define PLLE_AUX_USE_LOCKDET    BIT(3)
 #define PLLE_AUX_ENABLE_SWCTL   BIT(4)
+#define PLLE_AUX_SS_SWCTL       BIT(6)
 #define PLLE_AUX_SEQ_ENABLE     BIT(24)
+#define PLLE_AUX_SEQ_START_STATE BIT(25)
 #define PLLE_AUX_PLLRE_SEL      BIT(28)
 
+#define XUSBIO_PLL_CFG0         0x51c
+#define XUSBIO_PLL_CFG0_PADPLL_RESET_SWCTL      BIT(0)
+#define XUSBIO_PLL_CFG0_CLK_ENABLE_SWCTL        BIT(2)
+#define XUSBIO_PLL_CFG0_PADPLL_USE_LOCKDET      BIT(6)
+#define XUSBIO_PLL_CFG0_SEQ_ENABLE              BIT(24)
+#define XUSBIO_PLL_CFG0_SEQ_START_STATE         BIT(25)
+
 #define PLLE_MISC_PLLE_PTS      BIT(8)
 #define PLLE_MISC_IDDQ_SW_VALUE BIT(13)
 #define PLLE_MISC_IDDQ_SW_CTRL  BIT(14)
@@ -1328,7 +1338,28 @@ static int clk_plle_tegra114_enable(struct clk_hw *hw)
         pll_writel(val, PLLE_SS_CTRL, pll);
         udelay(1);
 
-        /* TODO: enable hw control of xusb brick pll */
+        /* Enable hw control of xusb brick pll */
+        val = pll_readl_misc(pll);
+        val &= ~PLLE_MISC_IDDQ_SW_CTRL;
+        pll_writel_misc(val, pll);
+
+        val = pll_readl(pll->params->aux_reg, pll);
+        val |= (PLLE_AUX_USE_LOCKDET | PLLE_AUX_SEQ_START_STATE);
+        val &= ~(PLLE_AUX_ENABLE_SWCTL | PLLE_AUX_SS_SWCTL);
+        pll_writel(val, pll->params->aux_reg, pll);
+        udelay(1);
+        val |= PLLE_AUX_SEQ_ENABLE;
+        pll_writel(val, pll->params->aux_reg, pll);
+
+        val = pll_readl(XUSBIO_PLL_CFG0, pll);
+        val |= (XUSBIO_PLL_CFG0_PADPLL_USE_LOCKDET |
+                XUSBIO_PLL_CFG0_SEQ_START_STATE);
+        val &= ~(XUSBIO_PLL_CFG0_CLK_ENABLE_SWCTL |
+                 XUSBIO_PLL_CFG0_PADPLL_RESET_SWCTL);
+        pll_writel(val, XUSBIO_PLL_CFG0, pll);
+        udelay(1);
+        val |= XUSBIO_PLL_CFG0_SEQ_ENABLE;
+        pll_writel(val, XUSBIO_PLL_CFG0, pll);
 
 out:
         if (pll->lock)