Commit | Line | Data |
---|---|---|
6a6c957e GL |
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/ps3.h> | |
22 | ||
23 | static int ps3_ohci_hc_reset(struct usb_hcd *hcd) | |
24 | { | |
25 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | |
26 | ||
27 | ohci->flags |= OHCI_QUIRK_BE_MMIO; | |
28 | ohci_hcd_init(ohci); | |
29 | return ohci_init(ohci); | |
30 | } | |
31 | ||
32 | static int __devinit ps3_ohci_hc_start(struct usb_hcd *hcd) | |
33 | { | |
34 | int result; | |
35 | struct ohci_hcd *ohci = hcd_to_ohci(hcd); | |
36 | ||
37 | /* Handle root hub init quirk in spider south bridge. */ | |
38 | /* Also set PwrOn2PwrGood to 0x7f (254ms). */ | |
39 | ||
40 | ohci_writel(ohci, 0x7f000000 | RH_A_PSM | RH_A_OCPM, | |
41 | &ohci->regs->roothub.a); | |
42 | ohci_writel(ohci, 0x00060000, &ohci->regs->roothub.b); | |
43 | ||
44 | result = ohci_run(ohci); | |
45 | ||
46 | if (result < 0) { | |
47 | err("can't start %s", hcd->self.bus_name); | |
48 | ohci_stop(hcd); | |
49 | } | |
50 | ||
51 | return result; | |
52 | } | |
53 | ||
54 | static const struct hc_driver ps3_ohci_hc_driver = { | |
55 | .description = hcd_name, | |
56 | .product_desc = "PS3 OHCI Host Controller", | |
57 | .hcd_priv_size = sizeof(struct ohci_hcd), | |
58 | .irq = ohci_irq, | |
59 | .flags = HCD_MEMORY | HCD_USB11, | |
60 | .reset = ps3_ohci_hc_reset, | |
61 | .start = ps3_ohci_hc_start, | |
62 | .stop = ohci_stop, | |
63 | .shutdown = ohci_shutdown, | |
64 | .urb_enqueue = ohci_urb_enqueue, | |
65 | .urb_dequeue = ohci_urb_dequeue, | |
66 | .endpoint_disable = ohci_endpoint_disable, | |
67 | .get_frame_number = ohci_get_frame, | |
68 | .hub_status_data = ohci_hub_status_data, | |
69 | .hub_control = ohci_hub_control, | |
70 | .hub_irq_enable = ohci_rhsc_enable, | |
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 | ||
6a6c957e GL |
78 | static int ps3_ohci_sb_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_32BIT_MASK; | |
84 | ||
85 | if (usb_disabled()) { | |
86 | result = -ENODEV; | |
87 | goto fail_start; | |
88 | } | |
89 | ||
90 | result = ps3_mmio_region_create(dev->m_region); | |
91 | ||
92 | if (result) { | |
93 | dev_dbg(&dev->core, "%s:%d: ps3_map_mmio_region failed\n", | |
94 | __func__, __LINE__); | |
95 | result = -EPERM; | |
96 | goto fail_mmio; | |
97 | } | |
98 | ||
99 | dev_dbg(&dev->core, "%s:%d: mmio mapped_addr %lxh\n", __func__, | |
100 | __LINE__, dev->m_region->lpar_addr); | |
101 | ||
dc4f60c2 | 102 | result = ps3_io_irq_setup(PS3_BINDING_CPU_ANY, dev->interrupt_id, &virq); |
6a6c957e GL |
103 | |
104 | if (result) { | |
105 | dev_dbg(&dev->core, "%s:%d: ps3_construct_io_irq(%d) failed.\n", | |
106 | __func__, __LINE__, virq); | |
107 | result = -EPERM; | |
108 | goto fail_irq; | |
109 | } | |
110 | ||
111 | dev->core.power.power_state = PMSG_ON; | |
112 | dev->core.dma_mask = &dummy_mask; /* FIXME: for improper usb code */ | |
113 | ||
114 | hcd = usb_create_hcd(&ps3_ohci_hc_driver, &dev->core, dev->core.bus_id); | |
115 | ||
116 | if (!hcd) { | |
117 | dev_dbg(&dev->core, "%s:%d: usb_create_hcd failed\n", __func__, | |
118 | __LINE__); | |
119 | result = -ENOMEM; | |
120 | goto fail_create_hcd; | |
121 | } | |
122 | ||
123 | hcd->rsrc_start = dev->m_region->lpar_addr; | |
124 | hcd->rsrc_len = dev->m_region->len; | |
125 | hcd->regs = ioremap(dev->m_region->lpar_addr, dev->m_region->len); | |
126 | ||
127 | if (!hcd->regs) { | |
128 | dev_dbg(&dev->core, "%s:%d: ioremap failed\n", __func__, | |
129 | __LINE__); | |
130 | result = -EPERM; | |
131 | goto fail_ioremap; | |
132 | } | |
133 | ||
134 | dev_dbg(&dev->core, "%s:%d: hcd->rsrc_start %lxh\n", __func__, __LINE__, | |
135 | (unsigned long)hcd->rsrc_start); | |
136 | dev_dbg(&dev->core, "%s:%d: hcd->rsrc_len %lxh\n", __func__, __LINE__, | |
137 | (unsigned long)hcd->rsrc_len); | |
138 | dev_dbg(&dev->core, "%s:%d: hcd->regs %lxh\n", __func__, __LINE__, | |
139 | (unsigned long)hcd->regs); | |
140 | dev_dbg(&dev->core, "%s:%d: virq %lu\n", __func__, __LINE__, | |
141 | (unsigned long)virq); | |
142 | ||
143 | ps3_system_bus_set_driver_data(dev, hcd); | |
144 | ||
145 | result = usb_add_hcd(hcd, virq, IRQF_DISABLED); | |
146 | ||
147 | if (result) { | |
148 | dev_dbg(&dev->core, "%s:%d: usb_add_hcd failed (%d)\n", | |
149 | __func__, __LINE__, result); | |
150 | goto fail_add_hcd; | |
151 | } | |
152 | ||
153 | return result; | |
154 | ||
155 | fail_add_hcd: | |
156 | iounmap(hcd->regs); | |
157 | fail_ioremap: | |
158 | usb_put_hcd(hcd); | |
159 | fail_create_hcd: | |
dc4f60c2 | 160 | ps3_io_irq_destroy(virq); |
6a6c957e GL |
161 | fail_irq: |
162 | ps3_free_mmio_region(dev->m_region); | |
163 | fail_mmio: | |
164 | fail_start: | |
165 | return result; | |
166 | } | |
167 | ||
168 | static int ps3_ohci_sb_remove (struct ps3_system_bus_device *dev) | |
169 | { | |
170 | struct usb_hcd *hcd = | |
171 | (struct usb_hcd *)ps3_system_bus_get_driver_data(dev); | |
172 | ||
173 | usb_put_hcd(hcd); | |
174 | ps3_system_bus_set_driver_data(dev, NULL); | |
175 | ||
176 | return 0; | |
177 | } | |
178 | ||
179 | MODULE_ALIAS("ps3-ohci"); | |
180 | ||
181 | static struct ps3_system_bus_driver ps3_ohci_sb_driver = { | |
182 | .match_id = PS3_MATCH_ID_OHCI, | |
183 | .core = { | |
184 | .name = "ps3-ohci-driver", | |
185 | }, | |
186 | .probe = ps3_ohci_sb_probe, | |
187 | .remove = ps3_ohci_sb_remove, | |
188 | }; |