Added functions to enable and disable USB clocks which can be invoked
during USB init and  USB exit respectively.

Cc: Roger Quadros <rog...@ti.com>
Cc: Tero Kristo <t-kri...@ti.com>
Cc: Nishanth Menon <n...@ti.com>
Signed-off-by: Kishon Vijay Abraham I <kis...@ti.com>
---
 arch/arm/cpu/armv7/omap5/hw_data.c |   97 ++++++++++++++++++++++++++++++++++++
 arch/arm/include/asm/omap_common.h |    6 +++
 2 files changed, 103 insertions(+)

diff --git a/arch/arm/cpu/armv7/omap5/hw_data.c 
b/arch/arm/cpu/armv7/omap5/hw_data.c
index 11440ac..1085bb3 100644
--- a/arch/arm/cpu/armv7/omap5/hw_data.c
+++ b/arch/arm/cpu/armv7/omap5/hw_data.c
@@ -581,6 +581,103 @@ void enable_basic_uboot_clocks(void)
                         1);
 }
 
+#ifdef CONFIG_USB_DWC3
+void enable_usb_clocks(int index)
+{
+       u32 cm_l3init_usb_otg_ss_clkctrl = 0;
+
+       if (index == 0) {
+               cm_l3init_usb_otg_ss_clkctrl =
+                       (*prcm)->cm_l3init_usb_otg_ss1_clkctrl;
+               /* Enable 960 MHz clock for dwc3 */
+               setbits_le32((*prcm)->cm_l3init_usb_otg_ss1_clkctrl,
+                            OPTFCLKEN_REFCLK960M);
+
+               /* Enable 32 KHz clock for dwc3 */
+               setbits_le32((*prcm)->cm_coreaon_usb_phy1_core_clkctrl,
+                            USBPHY_CORE_CLKCTRL_OPTFCLKEN_CLK32K);
+       } else if (index == 1) {
+               cm_l3init_usb_otg_ss_clkctrl =
+                       (*prcm)->cm_l3init_usb_otg_ss2_clkctrl;
+               /* Enable 960 MHz clock for dwc3 */
+               setbits_le32((*prcm)->cm_l3init_usb_otg_ss2_clkctrl,
+                            OPTFCLKEN_REFCLK960M);
+
+               /* Enable 32 KHz clock for dwc3 */
+               setbits_le32((*prcm)->cm_coreaon_usb_phy2_core_clkctrl,
+                            USBPHY_CORE_CLKCTRL_OPTFCLKEN_CLK32K);
+
+               /* Enable 60 MHz clock for USB2PHY2 */
+               setbits_le32((*prcm)->cm_coreaon_l3init_60m_gfclk_clkctrl,
+                            L3INIT_CLKCTRL_OPTFCLKEN_60M_GFCLK);
+       }
+
+       u32 const clk_domains_usb[] = {
+               0
+       };
+
+       u32 const clk_modules_hw_auto_usb[] = {
+               (*prcm)->cm_l3init_ocp2scp1_clkctrl,
+               cm_l3init_usb_otg_ss_clkctrl,
+               0
+       };
+
+       u32 const clk_modules_explicit_en_usb[] = {
+               0
+       };
+
+       do_enable_clocks(clk_domains_usb,
+                        clk_modules_hw_auto_usb,
+                        clk_modules_explicit_en_usb,
+                        1);
+}
+
+void disable_usb_clocks(int index)
+{
+       u32 cm_l3init_usb_otg_ss_clkctrl = 0;
+
+       if (index == 0) {
+               cm_l3init_usb_otg_ss_clkctrl =
+                       (*prcm)->cm_l3init_usb_otg_ss1_clkctrl;
+               /* Disable 960 MHz clock for dwc3 */
+               clrbits_le32((*prcm)->cm_l3init_usb_otg_ss1_clkctrl,
+                            OPTFCLKEN_REFCLK960M);
+
+               /* Disable 32 KHz clock for dwc3 */
+               clrbits_le32((*prcm)->cm_coreaon_usb_phy1_core_clkctrl,
+                            USBPHY_CORE_CLKCTRL_OPTFCLKEN_CLK32K);
+       } else if (index == 1) {
+               cm_l3init_usb_otg_ss_clkctrl =
+                       (*prcm)->cm_l3init_usb_otg_ss2_clkctrl;
+               /* Disable 960 MHz clock for dwc3 */
+               clrbits_le32((*prcm)->cm_l3init_usb_otg_ss2_clkctrl,
+                            OPTFCLKEN_REFCLK960M);
+
+               /* Disable 32 KHz clock for dwc3 */
+               clrbits_le32((*prcm)->cm_coreaon_usb_phy2_core_clkctrl,
+                            USBPHY_CORE_CLKCTRL_OPTFCLKEN_CLK32K);
+
+               /* Disable 60 MHz clock for USB2PHY2 */
+               clrbits_le32((*prcm)->cm_coreaon_l3init_60m_gfclk_clkctrl,
+                            L3INIT_CLKCTRL_OPTFCLKEN_60M_GFCLK);
+       }
+
+       u32 const clk_domains_usb[] = {
+               0
+       };
+
+       u32 const clk_modules_disable[] = {
+               (*prcm)->cm_l3init_ocp2scp1_clkctrl,
+               cm_l3init_usb_otg_ss_clkctrl,
+               0
+       };
+
+       do_disable_clocks(clk_domains_usb,
+                         clk_modules_disable,
+                         1);
+}
+#endif
+
 const struct ctrl_ioregs ioregs_omap5430 = {
        .ctrl_ddrch = DDR_IO_I_34OHM_SR_FASTEST_WD_DQ_NO_PULL_DQS_PULL_DOWN,
        .ctrl_lpddr2ch = DDR_IO_I_34OHM_SR_FASTEST_WD_CK_CKE_NCS_CA_PULL_DOWN,
diff --git a/arch/arm/include/asm/omap_common.h 
b/arch/arm/include/asm/omap_common.h
index 224fbf0..527e143 100644
--- a/arch/arm/include/asm/omap_common.h
+++ b/arch/arm/include/asm/omap_common.h
@@ -587,6 +587,12 @@ u32 omap_ddr_clk(void);
 u32 get_sys_clk_index(void);
 void enable_basic_clocks(void);
 void enable_basic_uboot_clocks(void);
+
+#ifdef CONFIG_USB_DWC3
+void enable_usb_clocks(int index);
+void disable_usb_clocks(int index);
+#endif
+
 void scale_vcores(struct vcores_data const *);
 u32 get_offset_code(u32 volt_offset, struct pmic_data *pmic);
 void do_scale_vcore(u32 vcore_reg, u32 volt_mv, struct pmic_data *pmic);
-- 
1.7.9.5

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to