1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/kernel.h>
19#include <linux/init.h>
20#include <linux/module.h>
21#include <linux/uwb/umc.h>
22
23#include "../../wusbcore/wusbhc.h"
24
25#include "whcd.h"
26
27
28
29
30
31
32static int whc_reset(struct usb_hcd *usb_hcd)
33{
34 return 0;
35}
36
37
38
39
40
41
42
43
44static int whc_start(struct usb_hcd *usb_hcd)
45{
46 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
47 struct whc *whc = wusbhc_to_whc(wusbhc);
48 u8 bcid;
49 int ret;
50
51 mutex_lock(&wusbhc->mutex);
52
53 le_writel(WUSBINTR_GEN_CMD_DONE
54 | WUSBINTR_HOST_ERR
55 | WUSBINTR_ASYNC_SCHED_SYNCED
56 | WUSBINTR_DNTS_INT
57 | WUSBINTR_ERR_INT
58 | WUSBINTR_INT,
59 whc->base + WUSBINTR);
60
61
62 bcid = wusb_cluster_id_get();
63 ret = whc_set_cluster_id(whc, bcid);
64 if (ret < 0)
65 goto out;
66 wusbhc->cluster_id = bcid;
67
68
69 whc_write_wusbcmd(whc, WUSBCMD_RUN, WUSBCMD_RUN);
70
71 usb_hcd->uses_new_polling = 1;
72 set_bit(HCD_FLAG_POLL_RH, &usb_hcd->flags);
73 usb_hcd->state = HC_STATE_RUNNING;
74
75out:
76 mutex_unlock(&wusbhc->mutex);
77 return ret;
78}
79
80
81
82
83
84
85
86
87
88static void whc_stop(struct usb_hcd *usb_hcd)
89{
90 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
91 struct whc *whc = wusbhc_to_whc(wusbhc);
92
93 mutex_lock(&wusbhc->mutex);
94
95
96 le_writel(0, whc->base + WUSBINTR);
97 whc_write_wusbcmd(whc, WUSBCMD_RUN, 0);
98 whci_wait_for(&whc->umc->dev, whc->base + WUSBSTS,
99 WUSBSTS_HCHALTED, WUSBSTS_HCHALTED,
100 100, "HC to halt");
101
102 wusb_cluster_id_put(wusbhc->cluster_id);
103
104 mutex_unlock(&wusbhc->mutex);
105}
106
107static int whc_get_frame_number(struct usb_hcd *usb_hcd)
108{
109
110 return -ENOSYS;
111}
112
113
114
115
116
117static int whc_urb_enqueue(struct usb_hcd *usb_hcd, struct urb *urb,
118 gfp_t mem_flags)
119{
120 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
121 struct whc *whc = wusbhc_to_whc(wusbhc);
122 int ret;
123
124 switch (usb_pipetype(urb->pipe)) {
125 case PIPE_INTERRUPT:
126 ret = pzl_urb_enqueue(whc, urb, mem_flags);
127 break;
128 case PIPE_ISOCHRONOUS:
129 dev_err(&whc->umc->dev, "isochronous transfers unsupported\n");
130 ret = -ENOTSUPP;
131 break;
132 case PIPE_CONTROL:
133 case PIPE_BULK:
134 default:
135 ret = asl_urb_enqueue(whc, urb, mem_flags);
136 break;
137 }
138
139 return ret;
140}
141
142
143
144
145static int whc_urb_dequeue(struct usb_hcd *usb_hcd, struct urb *urb, int status)
146{
147 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
148 struct whc *whc = wusbhc_to_whc(wusbhc);
149 int ret;
150
151 switch (usb_pipetype(urb->pipe)) {
152 case PIPE_INTERRUPT:
153 ret = pzl_urb_dequeue(whc, urb, status);
154 break;
155 case PIPE_ISOCHRONOUS:
156 ret = -ENOTSUPP;
157 break;
158 case PIPE_CONTROL:
159 case PIPE_BULK:
160 default:
161 ret = asl_urb_dequeue(whc, urb, status);
162 break;
163 }
164
165 return ret;
166}
167
168
169
170
171
172static void whc_endpoint_disable(struct usb_hcd *usb_hcd,
173 struct usb_host_endpoint *ep)
174{
175 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
176 struct whc *whc = wusbhc_to_whc(wusbhc);
177 struct whc_qset *qset;
178
179 qset = ep->hcpriv;
180 if (qset) {
181 ep->hcpriv = NULL;
182 if (usb_endpoint_xfer_bulk(&ep->desc)
183 || usb_endpoint_xfer_control(&ep->desc))
184 asl_qset_delete(whc, qset);
185 else
186 pzl_qset_delete(whc, qset);
187 }
188}
189
190static void whc_endpoint_reset(struct usb_hcd *usb_hcd,
191 struct usb_host_endpoint *ep)
192{
193 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
194 struct whc *whc = wusbhc_to_whc(wusbhc);
195 struct whc_qset *qset;
196 unsigned long flags;
197
198 spin_lock_irqsave(&whc->lock, flags);
199
200 qset = ep->hcpriv;
201 if (qset) {
202 qset->remove = 1;
203 qset->reset = 1;
204
205 if (usb_endpoint_xfer_bulk(&ep->desc)
206 || usb_endpoint_xfer_control(&ep->desc))
207 queue_work(whc->workqueue, &whc->async_work);
208 else
209 queue_work(whc->workqueue, &whc->periodic_work);
210 }
211
212 spin_unlock_irqrestore(&whc->lock, flags);
213}
214
215
216static struct hc_driver whc_hc_driver = {
217 .description = "whci-hcd",
218 .product_desc = "Wireless host controller",
219 .hcd_priv_size = sizeof(struct whc) - sizeof(struct usb_hcd),
220 .irq = whc_int_handler,
221 .flags = HCD_USB2,
222
223 .reset = whc_reset,
224 .start = whc_start,
225 .stop = whc_stop,
226 .get_frame_number = whc_get_frame_number,
227 .urb_enqueue = whc_urb_enqueue,
228 .urb_dequeue = whc_urb_dequeue,
229 .endpoint_disable = whc_endpoint_disable,
230 .endpoint_reset = whc_endpoint_reset,
231
232 .hub_status_data = wusbhc_rh_status_data,
233 .hub_control = wusbhc_rh_control,
234 .start_port_reset = wusbhc_rh_start_port_reset,
235};
236
237static int whc_probe(struct umc_dev *umc)
238{
239 int ret;
240 struct usb_hcd *usb_hcd;
241 struct wusbhc *wusbhc;
242 struct whc *whc;
243 struct device *dev = &umc->dev;
244
245 usb_hcd = usb_create_hcd(&whc_hc_driver, dev, "whci");
246 if (usb_hcd == NULL) {
247 dev_err(dev, "unable to create hcd\n");
248 return -ENOMEM;
249 }
250
251 usb_hcd->wireless = 1;
252 usb_hcd->self.sg_tablesize = 2048;
253
254 wusbhc = usb_hcd_to_wusbhc(usb_hcd);
255 whc = wusbhc_to_whc(wusbhc);
256 whc->umc = umc;
257
258 ret = whc_init(whc);
259 if (ret)
260 goto error_whc_init;
261
262 wusbhc->dev = dev;
263 wusbhc->uwb_rc = uwb_rc_get_by_grandpa(umc->dev.parent);
264 if (!wusbhc->uwb_rc) {
265 ret = -ENODEV;
266 dev_err(dev, "cannot get radio controller\n");
267 goto error_uwb_rc;
268 }
269
270 if (whc->n_devices > USB_MAXCHILDREN) {
271 dev_warn(dev, "USB_MAXCHILDREN too low for WUSB adapter (%u ports)\n",
272 whc->n_devices);
273 wusbhc->ports_max = USB_MAXCHILDREN;
274 } else
275 wusbhc->ports_max = whc->n_devices;
276 wusbhc->mmcies_max = whc->n_mmc_ies;
277 wusbhc->start = whc_wusbhc_start;
278 wusbhc->stop = whc_wusbhc_stop;
279 wusbhc->mmcie_add = whc_mmcie_add;
280 wusbhc->mmcie_rm = whc_mmcie_rm;
281 wusbhc->dev_info_set = whc_dev_info_set;
282 wusbhc->bwa_set = whc_bwa_set;
283 wusbhc->set_num_dnts = whc_set_num_dnts;
284 wusbhc->set_ptk = whc_set_ptk;
285 wusbhc->set_gtk = whc_set_gtk;
286
287 ret = wusbhc_create(wusbhc);
288 if (ret)
289 goto error_wusbhc_create;
290
291 ret = usb_add_hcd(usb_hcd, whc->umc->irq, IRQF_SHARED);
292 if (ret) {
293 dev_err(dev, "cannot add HCD: %d\n", ret);
294 goto error_usb_add_hcd;
295 }
296 device_wakeup_enable(usb_hcd->self.controller);
297
298 ret = wusbhc_b_create(wusbhc);
299 if (ret) {
300 dev_err(dev, "WUSBHC phase B setup failed: %d\n", ret);
301 goto error_wusbhc_b_create;
302 }
303
304 whc_dbg_init(whc);
305
306 return 0;
307
308error_wusbhc_b_create:
309 usb_remove_hcd(usb_hcd);
310error_usb_add_hcd:
311 wusbhc_destroy(wusbhc);
312error_wusbhc_create:
313 uwb_rc_put(wusbhc->uwb_rc);
314error_uwb_rc:
315 whc_clean_up(whc);
316error_whc_init:
317 usb_put_hcd(usb_hcd);
318 return ret;
319}
320
321
322static void whc_remove(struct umc_dev *umc)
323{
324 struct usb_hcd *usb_hcd = dev_get_drvdata(&umc->dev);
325 struct wusbhc *wusbhc = usb_hcd_to_wusbhc(usb_hcd);
326 struct whc *whc = wusbhc_to_whc(wusbhc);
327
328 if (usb_hcd) {
329 whc_dbg_clean_up(whc);
330 wusbhc_b_destroy(wusbhc);
331 usb_remove_hcd(usb_hcd);
332 wusbhc_destroy(wusbhc);
333 uwb_rc_put(wusbhc->uwb_rc);
334 whc_clean_up(whc);
335 usb_put_hcd(usb_hcd);
336 }
337}
338
339static struct umc_driver whci_hc_driver = {
340 .name = "whci-hcd",
341 .cap_id = UMC_CAP_ID_WHCI_WUSB_HC,
342 .probe = whc_probe,
343 .remove = whc_remove,
344};
345
346static int __init whci_hc_driver_init(void)
347{
348 return umc_driver_register(&whci_hc_driver);
349}
350module_init(whci_hc_driver_init);
351
352static void __exit whci_hc_driver_exit(void)
353{
354 umc_driver_unregister(&whci_hc_driver);
355}
356module_exit(whci_hc_driver_exit);
357
358
359static struct pci_device_id __used whci_hcd_id_table[] = {
360 { PCI_DEVICE_CLASS(PCI_CLASS_WIRELESS_WHCI, ~0) },
361 { }
362};
363MODULE_DEVICE_TABLE(pci, whci_hcd_id_table);
364
365MODULE_DESCRIPTION("WHCI Wireless USB host controller driver");
366MODULE_AUTHOR("Cambridge Silicon Radio Ltd.");
367MODULE_LICENSE("GPL");
368