Commit | Line | Data |
---|---|---|
80cb9aee | 1 | /* |
1af10774 AV |
2 | * Copyright 2005-2009 MontaVista Software, Inc. |
3 | * Copyright 2008 Freescale Semiconductor, Inc. | |
80cb9aee RV |
4 | * |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms of the GNU General Public License as published by the | |
7 | * Free Software Foundation; either version 2 of the License, or (at your | |
8 | * option) any later version. | |
9 | * | |
10 | * This program is distributed in the hope that it will be useful, but | |
11 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | |
12 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License | |
13 | * for more details. | |
14 | * | |
15 | * You should have received a copy of the GNU General Public License | |
16 | * along with this program; if not, write to the Free Software Foundation, | |
17 | * Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
18 | * | |
19 | * Ported to 834x by Randy Vinson <rvinson@mvista.com> using code provided | |
20 | * by Hunter Wu. | |
1af10774 AV |
21 | * Power Management support by Dave Liu <daveliu@freescale.com>, |
22 | * Jerry Huang <Chang-Ming.Huang@freescale.com> and | |
23 | * Anton Vorontsov <avorontsov@ru.mvista.com>. | |
80cb9aee RV |
24 | */ |
25 | ||
1af10774 AV |
26 | #include <linux/kernel.h> |
27 | #include <linux/types.h> | |
28 | #include <linux/delay.h> | |
29 | #include <linux/pm.h> | |
80cb9aee RV |
30 | #include <linux/platform_device.h> |
31 | #include <linux/fsl_devices.h> | |
32 | ||
33 | #include "ehci-fsl.h" | |
34 | ||
80cb9aee RV |
35 | /* configure so an HC device and id are always provided */ |
36 | /* always called with process context; sleeping is OK */ | |
37 | ||
38 | /** | |
39 | * usb_hcd_fsl_probe - initialize FSL-based HCDs | |
40 | * @drvier: Driver to be used for this HCD | |
41 | * @pdev: USB Host Controller being probed | |
42 | * Context: !in_interrupt() | |
43 | * | |
44 | * Allocates basic resources for this USB host controller. | |
45 | * | |
46 | */ | |
dad3843f AV |
47 | static int usb_hcd_fsl_probe(const struct hc_driver *driver, |
48 | struct platform_device *pdev) | |
80cb9aee RV |
49 | { |
50 | struct fsl_usb2_platform_data *pdata; | |
51 | struct usb_hcd *hcd; | |
52 | struct resource *res; | |
53 | int irq; | |
54 | int retval; | |
80cb9aee RV |
55 | |
56 | pr_debug("initializing FSL-SOC USB Controller\n"); | |
57 | ||
58 | /* Need platform data for setup */ | |
59 | pdata = (struct fsl_usb2_platform_data *)pdev->dev.platform_data; | |
60 | if (!pdata) { | |
61 | dev_err(&pdev->dev, | |
7071a3ce | 62 | "No platform data for %s.\n", dev_name(&pdev->dev)); |
80cb9aee RV |
63 | return -ENODEV; |
64 | } | |
65 | ||
66 | /* | |
67 | * This is a host mode driver, verify that we're supposed to be | |
68 | * in host mode. | |
69 | */ | |
70 | if (!((pdata->operating_mode == FSL_USB2_DR_HOST) || | |
ba02978a LY |
71 | (pdata->operating_mode == FSL_USB2_MPH_HOST) || |
72 | (pdata->operating_mode == FSL_USB2_DR_OTG))) { | |
80cb9aee RV |
73 | dev_err(&pdev->dev, |
74 | "Non Host Mode configured for %s. Wrong driver linked.\n", | |
7071a3ce | 75 | dev_name(&pdev->dev)); |
80cb9aee RV |
76 | return -ENODEV; |
77 | } | |
78 | ||
79 | res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); | |
80 | if (!res) { | |
81 | dev_err(&pdev->dev, | |
82 | "Found HC with no IRQ. Check %s setup!\n", | |
7071a3ce | 83 | dev_name(&pdev->dev)); |
80cb9aee RV |
84 | return -ENODEV; |
85 | } | |
86 | irq = res->start; | |
87 | ||
7071a3ce | 88 | hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev)); |
80cb9aee RV |
89 | if (!hcd) { |
90 | retval = -ENOMEM; | |
91 | goto err1; | |
92 | } | |
93 | ||
94 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
95 | if (!res) { | |
96 | dev_err(&pdev->dev, | |
97 | "Found HC with no register addr. Check %s setup!\n", | |
7071a3ce | 98 | dev_name(&pdev->dev)); |
80cb9aee RV |
99 | retval = -ENODEV; |
100 | goto err2; | |
101 | } | |
102 | hcd->rsrc_start = res->start; | |
103 | hcd->rsrc_len = res->end - res->start + 1; | |
104 | if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, | |
105 | driver->description)) { | |
106 | dev_dbg(&pdev->dev, "controller already in use\n"); | |
107 | retval = -EBUSY; | |
108 | goto err2; | |
109 | } | |
110 | hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len); | |
111 | ||
112 | if (hcd->regs == NULL) { | |
113 | dev_dbg(&pdev->dev, "error mapping memory\n"); | |
114 | retval = -EFAULT; | |
115 | goto err3; | |
116 | } | |
117 | ||
230f7ede | 118 | pdata->regs = hcd->regs; |
80cb9aee | 119 | |
230f7ede AG |
120 | /* |
121 | * do platform specific init: check the clock, grab/config pins, etc. | |
122 | */ | |
123 | if (pdata->init && pdata->init(pdev)) { | |
124 | retval = -ENODEV; | |
125 | goto err3; | |
126 | } | |
127 | ||
230f7ede AG |
128 | /* Enable USB controller, 83xx or 8536 */ |
129 | if (pdata->have_sysif_regs) | |
130 | setbits32(hcd->regs + FSL_SOC_USB_CTRL, 0x4); | |
131 | ||
132 | /* Don't need to set host mode here. It will be done by tdi_reset() */ | |
80cb9aee | 133 | |
442258e2 | 134 | retval = usb_add_hcd(hcd, irq, IRQF_DISABLED | IRQF_SHARED); |
80cb9aee RV |
135 | if (retval != 0) |
136 | goto err4; | |
137 | return retval; | |
138 | ||
139 | err4: | |
140 | iounmap(hcd->regs); | |
141 | err3: | |
142 | release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | |
143 | err2: | |
144 | usb_put_hcd(hcd); | |
145 | err1: | |
7071a3ce | 146 | dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), retval); |
230f7ede AG |
147 | if (pdata->exit) |
148 | pdata->exit(pdev); | |
80cb9aee RV |
149 | return retval; |
150 | } | |
151 | ||
152 | /* may be called without controller electrically present */ | |
153 | /* may be called with controller, bus, and devices active */ | |
154 | ||
155 | /** | |
156 | * usb_hcd_fsl_remove - shutdown processing for FSL-based HCDs | |
157 | * @dev: USB Host Controller being removed | |
158 | * Context: !in_interrupt() | |
159 | * | |
160 | * Reverses the effect of usb_hcd_fsl_probe(). | |
161 | * | |
162 | */ | |
dad3843f AV |
163 | static void usb_hcd_fsl_remove(struct usb_hcd *hcd, |
164 | struct platform_device *pdev) | |
80cb9aee | 165 | { |
230f7ede AG |
166 | struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data; |
167 | ||
80cb9aee | 168 | usb_remove_hcd(hcd); |
230f7ede AG |
169 | |
170 | /* | |
171 | * do platform specific un-initialization: | |
172 | * release iomux pins, disable clock, etc. | |
173 | */ | |
174 | if (pdata->exit) | |
175 | pdata->exit(pdev); | |
80cb9aee RV |
176 | iounmap(hcd->regs); |
177 | release_mem_region(hcd->rsrc_start, hcd->rsrc_len); | |
178 | usb_put_hcd(hcd); | |
179 | } | |
180 | ||
230f7ede AG |
181 | static void ehci_fsl_setup_phy(struct ehci_hcd *ehci, |
182 | enum fsl_usb2_phy_modes phy_mode, | |
183 | unsigned int port_offset) | |
80cb9aee | 184 | { |
230f7ede AG |
185 | u32 portsc; |
186 | ||
187 | portsc = ehci_readl(ehci, &ehci->regs->port_status[port_offset]); | |
188 | portsc &= ~(PORT_PTS_MSK | PORT_PTS_PTW); | |
189 | ||
80cb9aee RV |
190 | switch (phy_mode) { |
191 | case FSL_USB2_PHY_ULPI: | |
192 | portsc |= PORT_PTS_ULPI; | |
193 | break; | |
194 | case FSL_USB2_PHY_SERIAL: | |
195 | portsc |= PORT_PTS_SERIAL; | |
196 | break; | |
197 | case FSL_USB2_PHY_UTMI_WIDE: | |
198 | portsc |= PORT_PTS_PTW; | |
199 | /* fall through */ | |
200 | case FSL_USB2_PHY_UTMI: | |
201 | portsc |= PORT_PTS_UTMI; | |
202 | break; | |
203 | case FSL_USB2_PHY_NONE: | |
204 | break; | |
205 | } | |
083522d7 | 206 | ehci_writel(ehci, portsc, &ehci->regs->port_status[port_offset]); |
80cb9aee RV |
207 | } |
208 | ||
230f7ede | 209 | static void ehci_fsl_usb_setup(struct ehci_hcd *ehci) |
80cb9aee | 210 | { |
230f7ede | 211 | struct usb_hcd *hcd = ehci_to_hcd(ehci); |
80cb9aee RV |
212 | struct fsl_usb2_platform_data *pdata; |
213 | void __iomem *non_ehci = hcd->regs; | |
ba02978a | 214 | u32 temp; |
80cb9aee | 215 | |
230f7ede AG |
216 | pdata = hcd->self.controller->platform_data; |
217 | ||
80cb9aee | 218 | /* Enable PHY interface in the control reg. */ |
230f7ede AG |
219 | if (pdata->have_sysif_regs) { |
220 | temp = in_be32(non_ehci + FSL_SOC_USB_CTRL); | |
221 | out_be32(non_ehci + FSL_SOC_USB_CTRL, temp | 0x00000004); | |
222 | out_be32(non_ehci + FSL_SOC_USB_SNOOP1, 0x0000001b); | |
223 | } | |
80cb9aee | 224 | |
40acc095 LY |
225 | #if defined(CONFIG_PPC32) && !defined(CONFIG_NOT_COHERENT_CACHE) |
226 | /* | |
227 | * Turn on cache snooping hardware, since some PowerPC platforms | |
228 | * wholly rely on hardware to deal with cache coherent | |
229 | */ | |
230 | ||
231 | /* Setup Snooping for all the 4GB space */ | |
232 | /* SNOOP1 starts from 0x0, size 2G */ | |
233 | out_be32(non_ehci + FSL_SOC_USB_SNOOP1, 0x0 | SNOOP_SIZE_2GB); | |
234 | /* SNOOP2 starts from 0x80000000, size 2G */ | |
235 | out_be32(non_ehci + FSL_SOC_USB_SNOOP2, 0x80000000 | SNOOP_SIZE_2GB); | |
236 | #endif | |
237 | ||
ba02978a LY |
238 | if ((pdata->operating_mode == FSL_USB2_DR_HOST) || |
239 | (pdata->operating_mode == FSL_USB2_DR_OTG)) | |
230f7ede | 240 | ehci_fsl_setup_phy(ehci, pdata->phy_mode, 0); |
80cb9aee RV |
241 | |
242 | if (pdata->operating_mode == FSL_USB2_MPH_HOST) { | |
8cd42e97 KG |
243 | unsigned int chip, rev, svr; |
244 | ||
245 | svr = mfspr(SPRN_SVR); | |
246 | chip = svr >> 16; | |
247 | rev = (svr >> 4) & 0xf; | |
248 | ||
249 | /* Deal with USB Erratum #14 on MPC834x Rev 1.0 & 1.1 chips */ | |
250 | if ((rev == 1) && (chip >= 0x8050) && (chip <= 0x8055)) | |
251 | ehci->has_fsl_port_bug = 1; | |
252 | ||
80cb9aee | 253 | if (pdata->port_enables & FSL_USB2_PORT0_ENABLED) |
230f7ede | 254 | ehci_fsl_setup_phy(ehci, pdata->phy_mode, 0); |
80cb9aee | 255 | if (pdata->port_enables & FSL_USB2_PORT1_ENABLED) |
230f7ede | 256 | ehci_fsl_setup_phy(ehci, pdata->phy_mode, 1); |
80cb9aee RV |
257 | } |
258 | ||
230f7ede | 259 | if (pdata->have_sysif_regs) { |
4f534258 | 260 | #ifdef CONFIG_PPC_85xx |
230f7ede AG |
261 | out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x00000008); |
262 | out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000080); | |
4f534258 | 263 | #else |
230f7ede AG |
264 | out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x0000000c); |
265 | out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000040); | |
4f534258 | 266 | #endif |
230f7ede AG |
267 | out_be32(non_ehci + FSL_SOC_USB_SICTRL, 0x00000001); |
268 | } | |
80cb9aee RV |
269 | } |
270 | ||
271 | /* called after powerup, by probe or system-pm "wakeup" */ | |
272 | static int ehci_fsl_reinit(struct ehci_hcd *ehci) | |
273 | { | |
230f7ede | 274 | ehci_fsl_usb_setup(ehci); |
80cb9aee RV |
275 | ehci_port_power(ehci, 0); |
276 | ||
277 | return 0; | |
278 | } | |
279 | ||
280 | /* called during probe() after chip reset completes */ | |
281 | static int ehci_fsl_setup(struct usb_hcd *hcd) | |
282 | { | |
283 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
284 | int retval; | |
230f7ede AG |
285 | struct fsl_usb2_platform_data *pdata; |
286 | ||
287 | pdata = hcd->self.controller->platform_data; | |
288 | ehci->big_endian_desc = pdata->big_endian_desc; | |
289 | ehci->big_endian_mmio = pdata->big_endian_mmio; | |
80cb9aee RV |
290 | |
291 | /* EHCI registers start at offset 0x100 */ | |
292 | ehci->caps = hcd->regs + 0x100; | |
293 | ehci->regs = hcd->regs + 0x100 + | |
083522d7 | 294 | HC_LENGTH(ehci_readl(ehci, &ehci->caps->hc_capbase)); |
80cb9aee RV |
295 | dbg_hcs_params(ehci, "reset"); |
296 | dbg_hcc_params(ehci, "reset"); | |
297 | ||
298 | /* cache this readonly data; minimize chip reads */ | |
083522d7 | 299 | ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params); |
80cb9aee | 300 | |
65fd4272 MC |
301 | hcd->has_tt = 1; |
302 | ||
80cb9aee RV |
303 | retval = ehci_halt(ehci); |
304 | if (retval) | |
305 | return retval; | |
306 | ||
307 | /* data structure init */ | |
308 | retval = ehci_init(hcd); | |
309 | if (retval) | |
310 | return retval; | |
311 | ||
80cb9aee RV |
312 | ehci->sbrn = 0x20; |
313 | ||
314 | ehci_reset(ehci); | |
315 | ||
316 | retval = ehci_fsl_reinit(ehci); | |
317 | return retval; | |
318 | } | |
319 | ||
1af10774 AV |
320 | struct ehci_fsl { |
321 | struct ehci_hcd ehci; | |
322 | ||
323 | #ifdef CONFIG_PM | |
324 | /* Saved USB PHY settings, need to restore after deep sleep. */ | |
325 | u32 usb_ctrl; | |
326 | #endif | |
327 | }; | |
328 | ||
329 | #ifdef CONFIG_PM | |
330 | ||
13b7ee2a AG |
331 | #ifdef CONFIG_PPC_MPC512x |
332 | static int ehci_fsl_mpc512x_drv_suspend(struct device *dev) | |
333 | { | |
334 | struct usb_hcd *hcd = dev_get_drvdata(dev); | |
335 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
336 | struct fsl_usb2_platform_data *pdata = dev->platform_data; | |
337 | u32 tmp; | |
338 | ||
339 | #ifdef DEBUG | |
340 | u32 mode = ehci_readl(ehci, hcd->regs + FSL_SOC_USB_USBMODE); | |
341 | mode &= USBMODE_CM_MASK; | |
342 | tmp = ehci_readl(ehci, hcd->regs + 0x140); /* usbcmd */ | |
343 | ||
344 | dev_dbg(dev, "suspend=%d already_suspended=%d " | |
345 | "mode=%d usbcmd %08x\n", pdata->suspended, | |
346 | pdata->already_suspended, mode, tmp); | |
347 | #endif | |
348 | ||
349 | /* | |
350 | * If the controller is already suspended, then this must be a | |
351 | * PM suspend. Remember this fact, so that we will leave the | |
352 | * controller suspended at PM resume time. | |
353 | */ | |
354 | if (pdata->suspended) { | |
355 | dev_dbg(dev, "already suspended, leaving early\n"); | |
356 | pdata->already_suspended = 1; | |
357 | return 0; | |
358 | } | |
359 | ||
360 | dev_dbg(dev, "suspending...\n"); | |
361 | ||
362 | hcd->state = HC_STATE_SUSPENDED; | |
363 | dev->power.power_state = PMSG_SUSPEND; | |
364 | ||
365 | /* ignore non-host interrupts */ | |
366 | clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); | |
367 | ||
368 | /* stop the controller */ | |
369 | tmp = ehci_readl(ehci, &ehci->regs->command); | |
370 | tmp &= ~CMD_RUN; | |
371 | ehci_writel(ehci, tmp, &ehci->regs->command); | |
372 | ||
373 | /* save EHCI registers */ | |
374 | pdata->pm_command = ehci_readl(ehci, &ehci->regs->command); | |
375 | pdata->pm_command &= ~CMD_RUN; | |
376 | pdata->pm_status = ehci_readl(ehci, &ehci->regs->status); | |
377 | pdata->pm_intr_enable = ehci_readl(ehci, &ehci->regs->intr_enable); | |
378 | pdata->pm_frame_index = ehci_readl(ehci, &ehci->regs->frame_index); | |
379 | pdata->pm_segment = ehci_readl(ehci, &ehci->regs->segment); | |
380 | pdata->pm_frame_list = ehci_readl(ehci, &ehci->regs->frame_list); | |
381 | pdata->pm_async_next = ehci_readl(ehci, &ehci->regs->async_next); | |
382 | pdata->pm_configured_flag = | |
383 | ehci_readl(ehci, &ehci->regs->configured_flag); | |
384 | pdata->pm_portsc = ehci_readl(ehci, &ehci->regs->port_status[0]); | |
385 | pdata->pm_usbgenctrl = ehci_readl(ehci, | |
386 | hcd->regs + FSL_SOC_USB_USBGENCTRL); | |
387 | ||
388 | /* clear the W1C bits */ | |
389 | pdata->pm_portsc &= cpu_to_hc32(ehci, ~PORT_RWC_BITS); | |
390 | ||
391 | pdata->suspended = 1; | |
392 | ||
393 | /* clear PP to cut power to the port */ | |
394 | tmp = ehci_readl(ehci, &ehci->regs->port_status[0]); | |
395 | tmp &= ~PORT_POWER; | |
396 | ehci_writel(ehci, tmp, &ehci->regs->port_status[0]); | |
397 | ||
398 | return 0; | |
399 | } | |
400 | ||
401 | static int ehci_fsl_mpc512x_drv_resume(struct device *dev) | |
402 | { | |
403 | struct usb_hcd *hcd = dev_get_drvdata(dev); | |
404 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
405 | struct fsl_usb2_platform_data *pdata = dev->platform_data; | |
406 | u32 tmp; | |
407 | ||
408 | dev_dbg(dev, "suspend=%d already_suspended=%d\n", | |
409 | pdata->suspended, pdata->already_suspended); | |
410 | ||
411 | /* | |
412 | * If the controller was already suspended at suspend time, | |
413 | * then don't resume it now. | |
414 | */ | |
415 | if (pdata->already_suspended) { | |
416 | dev_dbg(dev, "already suspended, leaving early\n"); | |
417 | pdata->already_suspended = 0; | |
418 | return 0; | |
419 | } | |
420 | ||
421 | if (!pdata->suspended) { | |
422 | dev_dbg(dev, "not suspended, leaving early\n"); | |
423 | return 0; | |
424 | } | |
425 | ||
426 | pdata->suspended = 0; | |
427 | ||
428 | dev_dbg(dev, "resuming...\n"); | |
429 | ||
430 | /* set host mode */ | |
431 | tmp = USBMODE_CM_HOST | (pdata->es ? USBMODE_ES : 0); | |
432 | ehci_writel(ehci, tmp, hcd->regs + FSL_SOC_USB_USBMODE); | |
433 | ||
434 | ehci_writel(ehci, pdata->pm_usbgenctrl, | |
435 | hcd->regs + FSL_SOC_USB_USBGENCTRL); | |
436 | ehci_writel(ehci, ISIPHYCTRL_PXE | ISIPHYCTRL_PHYE, | |
437 | hcd->regs + FSL_SOC_USB_ISIPHYCTRL); | |
438 | ||
439 | /* restore EHCI registers */ | |
440 | ehci_writel(ehci, pdata->pm_command, &ehci->regs->command); | |
441 | ehci_writel(ehci, pdata->pm_intr_enable, &ehci->regs->intr_enable); | |
442 | ehci_writel(ehci, pdata->pm_frame_index, &ehci->regs->frame_index); | |
443 | ehci_writel(ehci, pdata->pm_segment, &ehci->regs->segment); | |
444 | ehci_writel(ehci, pdata->pm_frame_list, &ehci->regs->frame_list); | |
445 | ehci_writel(ehci, pdata->pm_async_next, &ehci->regs->async_next); | |
446 | ehci_writel(ehci, pdata->pm_configured_flag, | |
447 | &ehci->regs->configured_flag); | |
448 | ehci_writel(ehci, pdata->pm_portsc, &ehci->regs->port_status[0]); | |
449 | ||
450 | set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); | |
451 | hcd->state = HC_STATE_RUNNING; | |
452 | dev->power.power_state = PMSG_ON; | |
453 | ||
454 | tmp = ehci_readl(ehci, &ehci->regs->command); | |
455 | tmp |= CMD_RUN; | |
456 | ehci_writel(ehci, tmp, &ehci->regs->command); | |
457 | ||
458 | usb_hcd_resume_root_hub(hcd); | |
459 | ||
460 | return 0; | |
461 | } | |
462 | #else | |
463 | static inline int ehci_fsl_mpc512x_drv_suspend(struct device *dev) | |
464 | { | |
465 | return 0; | |
466 | } | |
467 | ||
468 | static inline int ehci_fsl_mpc512x_drv_resume(struct device *dev) | |
469 | { | |
470 | return 0; | |
471 | } | |
472 | #endif /* CONFIG_PPC_MPC512x */ | |
473 | ||
1af10774 AV |
474 | static struct ehci_fsl *hcd_to_ehci_fsl(struct usb_hcd *hcd) |
475 | { | |
476 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
477 | ||
478 | return container_of(ehci, struct ehci_fsl, ehci); | |
479 | } | |
480 | ||
481 | static int ehci_fsl_drv_suspend(struct device *dev) | |
482 | { | |
483 | struct usb_hcd *hcd = dev_get_drvdata(dev); | |
484 | struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd); | |
485 | void __iomem *non_ehci = hcd->regs; | |
486 | ||
13b7ee2a AG |
487 | if (of_device_is_compatible(dev->parent->of_node, |
488 | "fsl,mpc5121-usb2-dr")) { | |
489 | return ehci_fsl_mpc512x_drv_suspend(dev); | |
490 | } | |
491 | ||
4147200d AS |
492 | ehci_prepare_ports_for_controller_suspend(hcd_to_ehci(hcd), |
493 | device_may_wakeup(dev)); | |
1af10774 AV |
494 | if (!fsl_deep_sleep()) |
495 | return 0; | |
496 | ||
497 | ehci_fsl->usb_ctrl = in_be32(non_ehci + FSL_SOC_USB_CTRL); | |
498 | return 0; | |
499 | } | |
500 | ||
501 | static int ehci_fsl_drv_resume(struct device *dev) | |
502 | { | |
503 | struct usb_hcd *hcd = dev_get_drvdata(dev); | |
504 | struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd); | |
505 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
506 | void __iomem *non_ehci = hcd->regs; | |
507 | ||
13b7ee2a AG |
508 | if (of_device_is_compatible(dev->parent->of_node, |
509 | "fsl,mpc5121-usb2-dr")) { | |
510 | return ehci_fsl_mpc512x_drv_resume(dev); | |
511 | } | |
512 | ||
16032c4f | 513 | ehci_prepare_ports_for_controller_resume(ehci); |
1af10774 AV |
514 | if (!fsl_deep_sleep()) |
515 | return 0; | |
516 | ||
517 | usb_root_hub_lost_power(hcd->self.root_hub); | |
518 | ||
519 | /* Restore USB PHY settings and enable the controller. */ | |
520 | out_be32(non_ehci + FSL_SOC_USB_CTRL, ehci_fsl->usb_ctrl); | |
521 | ||
522 | ehci_reset(ehci); | |
523 | ehci_fsl_reinit(ehci); | |
524 | ||
525 | return 0; | |
526 | } | |
527 | ||
528 | static int ehci_fsl_drv_restore(struct device *dev) | |
529 | { | |
530 | struct usb_hcd *hcd = dev_get_drvdata(dev); | |
531 | ||
532 | usb_root_hub_lost_power(hcd->self.root_hub); | |
533 | return 0; | |
534 | } | |
535 | ||
536 | static struct dev_pm_ops ehci_fsl_pm_ops = { | |
537 | .suspend = ehci_fsl_drv_suspend, | |
538 | .resume = ehci_fsl_drv_resume, | |
539 | .restore = ehci_fsl_drv_restore, | |
540 | }; | |
541 | ||
542 | #define EHCI_FSL_PM_OPS (&ehci_fsl_pm_ops) | |
543 | #else | |
544 | #define EHCI_FSL_PM_OPS NULL | |
545 | #endif /* CONFIG_PM */ | |
546 | ||
80cb9aee RV |
547 | static const struct hc_driver ehci_fsl_hc_driver = { |
548 | .description = hcd_name, | |
549 | .product_desc = "Freescale On-Chip EHCI Host Controller", | |
1af10774 | 550 | .hcd_priv_size = sizeof(struct ehci_fsl), |
80cb9aee RV |
551 | |
552 | /* | |
553 | * generic hardware linkage | |
554 | */ | |
555 | .irq = ehci_irq, | |
230f7ede | 556 | .flags = HCD_USB2 | HCD_MEMORY, |
80cb9aee RV |
557 | |
558 | /* | |
559 | * basic lifecycle operations | |
560 | */ | |
561 | .reset = ehci_fsl_setup, | |
562 | .start = ehci_run, | |
80cb9aee | 563 | .stop = ehci_stop, |
64a21d02 | 564 | .shutdown = ehci_shutdown, |
80cb9aee RV |
565 | |
566 | /* | |
567 | * managing i/o requests and associated device resources | |
568 | */ | |
569 | .urb_enqueue = ehci_urb_enqueue, | |
570 | .urb_dequeue = ehci_urb_dequeue, | |
571 | .endpoint_disable = ehci_endpoint_disable, | |
b18ffd49 | 572 | .endpoint_reset = ehci_endpoint_reset, |
80cb9aee RV |
573 | |
574 | /* | |
575 | * scheduling support | |
576 | */ | |
577 | .get_frame_number = ehci_get_frame, | |
578 | ||
579 | /* | |
580 | * root hub support | |
581 | */ | |
582 | .hub_status_data = ehci_hub_status_data, | |
583 | .hub_control = ehci_hub_control, | |
584 | .bus_suspend = ehci_bus_suspend, | |
585 | .bus_resume = ehci_bus_resume, | |
90da096e | 586 | .relinquish_port = ehci_relinquish_port, |
3a31155c | 587 | .port_handed_over = ehci_port_handed_over, |
914b7012 AS |
588 | |
589 | .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete, | |
80cb9aee RV |
590 | }; |
591 | ||
592 | static int ehci_fsl_drv_probe(struct platform_device *pdev) | |
593 | { | |
594 | if (usb_disabled()) | |
595 | return -ENODEV; | |
596 | ||
135db048 | 597 | /* FIXME we only want one one probe() not two */ |
80cb9aee RV |
598 | return usb_hcd_fsl_probe(&ehci_fsl_hc_driver, pdev); |
599 | } | |
600 | ||
601 | static int ehci_fsl_drv_remove(struct platform_device *pdev) | |
602 | { | |
603 | struct usb_hcd *hcd = platform_get_drvdata(pdev); | |
604 | ||
135db048 | 605 | /* FIXME we only want one one remove() not two */ |
80cb9aee | 606 | usb_hcd_fsl_remove(hcd, pdev); |
80cb9aee RV |
607 | return 0; |
608 | } | |
609 | ||
135db048 | 610 | MODULE_ALIAS("platform:fsl-ehci"); |
80cb9aee | 611 | |
01cced25 | 612 | static struct platform_driver ehci_fsl_driver = { |
80cb9aee RV |
613 | .probe = ehci_fsl_drv_probe, |
614 | .remove = ehci_fsl_drv_remove, | |
64a21d02 | 615 | .shutdown = usb_hcd_platform_shutdown, |
80cb9aee | 616 | .driver = { |
1af10774 AV |
617 | .name = "fsl-ehci", |
618 | .pm = EHCI_FSL_PM_OPS, | |
135db048 | 619 | }, |
80cb9aee | 620 | }; |