net: Fix thinko in backport of skb destructor fix.
[linux-2.6/mini2440.git] / drivers / usb / host / ehci-ppc-of.c
blob8b6556ef7687bace4e4a01f3fd06305c2169ca85
1 /*
2 * EHCI HCD (Host Controller Driver) for USB.
4 * Bus Glue for PPC On-Chip EHCI driver on the of_platform bus
5 * Tested on AMCC PPC 440EPx
7 * Valentine Barshak <vbarshak@ru.mvista.com>
9 * Based on "ehci-ppc-soc.c" by Stefan Roese <sr@denx.de>
10 * and "ohci-ppc-of.c" by Sylvain Munaut <tnt@246tNt.com>
12 * This file is licenced under the GPL.
15 #include <linux/signal.h>
17 #include <linux/of.h>
18 #include <linux/of_platform.h>
20 /* called during probe() after chip reset completes */
21 static int ehci_ppc_of_setup(struct usb_hcd *hcd)
23 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
24 int retval;
26 retval = ehci_halt(ehci);
27 if (retval)
28 return retval;
30 retval = ehci_init(hcd);
31 if (retval)
32 return retval;
34 ehci->sbrn = 0x20;
35 return ehci_reset(ehci);
39 static const struct hc_driver ehci_ppc_of_hc_driver = {
40 .description = hcd_name,
41 .product_desc = "OF EHCI",
42 .hcd_priv_size = sizeof(struct ehci_hcd),
45 * generic hardware linkage
47 .irq = ehci_irq,
48 .flags = HCD_MEMORY | HCD_USB2,
51 * basic lifecycle operations
53 .reset = ehci_ppc_of_setup,
54 .start = ehci_run,
55 .stop = ehci_stop,
56 .shutdown = ehci_shutdown,
59 * managing i/o requests and associated device resources
61 .urb_enqueue = ehci_urb_enqueue,
62 .urb_dequeue = ehci_urb_dequeue,
63 .endpoint_disable = ehci_endpoint_disable,
66 * scheduling support
68 .get_frame_number = ehci_get_frame,
71 * root hub support
73 .hub_status_data = ehci_hub_status_data,
74 .hub_control = ehci_hub_control,
75 #ifdef CONFIG_PM
76 .bus_suspend = ehci_bus_suspend,
77 .bus_resume = ehci_bus_resume,
78 #endif
79 .relinquish_port = ehci_relinquish_port,
80 .port_handed_over = ehci_port_handed_over,
82 .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
87 * 440EPx Errata USBH_3
88 * Fix: Enable Break Memory Transfer (BMT) in INSNREG3
90 #define PPC440EPX_EHCI0_INSREG_BMT (0x1 << 0)
91 static int __devinit
92 ppc44x_enable_bmt(struct device_node *dn)
94 __iomem u32 *insreg_virt;
96 insreg_virt = of_iomap(dn, 1);
97 if (!insreg_virt)
98 return -EINVAL;
100 out_be32(insreg_virt + 3, PPC440EPX_EHCI0_INSREG_BMT);
102 iounmap(insreg_virt);
103 return 0;
107 static int __devinit
108 ehci_hcd_ppc_of_probe(struct of_device *op, const struct of_device_id *match)
110 struct device_node *dn = op->node;
111 struct usb_hcd *hcd;
112 struct ehci_hcd *ehci = NULL;
113 struct resource res;
114 int irq;
115 int rv;
117 struct device_node *np;
119 if (usb_disabled())
120 return -ENODEV;
122 dev_dbg(&op->dev, "initializing PPC-OF USB Controller\n");
124 rv = of_address_to_resource(dn, 0, &res);
125 if (rv)
126 return rv;
128 hcd = usb_create_hcd(&ehci_ppc_of_hc_driver, &op->dev, "PPC-OF USB");
129 if (!hcd)
130 return -ENOMEM;
132 hcd->rsrc_start = res.start;
133 hcd->rsrc_len = res.end - res.start + 1;
135 if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {
136 printk(KERN_ERR __FILE__ ": request_mem_region failed\n");
137 rv = -EBUSY;
138 goto err_rmr;
141 irq = irq_of_parse_and_map(dn, 0);
142 if (irq == NO_IRQ) {
143 printk(KERN_ERR __FILE__ ": irq_of_parse_and_map failed\n");
144 rv = -EBUSY;
145 goto err_irq;
148 hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
149 if (!hcd->regs) {
150 printk(KERN_ERR __FILE__ ": ioremap failed\n");
151 rv = -ENOMEM;
152 goto err_ioremap;
155 ehci = hcd_to_ehci(hcd);
156 np = of_find_compatible_node(NULL, NULL, "ibm,usb-ohci-440epx");
157 if (np != NULL) {
158 /* claim we really affected by usb23 erratum */
159 if (!of_address_to_resource(np, 0, &res))
160 ehci->ohci_hcctrl_reg = ioremap(res.start +
161 OHCI_HCCTRL_OFFSET, OHCI_HCCTRL_LEN);
162 else
163 pr_debug(__FILE__ ": no ohci offset in fdt\n");
164 if (!ehci->ohci_hcctrl_reg) {
165 pr_debug(__FILE__ ": ioremap for ohci hcctrl failed\n");
166 } else {
167 ehci->has_amcc_usb23 = 1;
171 if (of_get_property(dn, "big-endian", NULL)) {
172 ehci->big_endian_mmio = 1;
173 ehci->big_endian_desc = 1;
175 if (of_get_property(dn, "big-endian-regs", NULL))
176 ehci->big_endian_mmio = 1;
177 if (of_get_property(dn, "big-endian-desc", NULL))
178 ehci->big_endian_desc = 1;
180 ehci->caps = hcd->regs;
181 ehci->regs = hcd->regs +
182 HC_LENGTH(ehci_readl(ehci, &ehci->caps->hc_capbase));
184 /* cache this readonly data; minimize chip reads */
185 ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);
187 if (of_device_is_compatible(dn, "ibm,usb-ehci-440epx")) {
188 rv = ppc44x_enable_bmt(dn);
189 ehci_dbg(ehci, "Break Memory Transfer (BMT) is %senabled!\n",
190 rv ? "NOT ": "");
193 rv = usb_add_hcd(hcd, irq, 0);
194 if (rv == 0)
195 return 0;
197 iounmap(hcd->regs);
198 err_ioremap:
199 irq_dispose_mapping(irq);
200 err_irq:
201 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
203 if (ehci->has_amcc_usb23)
204 iounmap(ehci->ohci_hcctrl_reg);
205 err_rmr:
206 usb_put_hcd(hcd);
208 return rv;
212 static int ehci_hcd_ppc_of_remove(struct of_device *op)
214 struct usb_hcd *hcd = dev_get_drvdata(&op->dev);
215 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
217 struct device_node *np;
218 struct resource res;
220 dev_set_drvdata(&op->dev, NULL);
222 dev_dbg(&op->dev, "stopping PPC-OF USB Controller\n");
224 usb_remove_hcd(hcd);
226 iounmap(hcd->regs);
227 irq_dispose_mapping(hcd->irq);
228 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
230 /* use request_mem_region to test if the ohci driver is loaded. if so
231 * ensure the ohci core is operational.
233 if (ehci->has_amcc_usb23) {
234 np = of_find_compatible_node(NULL, NULL, "ibm,usb-ohci-440epx");
235 if (np != NULL) {
236 if (!of_address_to_resource(np, 0, &res))
237 if (!request_mem_region(res.start,
238 0x4, hcd_name))
239 set_ohci_hcfs(ehci, 1);
240 else
241 release_mem_region(res.start, 0x4);
242 else
243 pr_debug(__FILE__ ": no ohci offset in fdt\n");
244 of_node_put(np);
247 iounmap(ehci->ohci_hcctrl_reg);
249 usb_put_hcd(hcd);
251 return 0;
255 static int ehci_hcd_ppc_of_shutdown(struct of_device *op)
257 struct usb_hcd *hcd = dev_get_drvdata(&op->dev);
259 if (hcd->driver->shutdown)
260 hcd->driver->shutdown(hcd);
262 return 0;
266 static struct of_device_id ehci_hcd_ppc_of_match[] = {
268 .compatible = "usb-ehci",
272 MODULE_DEVICE_TABLE(of, ehci_hcd_ppc_of_match);
275 static struct of_platform_driver ehci_hcd_ppc_of_driver = {
276 .name = "ppc-of-ehci",
277 .match_table = ehci_hcd_ppc_of_match,
278 .probe = ehci_hcd_ppc_of_probe,
279 .remove = ehci_hcd_ppc_of_remove,
280 .shutdown = ehci_hcd_ppc_of_shutdown,
281 .driver = {
282 .name = "ppc-of-ehci",
283 .owner = THIS_MODULE,