blkcg: fix blkg_alloc() failure path
[linux-2.6.git] / drivers / usb / host / ohci-ppc-of.c
blobe27d5ae2b9ebf12c4b124000e777545e2122fda8
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
7 * (C) Copyright 2006 Sylvain Munaut <tnt@246tNt.com>
9 * Bus glue for OHCI HC on the of_platform bus
11 * Modified for of_platform bus from ohci-sa1111.c
13 * This file is licenced under the GPL.
16 #include <linux/signal.h>
17 #include <linux/of_platform.h>
19 #include <asm/prom.h>
22 static int __devinit
23 ohci_ppc_of_start(struct usb_hcd *hcd)
25 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
26 int ret;
28 if ((ret = ohci_init(ohci)) < 0)
29 return ret;
31 if ((ret = ohci_run(ohci)) < 0) {
32 dev_err(hcd->self.controller, "can't start %s\n",
33 hcd->self.bus_name);
34 ohci_stop(hcd);
35 return ret;
38 return 0;
41 static const struct hc_driver ohci_ppc_of_hc_driver = {
42 .description = hcd_name,
43 .product_desc = "OF OHCI",
44 .hcd_priv_size = sizeof(struct ohci_hcd),
47 * generic hardware linkage
49 .irq = ohci_irq,
50 .flags = HCD_USB11 | HCD_MEMORY,
53 * basic lifecycle operations
55 .start = ohci_ppc_of_start,
56 .stop = ohci_stop,
57 .shutdown = ohci_shutdown,
60 * managing i/o requests and associated device resources
62 .urb_enqueue = ohci_urb_enqueue,
63 .urb_dequeue = ohci_urb_dequeue,
64 .endpoint_disable = ohci_endpoint_disable,
67 * scheduling support
69 .get_frame_number = ohci_get_frame,
72 * root hub support
74 .hub_status_data = ohci_hub_status_data,
75 .hub_control = ohci_hub_control,
76 #ifdef CONFIG_PM
77 .bus_suspend = ohci_bus_suspend,
78 .bus_resume = ohci_bus_resume,
79 #endif
80 .start_port_reset = ohci_start_port_reset,
84 static int __devinit ohci_hcd_ppc_of_probe(struct platform_device *op)
86 struct device_node *dn = op->dev.of_node;
87 struct usb_hcd *hcd;
88 struct ohci_hcd *ohci;
89 struct resource res;
90 int irq;
92 int rv;
93 int is_bigendian;
94 struct device_node *np;
96 if (usb_disabled())
97 return -ENODEV;
99 is_bigendian =
100 of_device_is_compatible(dn, "ohci-bigendian") ||
101 of_device_is_compatible(dn, "ohci-be");
103 dev_dbg(&op->dev, "initializing PPC-OF USB Controller\n");
105 rv = of_address_to_resource(dn, 0, &res);
106 if (rv)
107 return rv;
109 hcd = usb_create_hcd(&ohci_ppc_of_hc_driver, &op->dev, "PPC-OF USB");
110 if (!hcd)
111 return -ENOMEM;
113 hcd->rsrc_start = res.start;
114 hcd->rsrc_len = resource_size(&res);
116 if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {
117 printk(KERN_ERR "%s: request_mem_region failed\n", __FILE__);
118 rv = -EBUSY;
119 goto err_rmr;
122 irq = irq_of_parse_and_map(dn, 0);
123 if (irq == NO_IRQ) {
124 printk(KERN_ERR "%s: irq_of_parse_and_map failed\n", __FILE__);
125 rv = -EBUSY;
126 goto err_irq;
129 hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
130 if (!hcd->regs) {
131 printk(KERN_ERR "%s: ioremap failed\n", __FILE__);
132 rv = -ENOMEM;
133 goto err_ioremap;
136 ohci = hcd_to_ohci(hcd);
137 if (is_bigendian) {
138 ohci->flags |= OHCI_QUIRK_BE_MMIO | OHCI_QUIRK_BE_DESC;
139 if (of_device_is_compatible(dn, "fsl,mpc5200-ohci"))
140 ohci->flags |= OHCI_QUIRK_FRAME_NO;
141 if (of_device_is_compatible(dn, "mpc5200-ohci"))
142 ohci->flags |= OHCI_QUIRK_FRAME_NO;
145 ohci_hcd_init(ohci);
147 rv = usb_add_hcd(hcd, irq, 0);
148 if (rv == 0)
149 return 0;
151 /* by now, 440epx is known to show usb_23 erratum */
152 np = of_find_compatible_node(NULL, NULL, "ibm,usb-ehci-440epx");
154 /* Work around - At this point ohci_run has executed, the
155 * controller is running, everything, the root ports, etc., is
156 * set up. If the ehci driver is loaded, put the ohci core in
157 * the suspended state. The ehci driver will bring it out of
158 * suspended state when / if a non-high speed USB device is
159 * attached to the USB Host port. If the ehci driver is not
160 * loaded, do nothing. request_mem_region is used to test if
161 * the ehci driver is loaded.
163 if (np != NULL) {
164 if (!of_address_to_resource(np, 0, &res)) {
165 if (!request_mem_region(res.start, 0x4, hcd_name)) {
166 writel_be((readl_be(&ohci->regs->control) |
167 OHCI_USB_SUSPEND), &ohci->regs->control);
168 (void) readl_be(&ohci->regs->control);
169 } else
170 release_mem_region(res.start, 0x4);
171 } else
172 pr_debug("%s: cannot get ehci offset from fdt\n", __FILE__);
175 iounmap(hcd->regs);
176 err_ioremap:
177 irq_dispose_mapping(irq);
178 err_irq:
179 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
180 err_rmr:
181 usb_put_hcd(hcd);
183 return rv;
186 static int ohci_hcd_ppc_of_remove(struct platform_device *op)
188 struct usb_hcd *hcd = dev_get_drvdata(&op->dev);
189 dev_set_drvdata(&op->dev, NULL);
191 dev_dbg(&op->dev, "stopping PPC-OF USB Controller\n");
193 usb_remove_hcd(hcd);
195 iounmap(hcd->regs);
196 irq_dispose_mapping(hcd->irq);
197 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
199 usb_put_hcd(hcd);
201 return 0;
204 static void ohci_hcd_ppc_of_shutdown(struct platform_device *op)
206 struct usb_hcd *hcd = dev_get_drvdata(&op->dev);
208 if (hcd->driver->shutdown)
209 hcd->driver->shutdown(hcd);
213 static const struct of_device_id ohci_hcd_ppc_of_match[] = {
214 #ifdef CONFIG_USB_OHCI_HCD_PPC_OF_BE
216 .name = "usb",
217 .compatible = "ohci-bigendian",
220 .name = "usb",
221 .compatible = "ohci-be",
223 #endif
224 #ifdef CONFIG_USB_OHCI_HCD_PPC_OF_LE
226 .name = "usb",
227 .compatible = "ohci-littledian",
230 .name = "usb",
231 .compatible = "ohci-le",
233 #endif
236 MODULE_DEVICE_TABLE(of, ohci_hcd_ppc_of_match);
238 #if !defined(CONFIG_USB_OHCI_HCD_PPC_OF_BE) && \
239 !defined(CONFIG_USB_OHCI_HCD_PPC_OF_LE)
240 #error "No endianness selected for ppc-of-ohci"
241 #endif
244 static struct platform_driver ohci_hcd_ppc_of_driver = {
245 .probe = ohci_hcd_ppc_of_probe,
246 .remove = ohci_hcd_ppc_of_remove,
247 .shutdown = ohci_hcd_ppc_of_shutdown,
248 .driver = {
249 .name = "ppc-of-ohci",
250 .owner = THIS_MODULE,
251 .of_match_table = ohci_hcd_ppc_of_match,