PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / usb / host / ohci-s3c2410.c
blobff7c8f1c48fb682a137484e74b7003a7bfe0d3f1
1 /*
2 * OHCI HCD (Host Controller Driver) for USB.
4 * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
5 * (C) Copyright 2000-2002 David Brownell <dbrownell@users.sourceforge.net>
6 * (C) Copyright 2002 Hewlett-Packard Company
8 * USB Bus Glue for Samsung S3C2410
10 * Written by Christopher Hoover <ch@hpl.hp.com>
11 * Based on fragments of previous driver by Russell King et al.
13 * Modified for S3C2410 from ohci-sa1111.c, ohci-omap.c and ohci-lh7a40.c
14 * by Ben Dooks, <ben@simtec.co.uk>
15 * Copyright (C) 2004 Simtec Electronics
17 * Thanks to basprog@mail.ru for updates to newer kernels
19 * This file is licenced under the GPL.
22 #include <linux/clk.h>
23 #include <linux/io.h>
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/platform_device.h>
27 #include <linux/platform_data/usb-ohci-s3c2410.h>
28 #include <linux/usb.h>
29 #include <linux/usb/hcd.h>
31 #include "ohci.h"
34 #define valid_port(idx) ((idx) == 1 || (idx) == 2)
36 /* clock device associated with the hcd */
39 #define DRIVER_DESC "OHCI S3C2410 driver"
41 static const char hcd_name[] = "ohci-s3c2410";
43 static struct clk *clk;
44 static struct clk *usb_clk;
46 /* forward definitions */
48 static int (*orig_ohci_hub_control)(struct usb_hcd *hcd, u16 typeReq,
49 u16 wValue, u16 wIndex, char *buf, u16 wLength);
50 static int (*orig_ohci_hub_status_data)(struct usb_hcd *hcd, char *buf);
52 static void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc);
54 /* conversion functions */
56 static struct s3c2410_hcd_info *to_s3c2410_info(struct usb_hcd *hcd)
58 return dev_get_platdata(hcd->self.controller);
61 static void s3c2410_start_hc(struct platform_device *dev, struct usb_hcd *hcd)
63 struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev);
65 dev_dbg(&dev->dev, "s3c2410_start_hc:\n");
67 clk_prepare_enable(usb_clk);
68 mdelay(2); /* let the bus clock stabilise */
70 clk_prepare_enable(clk);
72 if (info != NULL) {
73 info->hcd = hcd;
74 info->report_oc = s3c2410_hcd_oc;
76 if (info->enable_oc != NULL)
77 (info->enable_oc)(info, 1);
81 static void s3c2410_stop_hc(struct platform_device *dev)
83 struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev);
85 dev_dbg(&dev->dev, "s3c2410_stop_hc:\n");
87 if (info != NULL) {
88 info->report_oc = NULL;
89 info->hcd = NULL;
91 if (info->enable_oc != NULL)
92 (info->enable_oc)(info, 0);
95 clk_disable_unprepare(clk);
96 clk_disable_unprepare(usb_clk);
99 /* ohci_s3c2410_hub_status_data
101 * update the status data from the hub with anything that
102 * has been detected by our system
105 static int
106 ohci_s3c2410_hub_status_data(struct usb_hcd *hcd, char *buf)
108 struct s3c2410_hcd_info *info = to_s3c2410_info(hcd);
109 struct s3c2410_hcd_port *port;
110 int orig;
111 int portno;
113 orig = orig_ohci_hub_status_data(hcd, buf);
115 if (info == NULL)
116 return orig;
118 port = &info->port[0];
120 /* mark any changed port as changed */
122 for (portno = 0; portno < 2; port++, portno++) {
123 if (port->oc_changed == 1 &&
124 port->flags & S3C_HCDFLG_USED) {
125 dev_dbg(hcd->self.controller,
126 "oc change on port %d\n", portno);
128 if (orig < 1)
129 orig = 1;
131 buf[0] |= 1<<(portno+1);
135 return orig;
138 /* s3c2410_usb_set_power
140 * configure the power on a port, by calling the platform device
141 * routine registered with the platform device
144 static void s3c2410_usb_set_power(struct s3c2410_hcd_info *info,
145 int port, int to)
147 if (info == NULL)
148 return;
150 if (info->power_control != NULL) {
151 info->port[port-1].power = to;
152 (info->power_control)(port-1, to);
156 /* ohci_s3c2410_hub_control
158 * look at control requests to the hub, and see if we need
159 * to take any action or over-ride the results from the
160 * request.
163 static int ohci_s3c2410_hub_control(
164 struct usb_hcd *hcd,
165 u16 typeReq,
166 u16 wValue,
167 u16 wIndex,
168 char *buf,
169 u16 wLength)
171 struct s3c2410_hcd_info *info = to_s3c2410_info(hcd);
172 struct usb_hub_descriptor *desc;
173 int ret = -EINVAL;
174 u32 *data = (u32 *)buf;
176 dev_dbg(hcd->self.controller,
177 "s3c2410_hub_control(%p,0x%04x,0x%04x,0x%04x,%p,%04x)\n",
178 hcd, typeReq, wValue, wIndex, buf, wLength);
180 /* if we are only an humble host without any special capabilities
181 * process the request straight away and exit */
183 if (info == NULL) {
184 ret = orig_ohci_hub_control(hcd, typeReq, wValue,
185 wIndex, buf, wLength);
186 goto out;
189 /* check the request to see if it needs handling */
191 switch (typeReq) {
192 case SetPortFeature:
193 if (wValue == USB_PORT_FEAT_POWER) {
194 dev_dbg(hcd->self.controller, "SetPortFeat: POWER\n");
195 s3c2410_usb_set_power(info, wIndex, 1);
196 goto out;
198 break;
200 case ClearPortFeature:
201 switch (wValue) {
202 case USB_PORT_FEAT_C_OVER_CURRENT:
203 dev_dbg(hcd->self.controller,
204 "ClearPortFeature: C_OVER_CURRENT\n");
206 if (valid_port(wIndex)) {
207 info->port[wIndex-1].oc_changed = 0;
208 info->port[wIndex-1].oc_status = 0;
211 goto out;
213 case USB_PORT_FEAT_OVER_CURRENT:
214 dev_dbg(hcd->self.controller,
215 "ClearPortFeature: OVER_CURRENT\n");
217 if (valid_port(wIndex))
218 info->port[wIndex-1].oc_status = 0;
220 goto out;
222 case USB_PORT_FEAT_POWER:
223 dev_dbg(hcd->self.controller,
224 "ClearPortFeature: POWER\n");
226 if (valid_port(wIndex)) {
227 s3c2410_usb_set_power(info, wIndex, 0);
228 return 0;
231 break;
234 ret = orig_ohci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
235 if (ret)
236 goto out;
238 switch (typeReq) {
239 case GetHubDescriptor:
241 /* update the hub's descriptor */
243 desc = (struct usb_hub_descriptor *)buf;
245 if (info->power_control == NULL)
246 return ret;
248 dev_dbg(hcd->self.controller, "wHubCharacteristics 0x%04x\n",
249 desc->wHubCharacteristics);
251 /* remove the old configurations for power-switching, and
252 * over-current protection, and insert our new configuration
255 desc->wHubCharacteristics &= ~cpu_to_le16(HUB_CHAR_LPSM);
256 desc->wHubCharacteristics |= cpu_to_le16(0x0001);
258 if (info->enable_oc) {
259 desc->wHubCharacteristics &= ~cpu_to_le16(
260 HUB_CHAR_OCPM);
261 desc->wHubCharacteristics |= cpu_to_le16(
262 0x0008 |
263 0x0001);
266 dev_dbg(hcd->self.controller, "wHubCharacteristics after 0x%04x\n",
267 desc->wHubCharacteristics);
269 return ret;
271 case GetPortStatus:
272 /* check port status */
274 dev_dbg(hcd->self.controller, "GetPortStatus(%d)\n", wIndex);
276 if (valid_port(wIndex)) {
277 if (info->port[wIndex-1].oc_changed)
278 *data |= cpu_to_le32(RH_PS_OCIC);
280 if (info->port[wIndex-1].oc_status)
281 *data |= cpu_to_le32(RH_PS_POCI);
285 out:
286 return ret;
289 /* s3c2410_hcd_oc
291 * handle an over-current report
294 static void s3c2410_hcd_oc(struct s3c2410_hcd_info *info, int port_oc)
296 struct s3c2410_hcd_port *port;
297 struct usb_hcd *hcd;
298 unsigned long flags;
299 int portno;
301 if (info == NULL)
302 return;
304 port = &info->port[0];
305 hcd = info->hcd;
307 local_irq_save(flags);
309 for (portno = 0; portno < 2; port++, portno++) {
310 if (port_oc & (1<<portno) &&
311 port->flags & S3C_HCDFLG_USED) {
312 port->oc_status = 1;
313 port->oc_changed = 1;
315 /* ok, once over-current is detected,
316 the port needs to be powered down */
317 s3c2410_usb_set_power(info, portno+1, 0);
321 local_irq_restore(flags);
324 /* may be called without controller electrically present */
325 /* may be called with controller, bus, and devices active */
328 * usb_hcd_s3c2410_remove - shutdown processing for HCD
329 * @dev: USB Host Controller being removed
330 * Context: !in_interrupt()
332 * Reverses the effect of usb_hcd_3c2410_probe(), first invoking
333 * the HCD's stop() method. It is always called from a thread
334 * context, normally "rmmod", "apmd", or something similar.
338 static void
339 usb_hcd_s3c2410_remove(struct usb_hcd *hcd, struct platform_device *dev)
341 usb_remove_hcd(hcd);
342 s3c2410_stop_hc(dev);
343 usb_put_hcd(hcd);
347 * usb_hcd_s3c2410_probe - initialize S3C2410-based HCDs
348 * Context: !in_interrupt()
350 * Allocates basic resources for this USB host controller, and
351 * then invokes the start() method for the HCD associated with it
352 * through the hotplug entry's driver_data.
355 static int usb_hcd_s3c2410_probe(const struct hc_driver *driver,
356 struct platform_device *dev)
358 struct usb_hcd *hcd = NULL;
359 struct s3c2410_hcd_info *info = dev_get_platdata(&dev->dev);
360 int retval;
362 s3c2410_usb_set_power(info, 1, 1);
363 s3c2410_usb_set_power(info, 2, 1);
365 hcd = usb_create_hcd(driver, &dev->dev, "s3c24xx");
366 if (hcd == NULL)
367 return -ENOMEM;
369 hcd->rsrc_start = dev->resource[0].start;
370 hcd->rsrc_len = resource_size(&dev->resource[0]);
372 hcd->regs = devm_ioremap_resource(&dev->dev, &dev->resource[0]);
373 if (IS_ERR(hcd->regs)) {
374 retval = PTR_ERR(hcd->regs);
375 goto err_put;
378 clk = devm_clk_get(&dev->dev, "usb-host");
379 if (IS_ERR(clk)) {
380 dev_err(&dev->dev, "cannot get usb-host clock\n");
381 retval = PTR_ERR(clk);
382 goto err_put;
385 usb_clk = devm_clk_get(&dev->dev, "usb-bus-host");
386 if (IS_ERR(usb_clk)) {
387 dev_err(&dev->dev, "cannot get usb-bus-host clock\n");
388 retval = PTR_ERR(usb_clk);
389 goto err_put;
392 s3c2410_start_hc(dev, hcd);
394 retval = usb_add_hcd(hcd, dev->resource[1].start, 0);
395 if (retval != 0)
396 goto err_ioremap;
398 device_wakeup_enable(hcd->self.controller);
399 return 0;
401 err_ioremap:
402 s3c2410_stop_hc(dev);
404 err_put:
405 usb_put_hcd(hcd);
406 return retval;
409 /*-------------------------------------------------------------------------*/
411 static struct hc_driver __read_mostly ohci_s3c2410_hc_driver;
413 static int ohci_hcd_s3c2410_drv_probe(struct platform_device *pdev)
415 return usb_hcd_s3c2410_probe(&ohci_s3c2410_hc_driver, pdev);
418 static int ohci_hcd_s3c2410_drv_remove(struct platform_device *pdev)
420 struct usb_hcd *hcd = platform_get_drvdata(pdev);
422 usb_hcd_s3c2410_remove(hcd, pdev);
423 return 0;
426 #ifdef CONFIG_PM
427 static int ohci_hcd_s3c2410_drv_suspend(struct device *dev)
429 struct usb_hcd *hcd = dev_get_drvdata(dev);
430 struct platform_device *pdev = to_platform_device(dev);
431 bool do_wakeup = device_may_wakeup(dev);
432 int rc = 0;
434 rc = ohci_suspend(hcd, do_wakeup);
435 if (rc)
436 return rc;
438 s3c2410_stop_hc(pdev);
440 return rc;
443 static int ohci_hcd_s3c2410_drv_resume(struct device *dev)
445 struct usb_hcd *hcd = dev_get_drvdata(dev);
446 struct platform_device *pdev = to_platform_device(dev);
448 s3c2410_start_hc(pdev, hcd);
450 ohci_resume(hcd, false);
452 return 0;
454 #else
455 #define ohci_hcd_s3c2410_drv_suspend NULL
456 #define ohci_hcd_s3c2410_drv_resume NULL
457 #endif
459 static const struct dev_pm_ops ohci_hcd_s3c2410_pm_ops = {
460 .suspend = ohci_hcd_s3c2410_drv_suspend,
461 .resume = ohci_hcd_s3c2410_drv_resume,
464 static struct platform_driver ohci_hcd_s3c2410_driver = {
465 .probe = ohci_hcd_s3c2410_drv_probe,
466 .remove = ohci_hcd_s3c2410_drv_remove,
467 .shutdown = usb_hcd_platform_shutdown,
468 .driver = {
469 .owner = THIS_MODULE,
470 .name = "s3c2410-ohci",
471 .pm = &ohci_hcd_s3c2410_pm_ops,
475 static int __init ohci_s3c2410_init(void)
477 if (usb_disabled())
478 return -ENODEV;
480 pr_info("%s: " DRIVER_DESC "\n", hcd_name);
481 ohci_init_driver(&ohci_s3c2410_hc_driver, NULL);
484 * The Samsung HW has some unusual quirks, which require
485 * Sumsung-specific workarounds. We override certain hc_driver
486 * functions here to achieve that. We explicitly do not enhance
487 * ohci_driver_overrides to allow this more easily, since this
488 * is an unusual case, and we don't want to encourage others to
489 * override these functions by making it too easy.
492 orig_ohci_hub_control = ohci_s3c2410_hc_driver.hub_control;
493 orig_ohci_hub_status_data = ohci_s3c2410_hc_driver.hub_status_data;
495 ohci_s3c2410_hc_driver.hub_status_data = ohci_s3c2410_hub_status_data;
496 ohci_s3c2410_hc_driver.hub_control = ohci_s3c2410_hub_control;
498 return platform_driver_register(&ohci_hcd_s3c2410_driver);
500 module_init(ohci_s3c2410_init);
502 static void __exit ohci_s3c2410_cleanup(void)
504 platform_driver_unregister(&ohci_hcd_s3c2410_driver);
506 module_exit(ohci_s3c2410_cleanup);
508 MODULE_DESCRIPTION(DRIVER_DESC);
509 MODULE_LICENSE("GPL");
510 MODULE_ALIAS("platform:s3c2410-ohci");