ARM: AM43xx: Add functions to enable and disable USB clocks

Added functions to enable and disable USB clocks which can be invoked during USB init and USB exit respectively. Cc: Roger Quadros <rogerq@ti.com> Cc: Tero Kristo <t-kristo@ti.com> Cc: Nishanth Menon <nm@ti.com> Signed-off-by: Kishon Vijay Abraham I <kishon@ti.com>

ARM: AM43xx: Add functions to enable and disable USB clocks
Added functions to enable and disable USB clocks which can be invoked during USB init and USB exit respectively. Cc: Roger Quadros <rogerq@ti.com> Cc: Tero Kristo <t-kristo@ti.com> Cc: Nishanth Menon <nm@ti.com> Signed-off-by: Kishon Vijay Abraham I <kishon@ti.com>
Kishon Vijay Abraham I · Lokesh Vutla
1 parent f6a20e64be
Showing 2 changed files with 75 additions and 0 deletions Side-by-side Diff
arch/arm/cpu/armv7/am33xx/clock_am43xx.c
arch/arm/include/asm/arch-am33xx/sys_proto.h
@@ -191,4 +191,74 @@
 			  1);
 }
 #endif
+
+#ifdef CONFIG_USB_DWC3
+void enable_usb_clocks(int index)
+{
+	u32 *usbclkctrl = 0;
+	u32 *usbphyocp2scpclkctrl = 0;
+
+	if (index == 0) {
+		usbclkctrl = &cmper->usb0clkctrl;
+		usbphyocp2scpclkctrl = &cmper->usbphyocp2scp0clkctrl;
+		setbits_le32(&cmper->usb0clkctrl,
+			     USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
+		setbits_le32(&cmwkup->usbphy0clkctrl,
+			     USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
+	} else if (index == 1) {
+		usbclkctrl = &cmper->usb1clkctrl;
+		usbphyocp2scpclkctrl = &cmper->usbphyocp2scp1clkctrl;
+		setbits_le32(&cmper->usb1clkctrl,
+			     USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
+		setbits_le32(&cmwkup->usbphy1clkctrl,
+			     USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
+	}
+
+	u32 *const clk_domains_usb[] = {
+		0
+	};
+
+	u32 *const clk_modules_explicit_en_usb[] = {
+		usbclkctrl,
+		usbphyocp2scpclkctrl,
+		0
+	};
+
+	do_enable_clocks(clk_domains_usb, clk_modules_explicit_en_usb, 1);
+}
+
+void disable_usb_clocks(int index)
+{
+	u32 *usbclkctrl = 0;
+	u32 *usbphyocp2scpclkctrl = 0;
+
+	if (index == 0) {
+		usbclkctrl = &cmper->usb0clkctrl;
+		usbphyocp2scpclkctrl = &cmper->usbphyocp2scp0clkctrl;
+		clrbits_le32(&cmper->usb0clkctrl,
+			     USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
+		clrbits_le32(&cmwkup->usbphy0clkctrl,
+			     USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
+	} else if (index == 1) {
+		usbclkctrl = &cmper->usb1clkctrl;
+		usbphyocp2scpclkctrl = &cmper->usbphyocp2scp1clkctrl;
+		clrbits_le32(&cmper->usb1clkctrl,
+			     USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
+		clrbits_le32(&cmwkup->usbphy1clkctrl,
+			     USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
+	}
+
+	u32 *const clk_domains_usb[] = {
+		0
+	};
+
+	u32 *const clk_modules_disable_usb[] = {
+		usbclkctrl,
+		usbphyocp2scpclkctrl,
+		0
+	};
+
+	do_disable_clocks(clk_domains_usb, clk_modules_disable_usb, 1);
+}
+#endif
@@ -43,4 +43,9 @@
 int am335x_get_efuse_mpu_max_freq(struct ctrl_dev *cdev);
 int am335x_get_tps65910_mpu_vdd(int sil_rev, int frequency);
 #endif
+
+#ifdef CONFIG_USB_DWC3
+void enable_usb_clocks(int index);
+void disable_usb_clocks(int index);
+#endif
...	...	@@ -191,4 +191,74 @@
191	191	1);
192	192	}
193	193	#endif
	194	+
	195	+#ifdef CONFIG_USB_DWC3
	196	+void enable_usb_clocks(int index)
	197	+{
	198	+ u32 *usbclkctrl = 0;
	199	+ u32 *usbphyocp2scpclkctrl = 0;
	200	+
	201	+ if (index == 0) {
	202	+ usbclkctrl = &cmper->usb0clkctrl;
	203	+ usbphyocp2scpclkctrl = &cmper->usbphyocp2scp0clkctrl;
	204	+ setbits_le32(&cmper->usb0clkctrl,
	205	+ USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
	206	+ setbits_le32(&cmwkup->usbphy0clkctrl,
	207	+ USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
	208	+ } else if (index == 1) {
	209	+ usbclkctrl = &cmper->usb1clkctrl;
	210	+ usbphyocp2scpclkctrl = &cmper->usbphyocp2scp1clkctrl;
	211	+ setbits_le32(&cmper->usb1clkctrl,
	212	+ USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
	213	+ setbits_le32(&cmwkup->usbphy1clkctrl,
	214	+ USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
	215	+ }
	216	+
	217	+ u32 *const clk_domains_usb[] = {
	218	+ 0
	219	+ };
	220	+
	221	+ u32 *const clk_modules_explicit_en_usb[] = {
	222	+ usbclkctrl,
	223	+ usbphyocp2scpclkctrl,
	224	+ 0
	225	+ };
	226	+
	227	+ do_enable_clocks(clk_domains_usb, clk_modules_explicit_en_usb, 1);
	228	+}
	229	+
	230	+void disable_usb_clocks(int index)
	231	+{
	232	+ u32 *usbclkctrl = 0;
	233	+ u32 *usbphyocp2scpclkctrl = 0;
	234	+
	235	+ if (index == 0) {
	236	+ usbclkctrl = &cmper->usb0clkctrl;
	237	+ usbphyocp2scpclkctrl = &cmper->usbphyocp2scp0clkctrl;
	238	+ clrbits_le32(&cmper->usb0clkctrl,
	239	+ USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
	240	+ clrbits_le32(&cmwkup->usbphy0clkctrl,
	241	+ USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
	242	+ } else if (index == 1) {
	243	+ usbclkctrl = &cmper->usb1clkctrl;
	244	+ usbphyocp2scpclkctrl = &cmper->usbphyocp2scp1clkctrl;
	245	+ clrbits_le32(&cmper->usb1clkctrl,
	246	+ USBOTGSSX_CLKCTRL_OPTFCLKEN_REFCLK960);
	247	+ clrbits_le32(&cmwkup->usbphy1clkctrl,
	248	+ USBPHY0_CLKCTRL_OPTFCLKEN_CLK32K);
	249	+ }
	250	+
	251	+ u32 *const clk_domains_usb[] = {
	252	+ 0
	253	+ };
	254	+
	255	+ u32 *const clk_modules_disable_usb[] = {
	256	+ usbclkctrl,
	257	+ usbphyocp2scpclkctrl,
	258	+ 0
	259	+ };
	260	+
	261	+ do_disable_clocks(clk_domains_usb, clk_modules_disable_usb, 1);
	262	+}
	263	+#endif
...	...	@@ -43,4 +43,9 @@
43	43	int am335x_get_efuse_mpu_max_freq(struct ctrl_dev *cdev);
44	44	int am335x_get_tps65910_mpu_vdd(int sil_rev, int frequency);
45	45	#endif
	46	+
	47	+#ifdef CONFIG_USB_DWC3
	48	+void enable_usb_clocks(int index);
	49	+void disable_usb_clocks(int index);
	50	+#endif