ohci-ps3.c revision 03fa68c245cccbcb99035cbabaa13b408ba91ab5
1/*
2 *  PS3 OHCI Host Controller driver
3 *
4 *  Copyright (C) 2006 Sony Computer Entertainment Inc.
5 *  Copyright 2006 Sony Corp.
6 *
7 *  This program is free software; you can redistribute it and/or modify
8 *  it under the terms of the GNU General Public License as published by
9 *  the Free Software Foundation; version 2 of the License.
10 *
11 *  This program is distributed in the hope that it will be useful,
12 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14 *  GNU General Public License for more details.
15 *
16 *  You should have received a copy of the GNU General Public License
17 *  along with this program; if not, write to the Free Software
18 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
19 */
20
21#include <asm/firmware.h>
22#include <asm/ps3.h>
23
24static int ps3_ohci_hc_reset(struct usb_hcd *hcd)
25{
26	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
27
28	ohci->flags |= OHCI_QUIRK_BE_MMIO;
29	ohci_hcd_init(ohci);
30	return ohci_init(ohci);
31}
32
33static int __devinit ps3_ohci_hc_start(struct usb_hcd *hcd)
34{
35	int result;
36	struct ohci_hcd *ohci = hcd_to_ohci(hcd);
37
38	/* Handle root hub init quirk in spider south bridge. */
39	/* Also set PwrOn2PwrGood to 0x7f (254ms). */
40
41	ohci_writel(ohci, 0x7f000000 | RH_A_PSM | RH_A_OCPM,
42		&ohci->regs->roothub.a);
43	ohci_writel(ohci, 0x00060000, &ohci->regs->roothub.b);
44
45	result = ohci_run(ohci);
46
47	if (result < 0) {
48		err("can't start %s", hcd->self.bus_name);
49		ohci_stop(hcd);
50	}
51
52	return result;
53}
54
55static const struct hc_driver ps3_ohci_hc_driver = {
56	.description		= hcd_name,
57	.product_desc		= "PS3 OHCI Host Controller",
58	.hcd_priv_size		= sizeof(struct ohci_hcd),
59	.irq			= ohci_irq,
60	.flags			= HCD_MEMORY | HCD_USB11,
61	.reset			= ps3_ohci_hc_reset,
62	.start			= ps3_ohci_hc_start,
63	.stop			= ohci_stop,
64	.shutdown		= ohci_shutdown,
65	.urb_enqueue		= ohci_urb_enqueue,
66	.urb_dequeue		= ohci_urb_dequeue,
67	.endpoint_disable	= ohci_endpoint_disable,
68	.get_frame_number	= ohci_get_frame,
69	.hub_status_data	= ohci_hub_status_data,
70	.hub_control		= ohci_hub_control,
71	.start_port_reset	= ohci_start_port_reset,
72#if defined(CONFIG_PM)
73	.bus_suspend 		= ohci_bus_suspend,
74	.bus_resume 		= ohci_bus_resume,
75#endif
76};
77
78static int ps3_ohci_probe(struct ps3_system_bus_device *dev)
79{
80	int result;
81	struct usb_hcd *hcd;
82	unsigned int virq;
83	static u64 dummy_mask = DMA_BIT_MASK(32);
84
85	if (usb_disabled()) {
86		result = -ENODEV;
87		goto fail_start;
88	}
89
90	result = ps3_open_hv_device(dev);
91
92	if (result) {
93		dev_dbg(&dev->core, "%s:%d: ps3_open_hv_device failed: %s\n",
94			__func__, __LINE__, ps3_result(result));
95		result = -EPERM;
96		goto fail_open;
97	}
98
99	result = ps3_dma_region_create(dev->d_region);
100
101	if (result) {
102		dev_dbg(&dev->core, "%s:%d: ps3_dma_region_create failed: "
103			"(%d)\n", __func__, __LINE__, result);
104		BUG_ON("check region type");
105		goto fail_dma_region;
106	}
107
108	result = ps3_mmio_region_create(dev->m_region);
109
110	if (result) {
111		dev_dbg(&dev->core, "%s:%d: ps3_map_mmio_region failed\n",
112			__func__, __LINE__);
113		result = -EPERM;
114		goto fail_mmio_region;
115	}
116
117	dev_dbg(&dev->core, "%s:%d: mmio mapped_addr %lxh\n", __func__,
118		__LINE__, dev->m_region->lpar_addr);
119
120	result = ps3_io_irq_setup(PS3_BINDING_CPU_ANY, dev->interrupt_id, &virq);
121
122	if (result) {
123		dev_dbg(&dev->core, "%s:%d: ps3_construct_io_irq(%d) failed.\n",
124			__func__, __LINE__, virq);
125		result = -EPERM;
126		goto fail_irq;
127	}
128
129	dev->core.dma_mask = &dummy_mask; /* FIXME: for improper usb code */
130
131	hcd = usb_create_hcd(&ps3_ohci_hc_driver, &dev->core, dev_name(&dev->core));
132
133	if (!hcd) {
134		dev_dbg(&dev->core, "%s:%d: usb_create_hcd failed\n", __func__,
135			__LINE__);
136		result = -ENOMEM;
137		goto fail_create_hcd;
138	}
139
140	hcd->rsrc_start = dev->m_region->lpar_addr;
141	hcd->rsrc_len = dev->m_region->len;
142
143	if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name))
144		dev_dbg(&dev->core, "%s:%d: request_mem_region failed\n",
145			__func__, __LINE__);
146
147	hcd->regs = ioremap(dev->m_region->lpar_addr, dev->m_region->len);
148
149	if (!hcd->regs) {
150		dev_dbg(&dev->core, "%s:%d: ioremap failed\n", __func__,
151			__LINE__);
152		result = -EPERM;
153		goto fail_ioremap;
154	}
155
156	dev_dbg(&dev->core, "%s:%d: hcd->rsrc_start %lxh\n", __func__, __LINE__,
157		(unsigned long)hcd->rsrc_start);
158	dev_dbg(&dev->core, "%s:%d: hcd->rsrc_len   %lxh\n", __func__, __LINE__,
159		(unsigned long)hcd->rsrc_len);
160	dev_dbg(&dev->core, "%s:%d: hcd->regs       %lxh\n", __func__, __LINE__,
161		(unsigned long)hcd->regs);
162	dev_dbg(&dev->core, "%s:%d: virq            %lu\n", __func__, __LINE__,
163		(unsigned long)virq);
164
165	ps3_system_bus_set_drvdata(dev, hcd);
166
167	result = usb_add_hcd(hcd, virq, IRQF_DISABLED);
168
169	if (result) {
170		dev_dbg(&dev->core, "%s:%d: usb_add_hcd failed (%d)\n",
171			__func__, __LINE__, result);
172		goto fail_add_hcd;
173	}
174
175	return result;
176
177fail_add_hcd:
178	iounmap(hcd->regs);
179fail_ioremap:
180	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
181	usb_put_hcd(hcd);
182fail_create_hcd:
183	ps3_io_irq_destroy(virq);
184fail_irq:
185	ps3_free_mmio_region(dev->m_region);
186fail_mmio_region:
187	ps3_dma_region_free(dev->d_region);
188fail_dma_region:
189	ps3_close_hv_device(dev);
190fail_open:
191fail_start:
192	return result;
193}
194
195static int ps3_ohci_remove(struct ps3_system_bus_device *dev)
196{
197	unsigned int tmp;
198	struct usb_hcd *hcd = ps3_system_bus_get_drvdata(dev);
199
200	BUG_ON(!hcd);
201
202	dev_dbg(&dev->core, "%s:%d: regs %p\n", __func__, __LINE__, hcd->regs);
203	dev_dbg(&dev->core, "%s:%d: irq %u\n", __func__, __LINE__, hcd->irq);
204
205	tmp = hcd->irq;
206
207	ohci_shutdown(hcd);
208	usb_remove_hcd(hcd);
209
210	ps3_system_bus_set_drvdata(dev, NULL);
211
212	BUG_ON(!hcd->regs);
213	iounmap(hcd->regs);
214
215	release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
216	usb_put_hcd(hcd);
217
218	ps3_io_irq_destroy(tmp);
219	ps3_free_mmio_region(dev->m_region);
220
221	ps3_dma_region_free(dev->d_region);
222	ps3_close_hv_device(dev);
223
224	return 0;
225}
226
227static int ps3_ohci_driver_register(struct ps3_system_bus_driver *drv)
228{
229	return firmware_has_feature(FW_FEATURE_PS3_LV1)
230		? ps3_system_bus_driver_register(drv)
231		: 0;
232}
233
234static void ps3_ohci_driver_unregister(struct ps3_system_bus_driver *drv)
235{
236	if (firmware_has_feature(FW_FEATURE_PS3_LV1))
237		ps3_system_bus_driver_unregister(drv);
238}
239
240MODULE_ALIAS(PS3_MODULE_ALIAS_OHCI);
241
242static struct ps3_system_bus_driver ps3_ohci_driver = {
243	.core.name = "ps3-ohci-driver",
244	.core.owner = THIS_MODULE,
245	.match_id = PS3_MATCH_ID_OHCI,
246	.probe = ps3_ohci_probe,
247	.remove = ps3_ohci_remove,
248	.shutdown = ps3_ohci_remove,
249};
250