Commit | Line | Data |
---|---|---|
c8c38de9 DS |
1 | /* |
2 | * OHCI HCD (Host Controller Driver) for USB. | |
3 | * | |
4 | * Copyright (C) 2010 ST Microelectronics. | |
5 | * Deepak Sikri<deepak.sikri@st.com> | |
6 | * | |
7 | * Based on various ohci-*.c drivers | |
8 | * | |
9 | * This file is licensed under the terms of the GNU General Public | |
10 | * License version 2. This program is licensed "as is" without any | |
11 | * warranty of any kind, whether express or implied. | |
12 | */ | |
13 | ||
14 | #include <linux/signal.h> | |
15 | #include <linux/platform_device.h> | |
16 | #include <linux/clk.h> | |
17 | ||
18 | struct spear_ohci { | |
19 | struct ohci_hcd ohci; | |
20 | struct clk *clk; | |
21 | }; | |
22 | ||
23 | #define to_spear_ohci(hcd) (struct spear_ohci *)hcd_to_ohci(hcd) | |
24 | ||
25 | static void spear_start_ohci(struct spear_ohci *ohci) | |
26 | { | |
27 | clk_enable(ohci->clk); | |
28 | } | |
29 | ||
30 | static void spear_stop_ohci(struct spear_ohci *ohci) | |
31 | { | |
32 | clk_disable(ohci->clk); | |
33 | } | |
34 | ||
35 | static int __devinit ohci_spear_start(struct usb_hcd *hcd) | |
36 | { | |
37 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | |
38 | int ret; | |
39 | ||
40 | ret = ohci_init(ohci); | |
41 | if (ret < 0) | |
42 | return ret; | |
43 | ohci->regs = hcd->regs; | |
44 | ||
45 | ret = ohci_run(ohci); | |
46 | if (ret < 0) { | |
47 | dev_err(hcd->self.controller, "can't start\n"); | |
48 | ohci_stop(hcd); | |
49 | return ret; | |
50 | } | |
51 | ||
52 | create_debug_files(ohci); | |
53 | ||
54 | #ifdef DEBUG | |
55 | ohci_dump(ohci, 1); | |
56 | #endif | |
57 | return 0; | |
58 | } | |
59 | ||
60 | static const struct hc_driver ohci_spear_hc_driver = { | |
61 | .description = hcd_name, | |
62 | .product_desc = "SPEAr OHCI", | |
63 | .hcd_priv_size = sizeof(struct spear_ohci), | |
64 | ||
65 | /* generic hardware linkage */ | |
66 | .irq = ohci_irq, | |
67 | .flags = HCD_USB11 | HCD_MEMORY, | |
68 | ||
69 | /* basic lifecycle operations */ | |
70 | .start = ohci_spear_start, | |
71 | .stop = ohci_stop, | |
72 | .shutdown = ohci_shutdown, | |
73 | #ifdef CONFIG_PM | |
74 | .bus_suspend = ohci_bus_suspend, | |
75 | .bus_resume = ohci_bus_resume, | |
76 | #endif | |
77 | ||
78 | /* managing i/o requests and associated device resources */ | |
79 | .urb_enqueue = ohci_urb_enqueue, | |
80 | .urb_dequeue = ohci_urb_dequeue, | |
81 | .endpoint_disable = ohci_endpoint_disable, | |
82 | ||
83 | /* scheduling support */ | |
84 | .get_frame_number = ohci_get_frame, | |
85 | ||
86 | /* root hub support */ | |
87 | .hub_status_data = ohci_hub_status_data, | |
88 | .hub_control = ohci_hub_control, | |
89 | ||
90 | .start_port_reset = ohci_start_port_reset, | |
91 | }; | |
92 | ||
93 | static int spear_ohci_hcd_drv_probe(struct platform_device *pdev) | |
94 | { | |
95 | const struct hc_driver *driver = &ohci_spear_hc_driver; | |
96 | struct usb_hcd *hcd = NULL; | |
97 | struct clk *usbh_clk; | |
98 | struct spear_ohci *ohci_p; | |
99 | struct resource *res; | |
100 | int retval, irq; | |
101 | int *pdata = pdev->dev.platform_data; | |
102 | char clk_name[20] = "usbh_clk"; | |
103 | ||
104 | if (pdata == NULL) | |
105 | return -EFAULT; | |
106 | ||
107 | irq = platform_get_irq(pdev, 0); | |
108 | if (irq < 0) { | |
109 | retval = irq; | |
110 | goto fail_irq_get; | |
111 | } | |
112 | ||
113 | if (*pdata >= 0) | |
114 | sprintf(clk_name, "usbh.%01d_clk", *pdata); | |
115 | ||
116 | usbh_clk = clk_get(NULL, clk_name); | |
117 | if (IS_ERR(usbh_clk)) { | |
118 | dev_err(&pdev->dev, "Error getting interface clock\n"); | |
119 | retval = PTR_ERR(usbh_clk); | |
120 | goto fail_get_usbh_clk; | |
121 | } | |
122 | ||
123 | hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev)); | |
124 | if (!hcd) { | |
125 | retval = -ENOMEM; | |
126 | goto fail_create_hcd; | |
127 | } | |
128 | ||
129 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
130 | if (!res) { | |
131 | retval = -ENODEV; | |
132 | goto fail_request_resource; | |
133 | } | |
134 | ||
135 | hcd->rsrc_start = pdev->resource[0].start; | |
136 | hcd->rsrc_len = resource_size(res); | |
137 | if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) { | |
138 | dev_dbg(&pdev->dev, "request_mem_region failed\n"); | |
139 | retval = -EBUSY; | |
140 | goto fail_request_resource; | |
141 | } | |
142 | ||
143 | hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len); | |
144 | if (!hcd->regs) { | |
145 | dev_dbg(&pdev->dev, "ioremap failed\n"); | |
146 | retval = -ENOMEM; | |
147 | goto fail_ioremap; | |
148 | } | |
149 | ||
150 | ohci_p = (struct spear_ohci *)hcd_to_ohci(hcd); | |
151 | ohci_p->clk = usbh_clk; | |
152 | spear_start_ohci(ohci_p); | |
153 | ohci_hcd_init(hcd_to_ohci(hcd)); | |
154 | ||
155 | retval = usb_add_hcd(hcd, platform_get_irq(pdev, 0), IRQF_DISABLED); | |
156 | if (retval == 0) | |
157 | return retval; | |
158 | ||
159 | spear_stop_ohci(ohci_p); | |
160 | iounmap(hcd->regs); | |
161 | fail_ioremap: | |
162 | release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | |
163 | fail_request_resource: | |
164 | usb_put_hcd(hcd); | |
165 | fail_create_hcd: | |
166 | clk_put(usbh_clk); | |
167 | fail_get_usbh_clk: | |
168 | fail_irq_get: | |
169 | dev_err(&pdev->dev, "init fail, %d\n", retval); | |
170 | ||
171 | return retval; | |
172 | } | |
173 | ||
174 | static int spear_ohci_hcd_drv_remove(struct platform_device *pdev) | |
175 | { | |
176 | struct usb_hcd *hcd = platform_get_drvdata(pdev); | |
177 | struct spear_ohci *ohci_p = to_spear_ohci(hcd); | |
178 | ||
179 | usb_remove_hcd(hcd); | |
180 | if (ohci_p->clk) | |
181 | spear_stop_ohci(ohci_p); | |
182 | ||
183 | iounmap(hcd->regs); | |
184 | release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | |
185 | usb_put_hcd(hcd); | |
186 | ||
187 | if (ohci_p->clk) | |
188 | clk_put(ohci_p->clk); | |
189 | platform_set_drvdata(pdev, NULL); | |
190 | return 0; | |
191 | } | |
192 | ||
193 | #if defined(CONFIG_PM) | |
194 | static int spear_ohci_hcd_drv_suspend(struct platform_device *dev, | |
195 | pm_message_t message) | |
196 | { | |
197 | struct usb_hcd *hcd = platform_get_drvdata(dev); | |
198 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | |
199 | struct spear_ohci *ohci_p = to_spear_ohci(hcd); | |
200 | ||
201 | if (time_before(jiffies, ohci->next_statechange)) | |
202 | msleep(5); | |
203 | ohci->next_statechange = jiffies; | |
204 | ||
205 | spear_stop_ohci(ohci_p); | |
206 | ohci_to_hcd(ohci)->state = HC_STATE_SUSPENDED; | |
207 | return 0; | |
208 | } | |
209 | ||
210 | static int spear_ohci_hcd_drv_resume(struct platform_device *dev) | |
211 | { | |
212 | struct usb_hcd *hcd = platform_get_drvdata(dev); | |
213 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | |
214 | struct spear_ohci *ohci_p = to_spear_ohci(hcd); | |
215 | ||
216 | if (time_before(jiffies, ohci->next_statechange)) | |
217 | msleep(5); | |
218 | ohci->next_statechange = jiffies; | |
219 | ||
220 | spear_start_ohci(ohci_p); | |
221 | ohci_finish_controller_resume(hcd); | |
222 | return 0; | |
223 | } | |
224 | #endif | |
225 | ||
226 | /* Driver definition to register with the platform bus */ | |
227 | static struct platform_driver spear_ohci_hcd_driver = { | |
228 | .probe = spear_ohci_hcd_drv_probe, | |
229 | .remove = spear_ohci_hcd_drv_remove, | |
230 | #ifdef CONFIG_PM | |
231 | .suspend = spear_ohci_hcd_drv_suspend, | |
232 | .resume = spear_ohci_hcd_drv_resume, | |
233 | #endif | |
234 | .driver = { | |
235 | .owner = THIS_MODULE, | |
236 | .name = "spear-ohci", | |
237 | }, | |
238 | }; | |
239 | ||
240 | MODULE_ALIAS("platform:spear-ohci"); |