diff options
author | Vitaly Wool <vwool@ru.mvista.com> | 2006-06-29 10:28:18 -0400 |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@suse.de> | 2006-09-27 14:58:48 -0400 |
commit | 60bbfc84b6d916f5a10127762d0dcb3f4726450d (patch) | |
tree | d8ed7d510398056ad40911e67aa656408af75236 | |
parent | b2a8e097d0f3bbb7ef550103022db92fc3832842 (diff) |
USB OHCI controller support for PNX4008
inlined is the patch that adds basic support for USB OHCI controller
support for PNX4008 Philips PNX4008 ARM board. Due to HW design, it
depends on I2C driver for PNX4008 which I've recetnly posted to LKML and
i2c at lm-sensors.
Signed-off-by: Vitaly Wool <vitalywool@gmail.com>
Cc: David Brownell <david-b@pacbell.net>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
-rw-r--r-- | drivers/usb/Kconfig | 1 | ||||
-rw-r--r-- | drivers/usb/host/Kconfig | 2 | ||||
-rw-r--r-- | drivers/usb/host/ohci-hcd.c | 5 | ||||
-rw-r--r-- | drivers/usb/host/ohci-pnx4008.c | 476 |
4 files changed, 484 insertions, 0 deletions
diff --git a/drivers/usb/Kconfig b/drivers/usb/Kconfig index 005043197527..f9b1719b9a37 100644 --- a/drivers/usb/Kconfig +++ b/drivers/usb/Kconfig | |||
@@ -25,6 +25,7 @@ config USB_ARCH_HAS_OHCI | |||
25 | default y if PXA27x | 25 | default y if PXA27x |
26 | default y if ARCH_EP93XX | 26 | default y if ARCH_EP93XX |
27 | default y if (ARCH_AT91RM9200 || ARCH_AT91SAM9261) | 27 | default y if (ARCH_AT91RM9200 || ARCH_AT91SAM9261) |
28 | default y if ARCH_PNX4008 | ||
28 | # PPC: | 29 | # PPC: |
29 | default y if STB03xxx | 30 | default y if STB03xxx |
30 | default y if PPC_MPC52xx | 31 | default y if PPC_MPC52xx |
diff --git a/drivers/usb/host/Kconfig b/drivers/usb/host/Kconfig index b93d71d28db7..77ba2b0bf0b7 100644 --- a/drivers/usb/host/Kconfig +++ b/drivers/usb/host/Kconfig | |||
@@ -83,6 +83,8 @@ config USB_OHCI_HCD | |||
83 | tristate "OHCI HCD support" | 83 | tristate "OHCI HCD support" |
84 | depends on USB && USB_ARCH_HAS_OHCI | 84 | depends on USB && USB_ARCH_HAS_OHCI |
85 | select ISP1301_OMAP if MACH_OMAP_H2 || MACH_OMAP_H3 | 85 | select ISP1301_OMAP if MACH_OMAP_H2 || MACH_OMAP_H3 |
86 | select I2C if ARCH_PNX4008 | ||
87 | select I2C_PNX if ARCH_PNX4008 | ||
86 | ---help--- | 88 | ---help--- |
87 | The Open Host Controller Interface (OHCI) is a standard for accessing | 89 | The Open Host Controller Interface (OHCI) is a standard for accessing |
88 | USB 1.1 host controller hardware. It does more in hardware than Intel's | 90 | USB 1.1 host controller hardware. It does more in hardware than Intel's |
diff --git a/drivers/usb/host/ohci-hcd.c b/drivers/usb/host/ohci-hcd.c index 0684f57c14a0..cbf38ae5ae76 100644 --- a/drivers/usb/host/ohci-hcd.c +++ b/drivers/usb/host/ohci-hcd.c | |||
@@ -940,6 +940,10 @@ MODULE_LICENSE ("GPL"); | |||
940 | #include "ohci-at91.c" | 940 | #include "ohci-at91.c" |
941 | #endif | 941 | #endif |
942 | 942 | ||
943 | #ifdef CONFIG_ARCH_PNX4008 | ||
944 | #include "ohci-pnx4008.c" | ||
945 | #endif | ||
946 | |||
943 | #if !(defined(CONFIG_PCI) \ | 947 | #if !(defined(CONFIG_PCI) \ |
944 | || defined(CONFIG_SA1111) \ | 948 | || defined(CONFIG_SA1111) \ |
945 | || defined(CONFIG_ARCH_S3C2410) \ | 949 | || defined(CONFIG_ARCH_S3C2410) \ |
@@ -951,6 +955,7 @@ MODULE_LICENSE ("GPL"); | |||
951 | || defined (CONFIG_USB_OHCI_HCD_PPC_SOC) \ | 955 | || defined (CONFIG_USB_OHCI_HCD_PPC_SOC) \ |
952 | || defined (CONFIG_ARCH_AT91RM9200) \ | 956 | || defined (CONFIG_ARCH_AT91RM9200) \ |
953 | || defined (CONFIG_ARCH_AT91SAM9261) \ | 957 | || defined (CONFIG_ARCH_AT91SAM9261) \ |
958 | || defined (CONFIG_ARCH_PNX4008) \ | ||
954 | ) | 959 | ) |
955 | #error "missing bus glue for ohci-hcd" | 960 | #error "missing bus glue for ohci-hcd" |
956 | #endif | 961 | #endif |
diff --git a/drivers/usb/host/ohci-pnx4008.c b/drivers/usb/host/ohci-pnx4008.c new file mode 100644 index 000000000000..82cb22f002e7 --- /dev/null +++ b/drivers/usb/host/ohci-pnx4008.c | |||
@@ -0,0 +1,476 @@ | |||
1 | /* | ||
2 | * drivers/usb/host/ohci-pnx4008.c | ||
3 | * | ||
4 | * driver for Philips PNX4008 USB Host | ||
5 | * | ||
6 | * Authors: Dmitry Chigirev <source@mvista.com> | ||
7 | * Vitaly Wool <vitalywool@gmail.com> | ||
8 | * | ||
9 | * register initialization is based on code examples provided by Philips | ||
10 | * Copyright (c) 2005 Koninklijke Philips Electronics N.V. | ||
11 | * | ||
12 | * NOTE: This driver does not have suspend/resume functionality | ||
13 | * This driver is intended for engineering development purposes only | ||
14 | * | ||
15 | * 2005-2006 (c) MontaVista Software, Inc. This file is licensed under | ||
16 | * the terms of the GNU General Public License version 2. This program | ||
17 | * is licensed "as is" without any warranty of any kind, whether express | ||
18 | * or implied. | ||
19 | */ | ||
20 | #include <linux/clk.h> | ||
21 | #include <linux/platform_device.h> | ||
22 | #include <linux/i2c.h> | ||
23 | |||
24 | #include <asm/hardware.h> | ||
25 | #include <asm/io.h> | ||
26 | #include <asm/mach-types.h> | ||
27 | |||
28 | #include <asm/arch/platform.h> | ||
29 | #include <asm/arch/irqs.h> | ||
30 | #include <asm/arch/gpio.h> | ||
31 | |||
32 | #define USB_CTRL IO_ADDRESS(PNX4008_PWRMAN_BASE + 0x64) | ||
33 | |||
34 | /* USB_CTRL bit defines */ | ||
35 | #define USB_SLAVE_HCLK_EN (1 << 24) | ||
36 | #define USB_HOST_NEED_CLK_EN (1 << 21) | ||
37 | |||
38 | #define USB_OTG_CLK_CTRL IO_ADDRESS(PNX4008_USB_CONFIG_BASE + 0xFF4) | ||
39 | #define USB_OTG_CLK_STAT IO_ADDRESS(PNX4008_USB_CONFIG_BASE + 0xFF8) | ||
40 | |||
41 | /* USB_OTG_CLK_CTRL bit defines */ | ||
42 | #define AHB_M_CLOCK_ON (1 << 4) | ||
43 | #define OTG_CLOCK_ON (1 << 3) | ||
44 | #define I2C_CLOCK_ON (1 << 2) | ||
45 | #define DEV_CLOCK_ON (1 << 1) | ||
46 | #define HOST_CLOCK_ON (1 << 0) | ||
47 | |||
48 | #define USB_OTG_STAT_CONTROL IO_ADDRESS(PNX4008_USB_CONFIG_BASE + 0x110) | ||
49 | |||
50 | /* USB_OTG_STAT_CONTROL bit defines */ | ||
51 | #define TRANSPARENT_I2C_EN (1 << 7) | ||
52 | #define HOST_EN (1 << 0) | ||
53 | |||
54 | /* ISP1301 USB transceiver I2C registers */ | ||
55 | #define ISP1301_MODE_CONTROL_1 0x04 /* u8 read, set, +1 clear */ | ||
56 | |||
57 | #define MC1_SPEED_REG (1 << 0) | ||
58 | #define MC1_SUSPEND_REG (1 << 1) | ||
59 | #define MC1_DAT_SE0 (1 << 2) | ||
60 | #define MC1_TRANSPARENT (1 << 3) | ||
61 | #define MC1_BDIS_ACON_EN (1 << 4) | ||
62 | #define MC1_OE_INT_EN (1 << 5) | ||
63 | #define MC1_UART_EN (1 << 6) | ||
64 | #define MC1_MASK 0x7f | ||
65 | |||
66 | #define ISP1301_MODE_CONTROL_2 0x12 /* u8 read, set, +1 clear */ | ||
67 | |||
68 | #define MC2_GLOBAL_PWR_DN (1 << 0) | ||
69 | #define MC2_SPD_SUSP_CTRL (1 << 1) | ||
70 | #define MC2_BI_DI (1 << 2) | ||
71 | #define MC2_TRANSP_BDIR0 (1 << 3) | ||
72 | #define MC2_TRANSP_BDIR1 (1 << 4) | ||
73 | #define MC2_AUDIO_EN (1 << 5) | ||
74 | #define MC2_PSW_EN (1 << 6) | ||
75 | #define MC2_EN2V7 (1 << 7) | ||
76 | |||
77 | #define ISP1301_OTG_CONTROL_1 0x06 /* u8 read, set, +1 clear */ | ||
78 | # define OTG1_DP_PULLUP (1 << 0) | ||
79 | # define OTG1_DM_PULLUP (1 << 1) | ||
80 | # define OTG1_DP_PULLDOWN (1 << 2) | ||
81 | # define OTG1_DM_PULLDOWN (1 << 3) | ||
82 | # define OTG1_ID_PULLDOWN (1 << 4) | ||
83 | # define OTG1_VBUS_DRV (1 << 5) | ||
84 | # define OTG1_VBUS_DISCHRG (1 << 6) | ||
85 | # define OTG1_VBUS_CHRG (1 << 7) | ||
86 | #define ISP1301_OTG_STATUS 0x10 /* u8 readonly */ | ||
87 | # define OTG_B_SESS_END (1 << 6) | ||
88 | # define OTG_B_SESS_VLD (1 << 7) | ||
89 | |||
90 | #define ISP1301_I2C_ADDR 0x2C | ||
91 | |||
92 | #define ISP1301_I2C_MODE_CONTROL_1 0x4 | ||
93 | #define ISP1301_I2C_MODE_CONTROL_2 0x12 | ||
94 | #define ISP1301_I2C_OTG_CONTROL_1 0x6 | ||
95 | #define ISP1301_I2C_OTG_CONTROL_2 0x10 | ||
96 | #define ISP1301_I2C_INTERRUPT_SOURCE 0x8 | ||
97 | #define ISP1301_I2C_INTERRUPT_LATCH 0xA | ||
98 | #define ISP1301_I2C_INTERRUPT_FALLING 0xC | ||
99 | #define ISP1301_I2C_INTERRUPT_RISING 0xE | ||
100 | #define ISP1301_I2C_REG_CLEAR_ADDR 1 | ||
101 | |||
102 | struct i2c_driver isp1301_driver; | ||
103 | struct i2c_client *isp1301_i2c_client; | ||
104 | |||
105 | extern int usb_disabled(void); | ||
106 | extern int ocpi_enable(void); | ||
107 | |||
108 | static struct clk *usb_clk; | ||
109 | |||
110 | static int isp1301_probe(struct i2c_adapter *adap); | ||
111 | static int isp1301_detach(struct i2c_client *client); | ||
112 | static int isp1301_command(struct i2c_client *client, unsigned int cmd, | ||
113 | void *arg); | ||
114 | |||
115 | static unsigned short normal_i2c[] = | ||
116 | { ISP1301_I2C_ADDR, ISP1301_I2C_ADDR + 1, I2C_CLIENT_END }; | ||
117 | static unsigned short dummy_i2c_addrlist[] = { I2C_CLIENT_END }; | ||
118 | |||
119 | static struct i2c_client_address_data addr_data = { | ||
120 | .normal_i2c = normal_i2c, | ||
121 | .probe = dummy_i2c_addrlist, | ||
122 | .ignore = dummy_i2c_addrlist, | ||
123 | }; | ||
124 | |||
125 | struct i2c_driver isp1301_driver = { | ||
126 | .id = I2C_DRIVERID_I2CDEV, /* Fake Id */ | ||
127 | .class = I2C_CLASS_HWMON, | ||
128 | .attach_adapter = isp1301_probe, | ||
129 | .detach_client = isp1301_detach, | ||
130 | .command = isp1301_command | ||
131 | }; | ||
132 | |||
133 | static int isp1301_attach(struct i2c_adapter *adap, int addr, int kind) | ||
134 | { | ||
135 | struct i2c_client *c; | ||
136 | |||
137 | c = (struct i2c_client *)kzalloc(sizeof(*c), SLAB_KERNEL); | ||
138 | |||
139 | if (!c) | ||
140 | return -ENOMEM; | ||
141 | |||
142 | strcpy(c->name, "isp1301"); | ||
143 | c->flags = 0; | ||
144 | c->addr = addr; | ||
145 | c->adapter = adap; | ||
146 | c->driver = &isp1301_driver; | ||
147 | |||
148 | isp1301_i2c_client = c; | ||
149 | |||
150 | return i2c_attach_client(c); | ||
151 | } | ||
152 | |||
153 | static int isp1301_probe(struct i2c_adapter *adap) | ||
154 | { | ||
155 | return i2c_probe(adap, &addr_data, isp1301_attach); | ||
156 | } | ||
157 | |||
158 | static int isp1301_detach(struct i2c_client *client) | ||
159 | { | ||
160 | i2c_detach_client(client); | ||
161 | kfree(isp1301_i2c_client); | ||
162 | return 0; | ||
163 | } | ||
164 | |||
165 | /* No commands defined */ | ||
166 | static int isp1301_command(struct i2c_client *client, unsigned int cmd, | ||
167 | void *arg) | ||
168 | { | ||
169 | return 0; | ||
170 | } | ||
171 | |||
172 | static void i2c_write(u8 buf, u8 subaddr) | ||
173 | { | ||
174 | char tmpbuf[2]; | ||
175 | |||
176 | tmpbuf[0] = subaddr; /*register number */ | ||
177 | tmpbuf[1] = buf; /*register data */ | ||
178 | i2c_master_send(isp1301_i2c_client, &tmpbuf[0], 2); | ||
179 | } | ||
180 | |||
181 | static void isp1301_configure(void) | ||
182 | { | ||
183 | /* PNX4008 only supports DAT_SE0 USB mode */ | ||
184 | /* PNX4008 R2A requires setting the MAX603 to output 3.6V */ | ||
185 | /* Power up externel charge-pump */ | ||
186 | |||
187 | i2c_write(MC1_DAT_SE0 | MC1_SPEED_REG, ISP1301_I2C_MODE_CONTROL_1); | ||
188 | i2c_write(~(MC1_DAT_SE0 | MC1_SPEED_REG), | ||
189 | ISP1301_I2C_MODE_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR); | ||
190 | i2c_write(MC2_BI_DI | MC2_PSW_EN | MC2_SPD_SUSP_CTRL, | ||
191 | ISP1301_I2C_MODE_CONTROL_2); | ||
192 | i2c_write(~(MC2_BI_DI | MC2_PSW_EN | MC2_SPD_SUSP_CTRL), | ||
193 | ISP1301_I2C_MODE_CONTROL_2 | ISP1301_I2C_REG_CLEAR_ADDR); | ||
194 | i2c_write(OTG1_DM_PULLDOWN | OTG1_DP_PULLDOWN, | ||
195 | ISP1301_I2C_OTG_CONTROL_1); | ||
196 | i2c_write(~(OTG1_DM_PULLDOWN | OTG1_DP_PULLDOWN), | ||
197 | ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR); | ||
198 | i2c_write(0xFF, | ||
199 | ISP1301_I2C_INTERRUPT_LATCH | ISP1301_I2C_REG_CLEAR_ADDR); | ||
200 | i2c_write(0xFF, | ||
201 | ISP1301_I2C_INTERRUPT_FALLING | ISP1301_I2C_REG_CLEAR_ADDR); | ||
202 | i2c_write(0xFF, | ||
203 | ISP1301_I2C_INTERRUPT_RISING | ISP1301_I2C_REG_CLEAR_ADDR); | ||
204 | |||
205 | } | ||
206 | |||
207 | static inline void isp1301_vbus_on(void) | ||
208 | { | ||
209 | i2c_write(OTG1_VBUS_DRV, ISP1301_I2C_OTG_CONTROL_1); | ||
210 | } | ||
211 | |||
212 | static inline void isp1301_vbus_off(void) | ||
213 | { | ||
214 | i2c_write(OTG1_VBUS_DRV, | ||
215 | ISP1301_I2C_OTG_CONTROL_1 | ISP1301_I2C_REG_CLEAR_ADDR); | ||
216 | } | ||
217 | |||
218 | static void pnx4008_start_hc(void) | ||
219 | { | ||
220 | unsigned long tmp = __raw_readl(USB_OTG_STAT_CONTROL) | HOST_EN; | ||
221 | __raw_writel(tmp, USB_OTG_STAT_CONTROL); | ||
222 | isp1301_vbus_on(); | ||
223 | } | ||
224 | |||
225 | static void pnx4008_stop_hc(void) | ||
226 | { | ||
227 | unsigned long tmp; | ||
228 | isp1301_vbus_off(); | ||
229 | tmp = __raw_readl(USB_OTG_STAT_CONTROL) & ~HOST_EN; | ||
230 | __raw_writel(tmp, USB_OTG_STAT_CONTROL); | ||
231 | } | ||
232 | |||
233 | static int __devinit ohci_pnx4008_start(struct usb_hcd *hcd) | ||
234 | { | ||
235 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | ||
236 | int ret; | ||
237 | |||
238 | if ((ret = ohci_init(ohci)) < 0) | ||
239 | return ret; | ||
240 | |||
241 | if ((ret = ohci_run(ohci)) < 0) { | ||
242 | dev_err(hcd->self.controller, "can't start\n"); | ||
243 | ohci_stop(hcd); | ||
244 | return ret; | ||
245 | } | ||
246 | return 0; | ||
247 | } | ||
248 | |||
249 | static const struct hc_driver ohci_pnx4008_hc_driver = { | ||
250 | .description = hcd_name, | ||
251 | .product_desc = "pnx4008 OHCI", | ||
252 | |||
253 | /* | ||
254 | * generic hardware linkage | ||
255 | */ | ||
256 | .irq = ohci_irq, | ||
257 | .flags = HCD_USB11 | HCD_MEMORY, | ||
258 | |||
259 | .hcd_priv_size = sizeof(struct ohci_hcd), | ||
260 | /* | ||
261 | * basic lifecycle operations | ||
262 | */ | ||
263 | .start = ohci_pnx4008_start, | ||
264 | .stop = ohci_stop, | ||
265 | |||
266 | /* | ||
267 | * managing i/o requests and associated device resources | ||
268 | */ | ||
269 | .urb_enqueue = ohci_urb_enqueue, | ||
270 | .urb_dequeue = ohci_urb_dequeue, | ||
271 | .endpoint_disable = ohci_endpoint_disable, | ||
272 | |||
273 | /* | ||
274 | * scheduling support | ||
275 | */ | ||
276 | .get_frame_number = ohci_get_frame, | ||
277 | |||
278 | /* | ||
279 | * root hub support | ||
280 | */ | ||
281 | .hub_status_data = ohci_hub_status_data, | ||
282 | .hub_control = ohci_hub_control, | ||
283 | |||
284 | .start_port_reset = ohci_start_port_reset, | ||
285 | }; | ||
286 | |||
287 | #define USB_CLOCK_MASK (AHB_M_CLOCK_ON| OTG_CLOCK_ON | HOST_CLOCK_ON | I2C_CLOCK_ON) | ||
288 | |||
289 | static void pnx4008_set_usb_bits(void) | ||
290 | { | ||
291 | start_int_set_falling_edge(SE_USB_OTG_ATX_INT_N); | ||
292 | start_int_ack(SE_USB_OTG_ATX_INT_N); | ||
293 | start_int_umask(SE_USB_OTG_ATX_INT_N); | ||
294 | |||
295 | start_int_set_rising_edge(SE_USB_OTG_TIMER_INT); | ||
296 | start_int_ack(SE_USB_OTG_TIMER_INT); | ||
297 | start_int_umask(SE_USB_OTG_TIMER_INT); | ||
298 | |||
299 | start_int_set_rising_edge(SE_USB_I2C_INT); | ||
300 | start_int_ack(SE_USB_I2C_INT); | ||
301 | start_int_umask(SE_USB_I2C_INT); | ||
302 | |||
303 | start_int_set_rising_edge(SE_USB_INT); | ||
304 | start_int_ack(SE_USB_INT); | ||
305 | start_int_umask(SE_USB_INT); | ||
306 | |||
307 | start_int_set_rising_edge(SE_USB_NEED_CLK_INT); | ||
308 | start_int_ack(SE_USB_NEED_CLK_INT); | ||
309 | start_int_umask(SE_USB_NEED_CLK_INT); | ||
310 | |||
311 | start_int_set_rising_edge(SE_USB_AHB_NEED_CLK_INT); | ||
312 | start_int_ack(SE_USB_AHB_NEED_CLK_INT); | ||
313 | start_int_umask(SE_USB_AHB_NEED_CLK_INT); | ||
314 | } | ||
315 | |||
316 | static void pnx4008_unset_usb_bits(void) | ||
317 | { | ||
318 | start_int_mask(SE_USB_OTG_ATX_INT_N); | ||
319 | start_int_mask(SE_USB_OTG_TIMER_INT); | ||
320 | start_int_mask(SE_USB_I2C_INT); | ||
321 | start_int_mask(SE_USB_INT); | ||
322 | start_int_mask(SE_USB_NEED_CLK_INT); | ||
323 | start_int_mask(SE_USB_AHB_NEED_CLK_INT); | ||
324 | } | ||
325 | |||
326 | static int __devinit usb_hcd_pnx4008_probe(struct platform_device *pdev) | ||
327 | { | ||
328 | struct usb_hcd *hcd = 0; | ||
329 | struct ohci_hcd *ohci; | ||
330 | const struct hc_driver *driver = &ohci_pnx4008_hc_driver; | ||
331 | |||
332 | int ret = 0, irq; | ||
333 | |||
334 | dev_dbg(&pdev->dev, "%s: " DRIVER_INFO " (pnx4008)\n", hcd_name); | ||
335 | if (usb_disabled()) { | ||
336 | err("USB is disabled"); | ||
337 | ret = -ENODEV; | ||
338 | goto out; | ||
339 | } | ||
340 | |||
341 | if (pdev->num_resources != 2 | ||
342 | || pdev->resource[0].flags != IORESOURCE_MEM | ||
343 | || pdev->resource[1].flags != IORESOURCE_IRQ) { | ||
344 | err("Invalid resource configuration"); | ||
345 | ret = -ENODEV; | ||
346 | goto out; | ||
347 | } | ||
348 | |||
349 | /* Enable AHB slave USB clock, needed for further USB clock control */ | ||
350 | __raw_writel(USB_SLAVE_HCLK_EN | (1 << 19), USB_CTRL); | ||
351 | |||
352 | ret = i2c_add_driver(&isp1301_driver); | ||
353 | if (ret < 0) { | ||
354 | err("failed to connect I2C to ISP1301 USB Transceiver"); | ||
355 | goto out; | ||
356 | } | ||
357 | |||
358 | isp1301_configure(); | ||
359 | |||
360 | /* Enable USB PLL */ | ||
361 | usb_clk = clk_get(&pdev->dev, "ck_pll5"); | ||
362 | if (IS_ERR(usb_clk)) { | ||
363 | err("failed to acquire USB PLL"); | ||
364 | ret = PTR_ERR(usb_clk); | ||
365 | goto out1; | ||
366 | } | ||
367 | |||
368 | ret = clk_enable(usb_clk); | ||
369 | if (ret < 0) { | ||
370 | err("failed to start USB PLL"); | ||
371 | goto out2; | ||
372 | } | ||
373 | |||
374 | ret = clk_set_rate(usb_clk, 48000); | ||
375 | if (ret < 0) { | ||
376 | err("failed to set USB clock rate"); | ||
377 | goto out3; | ||
378 | } | ||
379 | |||
380 | __raw_writel(__raw_readl(USB_CTRL) | USB_HOST_NEED_CLK_EN, USB_CTRL); | ||
381 | |||
382 | /* Set to enable all needed USB clocks */ | ||
383 | __raw_writel(USB_CLOCK_MASK, USB_OTG_CLK_CTRL); | ||
384 | |||
385 | while ((__raw_readl(USB_OTG_CLK_STAT) & USB_CLOCK_MASK) != | ||
386 | USB_CLOCK_MASK) ; | ||
387 | |||
388 | hcd = usb_create_hcd (driver, &pdev->dev, pdev->dev.bus_id); | ||
389 | if (!hcd) { | ||
390 | err("Failed to allocate HC buffer"); | ||
391 | ret = -ENOMEM; | ||
392 | goto out3; | ||
393 | } | ||
394 | |||
395 | /* Set all USB bits in the Start Enable register */ | ||
396 | pnx4008_set_usb_bits(); | ||
397 | |||
398 | hcd->rsrc_start = pdev->resource[0].start; | ||
399 | hcd->rsrc_len = pdev->resource[0].end - pdev->resource[0].start + 1; | ||
400 | if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) { | ||
401 | dev_dbg(&pdev->dev, "request_mem_region failed\n"); | ||
402 | ret = -ENOMEM; | ||
403 | goto out4; | ||
404 | } | ||
405 | hcd->regs = (void __iomem *)pdev->resource[0].start; | ||
406 | |||
407 | irq = platform_get_irq(pdev, 0); | ||
408 | if (irq < 0) { | ||
409 | ret = -ENXIO; | ||
410 | goto out4; | ||
411 | } | ||
412 | |||
413 | hcd->self.hcpriv = (void *)hcd; | ||
414 | |||
415 | pnx4008_start_hc(); | ||
416 | platform_set_drvdata(pdev, hcd); | ||
417 | ohci = hcd_to_ohci(hcd); | ||
418 | ohci_hcd_init(ohci); | ||
419 | |||
420 | dev_info(&pdev->dev, "at 0x%p, irq %d\n", hcd->regs, hcd->irq); | ||
421 | ret = usb_add_hcd(hcd, irq, SA_INTERRUPT); | ||
422 | if (ret == 0) | ||
423 | return ret; | ||
424 | |||
425 | pnx4008_stop_hc(); | ||
426 | out4: | ||
427 | pnx4008_unset_usb_bits(); | ||
428 | usb_put_hcd(hcd); | ||
429 | out3: | ||
430 | clk_disable(usb_clk); | ||
431 | out2: | ||
432 | clk_put(usb_clk); | ||
433 | out1: | ||
434 | i2c_del_driver(&isp1301_driver); | ||
435 | out: | ||
436 | return ret; | ||
437 | } | ||
438 | |||
439 | static int usb_hcd_pnx4008_remove(struct platform_device *pdev) | ||
440 | { | ||
441 | struct usb_hcd *hcd = platform_get_drvdata(pdev); | ||
442 | |||
443 | usb_remove_hcd(hcd); | ||
444 | pnx4008_stop_hc(); | ||
445 | release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | ||
446 | usb_put_hcd(hcd); | ||
447 | pnx4008_unset_usb_bits(); | ||
448 | clk_disable(usb_clk); | ||
449 | clk_put(usb_clk); | ||
450 | i2c_del_driver(&isp1301_driver); | ||
451 | |||
452 | platform_set_drvdata(pdev, NULL); | ||
453 | |||
454 | return 0; | ||
455 | } | ||
456 | |||
457 | static struct platform_driver usb_hcd_pnx4008_driver = { | ||
458 | .driver = { | ||
459 | .name = "usb-ohci", | ||
460 | }, | ||
461 | .probe = usb_hcd_pnx4008_probe, | ||
462 | .remove = usb_hcd_pnx4008_remove, | ||
463 | }; | ||
464 | |||
465 | static int __init usb_hcd_pnx4008_init(void) | ||
466 | { | ||
467 | return platform_driver_register(&usb_hcd_pnx4008_driver); | ||
468 | } | ||
469 | |||
470 | static void __exit usb_hcd_pnx4008_cleanup(void) | ||
471 | { | ||
472 | return platform_driver_unregister(&usb_hcd_pnx4008_driver); | ||
473 | } | ||
474 | |||
475 | module_init(usb_hcd_pnx4008_init); | ||
476 | module_exit(usb_hcd_pnx4008_cleanup); | ||