xref: /OK3568_Linux_fs/u-boot/arch/arm/mach-sunxi/usb_phy.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Sunxi usb-phy code
3*4882a593Smuzhiyun  *
4*4882a593Smuzhiyun  * Copyright (C) 2015 Hans de Goede <hdegoede@redhat.com>
5*4882a593Smuzhiyun  * Copyright (C) 2014 Roman Byshko <rbyshko@gmail.com>
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Based on code from
8*4882a593Smuzhiyun  * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
9*4882a593Smuzhiyun  *
10*4882a593Smuzhiyun  * SPDX-License-Identifier:	GPL-2.0+
11*4882a593Smuzhiyun  */
12*4882a593Smuzhiyun 
13*4882a593Smuzhiyun #include <common.h>
14*4882a593Smuzhiyun #include <asm/arch/clock.h>
15*4882a593Smuzhiyun #include <asm/arch/cpu.h>
16*4882a593Smuzhiyun #include <asm/arch/usb_phy.h>
17*4882a593Smuzhiyun #include <asm/gpio.h>
18*4882a593Smuzhiyun #include <asm/io.h>
19*4882a593Smuzhiyun #include <errno.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun #define SUNXI_USB_PMU_IRQ_ENABLE	0x800
22*4882a593Smuzhiyun #ifdef CONFIG_MACH_SUN8I_A33
23*4882a593Smuzhiyun #define SUNXI_USB_CSR			0x410
24*4882a593Smuzhiyun #else
25*4882a593Smuzhiyun #define SUNXI_USB_CSR			0x404
26*4882a593Smuzhiyun #endif
27*4882a593Smuzhiyun #define SUNXI_USB_PASSBY_EN		1
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun #define SUNXI_EHCI_AHB_ICHR8_EN		(1 << 10)
30*4882a593Smuzhiyun #define SUNXI_EHCI_AHB_INCR4_BURST_EN	(1 << 9)
31*4882a593Smuzhiyun #define SUNXI_EHCI_AHB_INCRX_ALIGN_EN	(1 << 8)
32*4882a593Smuzhiyun #define SUNXI_EHCI_ULPI_BYPASS_EN	(1 << 0)
33*4882a593Smuzhiyun 
34*4882a593Smuzhiyun #define REG_PHY_UNK_H3			0x420
35*4882a593Smuzhiyun #define REG_PMU_UNK_H3			0x810
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun /* A83T specific control bits for PHY0 */
38*4882a593Smuzhiyun #define SUNXI_PHY_CTL_VBUSVLDEXT	BIT(5)
39*4882a593Smuzhiyun #define SUNXI_PHY_CTL_SIDDQ		BIT(3)
40*4882a593Smuzhiyun 
41*4882a593Smuzhiyun /* A83T HSIC specific bits */
42*4882a593Smuzhiyun #define SUNXI_EHCI_HS_FORCE		BIT(20)
43*4882a593Smuzhiyun #define SUNXI_EHCI_CONNECT_DET		BIT(17)
44*4882a593Smuzhiyun #define SUNXI_EHCI_CONNECT_INT		BIT(16)
45*4882a593Smuzhiyun #define SUNXI_EHCI_HSIC			BIT(1)
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun static struct sunxi_usb_phy {
48*4882a593Smuzhiyun 	int usb_rst_mask;
49*4882a593Smuzhiyun 	int gpio_vbus;
50*4882a593Smuzhiyun 	int gpio_vbus_det;
51*4882a593Smuzhiyun 	int gpio_id_det;
52*4882a593Smuzhiyun 	int id;
53*4882a593Smuzhiyun 	int init_count;
54*4882a593Smuzhiyun 	int power_on_count;
55*4882a593Smuzhiyun 	ulong base;
56*4882a593Smuzhiyun } sunxi_usb_phy[] = {
57*4882a593Smuzhiyun 	{
58*4882a593Smuzhiyun 		.usb_rst_mask = CCM_USB_CTRL_PHY0_RST | CCM_USB_CTRL_PHY0_CLK,
59*4882a593Smuzhiyun 		.id = 0,
60*4882a593Smuzhiyun 		.base = SUNXI_USB0_BASE,
61*4882a593Smuzhiyun 	},
62*4882a593Smuzhiyun 	{
63*4882a593Smuzhiyun 		.usb_rst_mask = CCM_USB_CTRL_PHY1_RST | CCM_USB_CTRL_PHY1_CLK,
64*4882a593Smuzhiyun 		.id = 1,
65*4882a593Smuzhiyun 		.base = SUNXI_USB1_BASE,
66*4882a593Smuzhiyun 	},
67*4882a593Smuzhiyun #if CONFIG_SUNXI_USB_PHYS >= 3
68*4882a593Smuzhiyun 	{
69*4882a593Smuzhiyun #ifdef CONFIG_MACH_SUN8I_A83T
70*4882a593Smuzhiyun 		.usb_rst_mask = CCM_USB_CTRL_HSIC_RST | CCM_USB_CTRL_HSIC_CLK |
71*4882a593Smuzhiyun 				CCM_USB_CTRL_12M_CLK,
72*4882a593Smuzhiyun #else
73*4882a593Smuzhiyun 		.usb_rst_mask = CCM_USB_CTRL_PHY2_RST | CCM_USB_CTRL_PHY2_CLK,
74*4882a593Smuzhiyun #endif
75*4882a593Smuzhiyun 		.id = 2,
76*4882a593Smuzhiyun 		.base = SUNXI_USB2_BASE,
77*4882a593Smuzhiyun 	},
78*4882a593Smuzhiyun #endif
79*4882a593Smuzhiyun #if CONFIG_SUNXI_USB_PHYS >= 4
80*4882a593Smuzhiyun 	{
81*4882a593Smuzhiyun 		.usb_rst_mask = CCM_USB_CTRL_PHY3_RST | CCM_USB_CTRL_PHY3_CLK,
82*4882a593Smuzhiyun 		.id = 3,
83*4882a593Smuzhiyun 		.base = SUNXI_USB3_BASE,
84*4882a593Smuzhiyun 	}
85*4882a593Smuzhiyun #endif
86*4882a593Smuzhiyun };
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun static int initial_usb_scan_delay = CONFIG_INITIAL_USB_SCAN_DELAY;
89*4882a593Smuzhiyun 
get_vbus_gpio(int index)90*4882a593Smuzhiyun static int get_vbus_gpio(int index)
91*4882a593Smuzhiyun {
92*4882a593Smuzhiyun 	switch (index) {
93*4882a593Smuzhiyun 	case 0: return sunxi_name_to_gpio(CONFIG_USB0_VBUS_PIN);
94*4882a593Smuzhiyun 	case 1: return sunxi_name_to_gpio(CONFIG_USB1_VBUS_PIN);
95*4882a593Smuzhiyun 	case 2: return sunxi_name_to_gpio(CONFIG_USB2_VBUS_PIN);
96*4882a593Smuzhiyun 	case 3: return sunxi_name_to_gpio(CONFIG_USB3_VBUS_PIN);
97*4882a593Smuzhiyun 	}
98*4882a593Smuzhiyun 	return -EINVAL;
99*4882a593Smuzhiyun }
100*4882a593Smuzhiyun 
get_vbus_detect_gpio(int index)101*4882a593Smuzhiyun static int get_vbus_detect_gpio(int index)
102*4882a593Smuzhiyun {
103*4882a593Smuzhiyun 	switch (index) {
104*4882a593Smuzhiyun 	case 0: return sunxi_name_to_gpio(CONFIG_USB0_VBUS_DET);
105*4882a593Smuzhiyun 	}
106*4882a593Smuzhiyun 	return -EINVAL;
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun 
get_id_detect_gpio(int index)109*4882a593Smuzhiyun static int get_id_detect_gpio(int index)
110*4882a593Smuzhiyun {
111*4882a593Smuzhiyun 	switch (index) {
112*4882a593Smuzhiyun 	case 0: return sunxi_name_to_gpio(CONFIG_USB0_ID_DET);
113*4882a593Smuzhiyun 	}
114*4882a593Smuzhiyun 	return -EINVAL;
115*4882a593Smuzhiyun }
116*4882a593Smuzhiyun 
usb_phy_write(struct sunxi_usb_phy * phy,int addr,int data,int len)117*4882a593Smuzhiyun __maybe_unused static void usb_phy_write(struct sunxi_usb_phy *phy, int addr,
118*4882a593Smuzhiyun 					 int data, int len)
119*4882a593Smuzhiyun {
120*4882a593Smuzhiyun 	int j = 0, usbc_bit = 0;
121*4882a593Smuzhiyun 	void *dest = (void *)SUNXI_USB0_BASE + SUNXI_USB_CSR;
122*4882a593Smuzhiyun 
123*4882a593Smuzhiyun #ifdef CONFIG_MACH_SUN8I_A33
124*4882a593Smuzhiyun 	/* CSR needs to be explicitly initialized to 0 on A33 */
125*4882a593Smuzhiyun 	writel(0, dest);
126*4882a593Smuzhiyun #endif
127*4882a593Smuzhiyun 
128*4882a593Smuzhiyun 	usbc_bit = 1 << (phy->id * 2);
129*4882a593Smuzhiyun 	for (j = 0; j < len; j++) {
130*4882a593Smuzhiyun 		/* set the bit address to be written */
131*4882a593Smuzhiyun 		clrbits_le32(dest, 0xff << 8);
132*4882a593Smuzhiyun 		setbits_le32(dest, (addr + j) << 8);
133*4882a593Smuzhiyun 
134*4882a593Smuzhiyun 		clrbits_le32(dest, usbc_bit);
135*4882a593Smuzhiyun 		/* set data bit */
136*4882a593Smuzhiyun 		if (data & 0x1)
137*4882a593Smuzhiyun 			setbits_le32(dest, 1 << 7);
138*4882a593Smuzhiyun 		else
139*4882a593Smuzhiyun 			clrbits_le32(dest, 1 << 7);
140*4882a593Smuzhiyun 
141*4882a593Smuzhiyun 		setbits_le32(dest, usbc_bit);
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 		clrbits_le32(dest, usbc_bit);
144*4882a593Smuzhiyun 
145*4882a593Smuzhiyun 		data >>= 1;
146*4882a593Smuzhiyun 	}
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun 
149*4882a593Smuzhiyun #if defined(CONFIG_MACH_SUNXI_H3_H5) || defined(CONFIG_MACH_SUN50I)
sunxi_usb_phy_config(struct sunxi_usb_phy * phy)150*4882a593Smuzhiyun static void sunxi_usb_phy_config(struct sunxi_usb_phy *phy)
151*4882a593Smuzhiyun {
152*4882a593Smuzhiyun #if defined CONFIG_MACH_SUNXI_H3_H5
153*4882a593Smuzhiyun 	if (phy->id == 0)
154*4882a593Smuzhiyun 		clrbits_le32(SUNXI_USBPHY_BASE + REG_PHY_UNK_H3, 0x01);
155*4882a593Smuzhiyun #endif
156*4882a593Smuzhiyun 	clrbits_le32(phy->base + REG_PMU_UNK_H3, 0x02);
157*4882a593Smuzhiyun }
158*4882a593Smuzhiyun #elif defined CONFIG_MACH_SUN8I_A83T
sunxi_usb_phy_config(struct sunxi_usb_phy * phy)159*4882a593Smuzhiyun static void sunxi_usb_phy_config(struct sunxi_usb_phy *phy)
160*4882a593Smuzhiyun {
161*4882a593Smuzhiyun }
162*4882a593Smuzhiyun #else
sunxi_usb_phy_config(struct sunxi_usb_phy * phy)163*4882a593Smuzhiyun static void sunxi_usb_phy_config(struct sunxi_usb_phy *phy)
164*4882a593Smuzhiyun {
165*4882a593Smuzhiyun 	/* The following comments are machine
166*4882a593Smuzhiyun 	 * translated from Chinese, you have been warned!
167*4882a593Smuzhiyun 	 */
168*4882a593Smuzhiyun 
169*4882a593Smuzhiyun 	/* Regulation 45 ohms */
170*4882a593Smuzhiyun 	if (phy->id == 0)
171*4882a593Smuzhiyun 		usb_phy_write(phy, 0x0c, 0x01, 1);
172*4882a593Smuzhiyun 
173*4882a593Smuzhiyun 	/* adjust PHY's magnitude and rate */
174*4882a593Smuzhiyun 	usb_phy_write(phy, 0x20, 0x14, 5);
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun 	/* threshold adjustment disconnect */
177*4882a593Smuzhiyun #if defined CONFIG_MACH_SUN5I || defined CONFIG_MACH_SUN7I
178*4882a593Smuzhiyun 	usb_phy_write(phy, 0x2a, 2, 2);
179*4882a593Smuzhiyun #else
180*4882a593Smuzhiyun 	usb_phy_write(phy, 0x2a, 3, 2);
181*4882a593Smuzhiyun #endif
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	return;
184*4882a593Smuzhiyun }
185*4882a593Smuzhiyun #endif
186*4882a593Smuzhiyun 
sunxi_usb_phy_passby(struct sunxi_usb_phy * phy,int enable)187*4882a593Smuzhiyun static void sunxi_usb_phy_passby(struct sunxi_usb_phy *phy, int enable)
188*4882a593Smuzhiyun {
189*4882a593Smuzhiyun 	unsigned long bits = 0;
190*4882a593Smuzhiyun 	void *addr;
191*4882a593Smuzhiyun 
192*4882a593Smuzhiyun 	addr = (void *)phy->base + SUNXI_USB_PMU_IRQ_ENABLE;
193*4882a593Smuzhiyun 
194*4882a593Smuzhiyun 	bits = SUNXI_EHCI_AHB_ICHR8_EN |
195*4882a593Smuzhiyun 		SUNXI_EHCI_AHB_INCR4_BURST_EN |
196*4882a593Smuzhiyun 		SUNXI_EHCI_AHB_INCRX_ALIGN_EN |
197*4882a593Smuzhiyun 		SUNXI_EHCI_ULPI_BYPASS_EN;
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun #ifdef CONFIG_MACH_SUN8I_A83T
200*4882a593Smuzhiyun 	if (phy->id == 2)
201*4882a593Smuzhiyun 		bits |= SUNXI_EHCI_HS_FORCE |
202*4882a593Smuzhiyun 			SUNXI_EHCI_CONNECT_INT |
203*4882a593Smuzhiyun 			SUNXI_EHCI_HSIC;
204*4882a593Smuzhiyun #endif
205*4882a593Smuzhiyun 
206*4882a593Smuzhiyun 	if (enable)
207*4882a593Smuzhiyun 		setbits_le32(addr, bits);
208*4882a593Smuzhiyun 	else
209*4882a593Smuzhiyun 		clrbits_le32(addr, bits);
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	return;
212*4882a593Smuzhiyun }
213*4882a593Smuzhiyun 
sunxi_usb_phy_enable_squelch_detect(int index,int enable)214*4882a593Smuzhiyun void sunxi_usb_phy_enable_squelch_detect(int index, int enable)
215*4882a593Smuzhiyun {
216*4882a593Smuzhiyun #ifndef CONFIG_MACH_SUN8I_A83T
217*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 	usb_phy_write(phy, 0x3c, enable ? 0 : 2, 2);
220*4882a593Smuzhiyun #endif
221*4882a593Smuzhiyun }
222*4882a593Smuzhiyun 
sunxi_usb_phy_init(int index)223*4882a593Smuzhiyun void sunxi_usb_phy_init(int index)
224*4882a593Smuzhiyun {
225*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
226*4882a593Smuzhiyun 	struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	phy->init_count++;
229*4882a593Smuzhiyun 	if (phy->init_count != 1)
230*4882a593Smuzhiyun 		return;
231*4882a593Smuzhiyun 
232*4882a593Smuzhiyun 	setbits_le32(&ccm->usb_clk_cfg, phy->usb_rst_mask);
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	sunxi_usb_phy_config(phy);
235*4882a593Smuzhiyun 
236*4882a593Smuzhiyun 	if (phy->id != 0)
237*4882a593Smuzhiyun 		sunxi_usb_phy_passby(phy, SUNXI_USB_PASSBY_EN);
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun #ifdef CONFIG_MACH_SUN8I_A83T
240*4882a593Smuzhiyun 	if (phy->id == 0) {
241*4882a593Smuzhiyun 		setbits_le32(SUNXI_USB0_BASE + SUNXI_USB_CSR,
242*4882a593Smuzhiyun 			     SUNXI_PHY_CTL_VBUSVLDEXT);
243*4882a593Smuzhiyun 		clrbits_le32(SUNXI_USB0_BASE + SUNXI_USB_CSR,
244*4882a593Smuzhiyun 			     SUNXI_PHY_CTL_SIDDQ);
245*4882a593Smuzhiyun 	}
246*4882a593Smuzhiyun #endif
247*4882a593Smuzhiyun }
248*4882a593Smuzhiyun 
sunxi_usb_phy_exit(int index)249*4882a593Smuzhiyun void sunxi_usb_phy_exit(int index)
250*4882a593Smuzhiyun {
251*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
252*4882a593Smuzhiyun 	struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	phy->init_count--;
255*4882a593Smuzhiyun 	if (phy->init_count != 0)
256*4882a593Smuzhiyun 		return;
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun 	if (phy->id != 0)
259*4882a593Smuzhiyun 		sunxi_usb_phy_passby(phy, !SUNXI_USB_PASSBY_EN);
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun #ifdef CONFIG_MACH_SUN8I_A83T
262*4882a593Smuzhiyun 	if (phy->id == 0) {
263*4882a593Smuzhiyun 		setbits_le32(SUNXI_USB0_BASE + SUNXI_USB_CSR,
264*4882a593Smuzhiyun 			     SUNXI_PHY_CTL_SIDDQ);
265*4882a593Smuzhiyun 	}
266*4882a593Smuzhiyun #endif
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun 	clrbits_le32(&ccm->usb_clk_cfg, phy->usb_rst_mask);
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun 
sunxi_usb_phy_power_on(int index)271*4882a593Smuzhiyun void sunxi_usb_phy_power_on(int index)
272*4882a593Smuzhiyun {
273*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
274*4882a593Smuzhiyun 
275*4882a593Smuzhiyun 	if (initial_usb_scan_delay) {
276*4882a593Smuzhiyun 		mdelay(initial_usb_scan_delay);
277*4882a593Smuzhiyun 		initial_usb_scan_delay = 0;
278*4882a593Smuzhiyun 	}
279*4882a593Smuzhiyun 
280*4882a593Smuzhiyun 	phy->power_on_count++;
281*4882a593Smuzhiyun 	if (phy->power_on_count != 1)
282*4882a593Smuzhiyun 		return;
283*4882a593Smuzhiyun 
284*4882a593Smuzhiyun 	if (phy->gpio_vbus >= 0)
285*4882a593Smuzhiyun 		gpio_set_value(phy->gpio_vbus, 1);
286*4882a593Smuzhiyun }
287*4882a593Smuzhiyun 
sunxi_usb_phy_power_off(int index)288*4882a593Smuzhiyun void sunxi_usb_phy_power_off(int index)
289*4882a593Smuzhiyun {
290*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
291*4882a593Smuzhiyun 
292*4882a593Smuzhiyun 	phy->power_on_count--;
293*4882a593Smuzhiyun 	if (phy->power_on_count != 0)
294*4882a593Smuzhiyun 		return;
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	if (phy->gpio_vbus >= 0)
297*4882a593Smuzhiyun 		gpio_set_value(phy->gpio_vbus, 0);
298*4882a593Smuzhiyun }
299*4882a593Smuzhiyun 
sunxi_usb_phy_vbus_detect(int index)300*4882a593Smuzhiyun int sunxi_usb_phy_vbus_detect(int index)
301*4882a593Smuzhiyun {
302*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
303*4882a593Smuzhiyun 	int err, retries = 3;
304*4882a593Smuzhiyun 
305*4882a593Smuzhiyun 	if (phy->gpio_vbus_det < 0)
306*4882a593Smuzhiyun 		return phy->gpio_vbus_det;
307*4882a593Smuzhiyun 
308*4882a593Smuzhiyun 	err = gpio_get_value(phy->gpio_vbus_det);
309*4882a593Smuzhiyun 	/*
310*4882a593Smuzhiyun 	 * Vbus may have been provided by the board and just been turned of
311*4882a593Smuzhiyun 	 * some milliseconds ago on reset, what we're measuring then is a
312*4882a593Smuzhiyun 	 * residual charge on Vbus, sleep a bit and try again.
313*4882a593Smuzhiyun 	 */
314*4882a593Smuzhiyun 	while (err > 0 && retries--) {
315*4882a593Smuzhiyun 		mdelay(100);
316*4882a593Smuzhiyun 		err = gpio_get_value(phy->gpio_vbus_det);
317*4882a593Smuzhiyun 	}
318*4882a593Smuzhiyun 
319*4882a593Smuzhiyun 	return err;
320*4882a593Smuzhiyun }
321*4882a593Smuzhiyun 
sunxi_usb_phy_id_detect(int index)322*4882a593Smuzhiyun int sunxi_usb_phy_id_detect(int index)
323*4882a593Smuzhiyun {
324*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy = &sunxi_usb_phy[index];
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 	if (phy->gpio_id_det < 0)
327*4882a593Smuzhiyun 		return phy->gpio_id_det;
328*4882a593Smuzhiyun 
329*4882a593Smuzhiyun 	return gpio_get_value(phy->gpio_id_det);
330*4882a593Smuzhiyun }
331*4882a593Smuzhiyun 
sunxi_usb_phy_probe(void)332*4882a593Smuzhiyun int sunxi_usb_phy_probe(void)
333*4882a593Smuzhiyun {
334*4882a593Smuzhiyun 	struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
335*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy;
336*4882a593Smuzhiyun 	int i, ret = 0;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	for (i = 0; i < CONFIG_SUNXI_USB_PHYS; i++) {
339*4882a593Smuzhiyun 		phy = &sunxi_usb_phy[i];
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 		phy->gpio_vbus = get_vbus_gpio(i);
342*4882a593Smuzhiyun 		if (phy->gpio_vbus >= 0) {
343*4882a593Smuzhiyun 			ret = gpio_request(phy->gpio_vbus, "usb_vbus");
344*4882a593Smuzhiyun 			if (ret)
345*4882a593Smuzhiyun 				return ret;
346*4882a593Smuzhiyun 			ret = gpio_direction_output(phy->gpio_vbus, 0);
347*4882a593Smuzhiyun 			if (ret)
348*4882a593Smuzhiyun 				return ret;
349*4882a593Smuzhiyun 		}
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun 		phy->gpio_vbus_det = get_vbus_detect_gpio(i);
352*4882a593Smuzhiyun 		if (phy->gpio_vbus_det >= 0) {
353*4882a593Smuzhiyun 			ret = gpio_request(phy->gpio_vbus_det, "usb_vbus_det");
354*4882a593Smuzhiyun 			if (ret)
355*4882a593Smuzhiyun 				return ret;
356*4882a593Smuzhiyun 			ret = gpio_direction_input(phy->gpio_vbus_det);
357*4882a593Smuzhiyun 			if (ret)
358*4882a593Smuzhiyun 				return ret;
359*4882a593Smuzhiyun 		}
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 		phy->gpio_id_det = get_id_detect_gpio(i);
362*4882a593Smuzhiyun 		if (phy->gpio_id_det >= 0) {
363*4882a593Smuzhiyun 			ret = gpio_request(phy->gpio_id_det, "usb_id_det");
364*4882a593Smuzhiyun 			if (ret)
365*4882a593Smuzhiyun 				return ret;
366*4882a593Smuzhiyun 			ret = gpio_direction_input(phy->gpio_id_det);
367*4882a593Smuzhiyun 			if (ret)
368*4882a593Smuzhiyun 				return ret;
369*4882a593Smuzhiyun 			sunxi_gpio_set_pull(phy->gpio_id_det,
370*4882a593Smuzhiyun 					    SUNXI_GPIO_PULL_UP);
371*4882a593Smuzhiyun 		}
372*4882a593Smuzhiyun 	}
373*4882a593Smuzhiyun 
374*4882a593Smuzhiyun 	setbits_le32(&ccm->usb_clk_cfg, CCM_USB_CTRL_PHYGATE);
375*4882a593Smuzhiyun 
376*4882a593Smuzhiyun 	return 0;
377*4882a593Smuzhiyun }
378*4882a593Smuzhiyun 
sunxi_usb_phy_remove(void)379*4882a593Smuzhiyun int sunxi_usb_phy_remove(void)
380*4882a593Smuzhiyun {
381*4882a593Smuzhiyun 	struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
382*4882a593Smuzhiyun 	struct sunxi_usb_phy *phy;
383*4882a593Smuzhiyun 	int i;
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	clrbits_le32(&ccm->usb_clk_cfg, CCM_USB_CTRL_PHYGATE);
386*4882a593Smuzhiyun 
387*4882a593Smuzhiyun 	for (i = 0; i < CONFIG_SUNXI_USB_PHYS; i++) {
388*4882a593Smuzhiyun 		phy = &sunxi_usb_phy[i];
389*4882a593Smuzhiyun 
390*4882a593Smuzhiyun 		if (phy->gpio_vbus >= 0)
391*4882a593Smuzhiyun 			gpio_free(phy->gpio_vbus);
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun 		if (phy->gpio_vbus_det >= 0)
394*4882a593Smuzhiyun 			gpio_free(phy->gpio_vbus_det);
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 		if (phy->gpio_id_det >= 0)
397*4882a593Smuzhiyun 			gpio_free(phy->gpio_id_det);
398*4882a593Smuzhiyun 	}
399*4882a593Smuzhiyun 
400*4882a593Smuzhiyun 	return 0;
401*4882a593Smuzhiyun }
402