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