]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blob - drivers/bluetooth/btusb.c
projects / mirror_ubuntu-zesty-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
iscsi-target: Fix sendpage breakage with proper padding+DataDigest iovec offsets
[mirror_ubuntu-zesty-kernel.git] / drivers / bluetooth / btusb.c
1 /*
2 *
3 * Generic Bluetooth USB driver
4 *
5 * Copyright (C) 2005-2008 Marcel Holtmann <marcel@holtmann.org>
6 *
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 *
22 */
23
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/init.h>
27 #include <linux/slab.h>
28 #include <linux/types.h>
29 #include <linux/sched.h>
30 #include <linux/errno.h>
31 #include <linux/skbuff.h>
32
33 #include <linux/usb.h>
34
35 #include <net/bluetooth/bluetooth.h>
36 #include <net/bluetooth/hci_core.h>
37
38 #define VERSION "0.6"
39
40 static int ignore_dga;
41 static int ignore_csr;
42 static int ignore_sniffer;
43 static int disable_scofix;
44 static int force_scofix;
45
46 static int reset = 1;
47
48 static struct usb_driver btusb_driver;
49
50 #define BTUSB_IGNORE 0x01
51 #define BTUSB_DIGIANSWER 0x02
52 #define BTUSB_CSR 0x04
53 #define BTUSB_SNIFFER 0x08
54 #define BTUSB_BCM92035 0x10
55 #define BTUSB_BROKEN_ISOC 0x20
56 #define BTUSB_WRONG_SCO_MTU 0x40
57 #define BTUSB_ATH3012 0x80
58
59 static struct usb_device_id btusb_table[] = {
60 /* Generic Bluetooth USB device */
61 { USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
62
63 /* Apple MacBookPro 7,1 */
64 { USB_DEVICE(0x05ac, 0x8213) },
65
66 /* Apple iMac11,1 */
67 { USB_DEVICE(0x05ac, 0x8215) },
68
69 /* Apple MacBookPro6,2 */
70 { USB_DEVICE(0x05ac, 0x8218) },
71
72 /* Apple MacBookAir3,1, MacBookAir3,2 */
73 { USB_DEVICE(0x05ac, 0x821b) },
74
75 /* Apple MacBookPro8,2 */
76 { USB_DEVICE(0x05ac, 0x821a) },
77
78 /* AVM BlueFRITZ! USB v2.0 */
79 { USB_DEVICE(0x057c, 0x3800) },
80
81 /* Bluetooth Ultraport Module from IBM */
82 { USB_DEVICE(0x04bf, 0x030a) },
83
84 /* ALPS Modules with non-standard id */
85 { USB_DEVICE(0x044e, 0x3001) },
86 { USB_DEVICE(0x044e, 0x3002) },
87
88 /* Ericsson with non-standard id */
89 { USB_DEVICE(0x0bdb, 0x1002) },
90
91 /* Canyon CN-BTU1 with HID interfaces */
92 { USB_DEVICE(0x0c10, 0x0000) },
93
94 { } /* Terminating entry */
95 };
96
97 MODULE_DEVICE_TABLE(usb, btusb_table);
98
99 static struct usb_device_id blacklist_table[] = {
100 /* CSR BlueCore devices */
101 { USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
102
103 /* Broadcom BCM2033 without firmware */
104 { USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
105
106 /* Atheros 3011 with sflash firmware */
107 { USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
108 { USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
109 { USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
110
111 /* Atheros AR9285 Malbec with sflash firmware */
112 { USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
113
114 /* Atheros 3012 with sflash firmware */
115 { USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
116
117 /* Atheros AR5BBU12 with sflash firmware */
118 { USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
119
120 /* Broadcom BCM2035 */
121 { USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
122 { USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
123 { USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
124
125 /* Broadcom BCM2045 */
126 { USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
127 { USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
128
129 /* IBM/Lenovo ThinkPad with Broadcom chip */
130 { USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
131 { USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
132
133 /* HP laptop with Broadcom chip */
134 { USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
135
136 /* Dell laptop with Broadcom chip */
137 { USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
138
139 /* Dell Wireless 370 and 410 devices */
140 { USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
141 { USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
142
143 /* Belkin F8T012 and F8T013 devices */
144 { USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
145 { USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
146
147 /* Asus WL-BTD202 device */
148 { USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
149
150 /* Kensington Bluetooth USB adapter */
151 { USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
152
153 /* RTX Telecom based adapters with buggy SCO support */
154 { USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
155 { USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
156
157 /* CONWISE Technology based adapters with buggy SCO support */
158 { USB_DEVICE(0x0e5e, 0x6622), .driver_info = BTUSB_BROKEN_ISOC },
159
160 /* Digianswer devices */
161 { USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
162 { USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
163
164 /* CSR BlueCore Bluetooth Sniffer */
165 { USB_DEVICE(0x0a12, 0x0002), .driver_info = BTUSB_SNIFFER },
166
167 /* Frontline ComProbe Bluetooth Sniffer */
168 { USB_DEVICE(0x16d3, 0x0002), .driver_info = BTUSB_SNIFFER },
169
170 { } /* Terminating entry */
171 };
172
173 #define BTUSB_MAX_ISOC_FRAMES 10
174
175 #define BTUSB_INTR_RUNNING 0
176 #define BTUSB_BULK_RUNNING 1
177 #define BTUSB_ISOC_RUNNING 2
178 #define BTUSB_SUSPENDING 3
179 #define BTUSB_DID_ISO_RESUME 4
180
181 struct btusb_data {
182 struct hci_dev *hdev;
183 struct usb_device *udev;
184 struct usb_interface *intf;
185 struct usb_interface *isoc;
186
187 spinlock_t lock;
188
189 unsigned long flags;
190
191 struct work_struct work;
192 struct work_struct waker;
193
194 struct usb_anchor tx_anchor;
195 struct usb_anchor intr_anchor;
196 struct usb_anchor bulk_anchor;
197 struct usb_anchor isoc_anchor;
198 struct usb_anchor deferred;
199 int tx_in_flight;
200 spinlock_t txlock;
201
202 struct usb_endpoint_descriptor *intr_ep;
203 struct usb_endpoint_descriptor *bulk_tx_ep;
204 struct usb_endpoint_descriptor *bulk_rx_ep;
205 struct usb_endpoint_descriptor *isoc_tx_ep;
206 struct usb_endpoint_descriptor *isoc_rx_ep;
207
208 __u8 cmdreq_type;
209
210 unsigned int sco_num;
211 int isoc_altsetting;
212 int suspend_count;
213 };
214
215 static int inc_tx(struct btusb_data *data)
216 {
217 unsigned long flags;
218 int rv;
219
220 spin_lock_irqsave(&data->txlock, flags);
221 rv = test_bit(BTUSB_SUSPENDING, &data->flags);
222 if (!rv)
223 data->tx_in_flight++;
224 spin_unlock_irqrestore(&data->txlock, flags);
225
226 return rv;
227 }
228
229 static void btusb_intr_complete(struct urb *urb)
230 {
231 struct hci_dev *hdev = urb->context;
232 struct btusb_data *data = hdev->driver_data;
233 int err;
234
235 BT_DBG("%s urb %p status %d count %d", hdev->name,
236 urb, urb->status, urb->actual_length);
237
238 if (!test_bit(HCI_RUNNING, &hdev->flags))
239 return;
240
241 if (urb->status == 0) {
242 hdev->stat.byte_rx += urb->actual_length;
243
244 if (hci_recv_fragment(hdev, HCI_EVENT_PKT,
245 urb->transfer_buffer,
246 urb->actual_length) < 0) {
247 BT_ERR("%s corrupted event packet", hdev->name);
248 hdev->stat.err_rx++;
249 }
250 }
251
252 if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
253 return;
254
255 usb_mark_last_busy(data->udev);
256 usb_anchor_urb(urb, &data->intr_anchor);
257
258 err = usb_submit_urb(urb, GFP_ATOMIC);
259 if (err < 0) {
260 /* -EPERM: urb is being killed;
261 * -ENODEV: device got disconnected */
262 if (err != -EPERM && err != -ENODEV)
263 BT_ERR("%s urb %p failed to resubmit (%d)",
264 hdev->name, urb, -err);
265 usb_unanchor_urb(urb);
266 }
267 }
268
269 static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
270 {
271 struct btusb_data *data = hdev->driver_data;
272 struct urb *urb;
273 unsigned char *buf;
274 unsigned int pipe;
275 int err, size;
276
277 BT_DBG("%s", hdev->name);
278
279 if (!data->intr_ep)
280 return -ENODEV;
281
282 urb = usb_alloc_urb(0, mem_flags);
283 if (!urb)
284 return -ENOMEM;
285
286 size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
287
288 buf = kmalloc(size, mem_flags);
289 if (!buf) {
290 usb_free_urb(urb);
291 return -ENOMEM;
292 }
293
294 pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
295
296 usb_fill_int_urb(urb, data->udev, pipe, buf, size,
297 btusb_intr_complete, hdev,
298 data->intr_ep->bInterval);
299
300 urb->transfer_flags |= URB_FREE_BUFFER;
301
302 usb_anchor_urb(urb, &data->intr_anchor);
303
304 err = usb_submit_urb(urb, mem_flags);
305 if (err < 0) {
306 BT_ERR("%s urb %p submission failed (%d)",
307 hdev->name, urb, -err);
308 usb_unanchor_urb(urb);
309 }
310
311 usb_free_urb(urb);
312
313 return err;
314 }
315
316 static void btusb_bulk_complete(struct urb *urb)
317 {
318 struct hci_dev *hdev = urb->context;
319 struct btusb_data *data = hdev->driver_data;
320 int err;
321
322 BT_DBG("%s urb %p status %d count %d", hdev->name,
323 urb, urb->status, urb->actual_length);
324
325 if (!test_bit(HCI_RUNNING, &hdev->flags))
326 return;
327
328 if (urb->status == 0) {
329 hdev->stat.byte_rx += urb->actual_length;
330
331 if (hci_recv_fragment(hdev, HCI_ACLDATA_PKT,
332 urb->transfer_buffer,
333 urb->actual_length) < 0) {
334 BT_ERR("%s corrupted ACL packet", hdev->name);
335 hdev->stat.err_rx++;
336 }
337 }
338
339 if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
340 return;
341
342 usb_anchor_urb(urb, &data->bulk_anchor);
343 usb_mark_last_busy(data->udev);
344
345 err = usb_submit_urb(urb, GFP_ATOMIC);
346 if (err < 0) {
347 /* -EPERM: urb is being killed;
348 * -ENODEV: device got disconnected */
349 if (err != -EPERM && err != -ENODEV)
350 BT_ERR("%s urb %p failed to resubmit (%d)",
351 hdev->name, urb, -err);
352 usb_unanchor_urb(urb);
353 }
354 }
355
356 static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
357 {
358 struct btusb_data *data = hdev->driver_data;
359 struct urb *urb;
360 unsigned char *buf;
361 unsigned int pipe;
362 int err, size = HCI_MAX_FRAME_SIZE;
363
364 BT_DBG("%s", hdev->name);
365
366 if (!data->bulk_rx_ep)
367 return -ENODEV;
368
369 urb = usb_alloc_urb(0, mem_flags);
370 if (!urb)
371 return -ENOMEM;
372
373 buf = kmalloc(size, mem_flags);
374 if (!buf) {
375 usb_free_urb(urb);
376 return -ENOMEM;
377 }
378
379 pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
380
381 usb_fill_bulk_urb(urb, data->udev, pipe,
382 buf, size, btusb_bulk_complete, hdev);
383
384 urb->transfer_flags |= URB_FREE_BUFFER;
385
386 usb_mark_last_busy(data->udev);
387 usb_anchor_urb(urb, &data->bulk_anchor);
388
389 err = usb_submit_urb(urb, mem_flags);
390 if (err < 0) {
391 BT_ERR("%s urb %p submission failed (%d)",
392 hdev->name, urb, -err);
393 usb_unanchor_urb(urb);
394 }
395
396 usb_free_urb(urb);
397
398 return err;
399 }
400
401 static void btusb_isoc_complete(struct urb *urb)
402 {
403 struct hci_dev *hdev = urb->context;
404 struct btusb_data *data = hdev->driver_data;
405 int i, err;
406
407 BT_DBG("%s urb %p status %d count %d", hdev->name,
408 urb, urb->status, urb->actual_length);
409
410 if (!test_bit(HCI_RUNNING, &hdev->flags))
411 return;
412
413 if (urb->status == 0) {
414 for (i = 0; i < urb->number_of_packets; i++) {
415 unsigned int offset = urb->iso_frame_desc[i].offset;
416 unsigned int length = urb->iso_frame_desc[i].actual_length;
417
418 if (urb->iso_frame_desc[i].status)
419 continue;
420
421 hdev->stat.byte_rx += length;
422
423 if (hci_recv_fragment(hdev, HCI_SCODATA_PKT,
424 urb->transfer_buffer + offset,
425 length) < 0) {
426 BT_ERR("%s corrupted SCO packet", hdev->name);
427 hdev->stat.err_rx++;
428 }
429 }
430 }
431
432 if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
433 return;
434
435 usb_anchor_urb(urb, &data->isoc_anchor);
436
437 err = usb_submit_urb(urb, GFP_ATOMIC);
438 if (err < 0) {
439 /* -EPERM: urb is being killed;
440 * -ENODEV: device got disconnected */
441 if (err != -EPERM && err != -ENODEV)
442 BT_ERR("%s urb %p failed to resubmit (%d)",
443 hdev->name, urb, -err);
444 usb_unanchor_urb(urb);
445 }
446 }
447
448 static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
449 {
450 int i, offset = 0;
451
452 BT_DBG("len %d mtu %d", len, mtu);
453
454 for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
455 i++, offset += mtu, len -= mtu) {
456 urb->iso_frame_desc[i].offset = offset;
457 urb->iso_frame_desc[i].length = mtu;
458 }
459
460 if (len && i < BTUSB_MAX_ISOC_FRAMES) {
461 urb->iso_frame_desc[i].offset = offset;
462 urb->iso_frame_desc[i].length = len;
463 i++;
464 }
465
466 urb->number_of_packets = i;
467 }
468
469 static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
470 {
471 struct btusb_data *data = hdev->driver_data;
472 struct urb *urb;
473 unsigned char *buf;
474 unsigned int pipe;
475 int err, size;
476
477 BT_DBG("%s", hdev->name);
478
479 if (!data->isoc_rx_ep)
480 return -ENODEV;
481
482 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
483 if (!urb)
484 return -ENOMEM;
485
486 size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
487 BTUSB_MAX_ISOC_FRAMES;
488
489 buf = kmalloc(size, mem_flags);
490 if (!buf) {
491 usb_free_urb(urb);
492 return -ENOMEM;
493 }
494
495 pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
496
497 urb->dev = data->udev;
498 urb->pipe = pipe;
499 urb->context = hdev;
500 urb->complete = btusb_isoc_complete;
501 urb->interval = data->isoc_rx_ep->bInterval;
502
503 urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
504 urb->transfer_buffer = buf;
505 urb->transfer_buffer_length = size;
506
507 __fill_isoc_descriptor(urb, size,
508 le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
509
510 usb_anchor_urb(urb, &data->isoc_anchor);
511
512 err = usb_submit_urb(urb, mem_flags);
513 if (err < 0) {
514 BT_ERR("%s urb %p submission failed (%d)",
515 hdev->name, urb, -err);
516 usb_unanchor_urb(urb);
517 }
518
519 usb_free_urb(urb);
520
521 return err;
522 }
523
524 static void btusb_tx_complete(struct urb *urb)
525 {
526 struct sk_buff *skb = urb->context;
527 struct hci_dev *hdev = (struct hci_dev *) skb->dev;
528 struct btusb_data *data = hdev->driver_data;
529
530 BT_DBG("%s urb %p status %d count %d", hdev->name,
531 urb, urb->status, urb->actual_length);
532
533 if (!test_bit(HCI_RUNNING, &hdev->flags))
534 goto done;
535
536 if (!urb->status)
537 hdev->stat.byte_tx += urb->transfer_buffer_length;
538 else
539 hdev->stat.err_tx++;
540
541 done:
542 spin_lock(&data->txlock);
543 data->tx_in_flight--;
544 spin_unlock(&data->txlock);
545
546 kfree(urb->setup_packet);
547
548 kfree_skb(skb);
549 }
550
551 static void btusb_isoc_tx_complete(struct urb *urb)
552 {
553 struct sk_buff *skb = urb->context;
554 struct hci_dev *hdev = (struct hci_dev *) skb->dev;
555
556 BT_DBG("%s urb %p status %d count %d", hdev->name,
557 urb, urb->status, urb->actual_length);
558
559 if (!test_bit(HCI_RUNNING, &hdev->flags))
560 goto done;
561
562 if (!urb->status)
563 hdev->stat.byte_tx += urb->transfer_buffer_length;
564 else
565 hdev->stat.err_tx++;
566
567 done:
568 kfree(urb->setup_packet);
569
570 kfree_skb(skb);
571 }
572
573 static int btusb_open(struct hci_dev *hdev)
574 {
575 struct btusb_data *data = hdev->driver_data;
576 int err;
577
578 BT_DBG("%s", hdev->name);
579
580 err = usb_autopm_get_interface(data->intf);
581 if (err < 0)
582 return err;
583
584 data->intf->needs_remote_wakeup = 1;
585
586 if (test_and_set_bit(HCI_RUNNING, &hdev->flags))
587 goto done;
588
589 if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
590 goto done;
591
592 err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
593 if (err < 0)
594 goto failed;
595
596 err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
597 if (err < 0) {
598 usb_kill_anchored_urbs(&data->intr_anchor);
599 goto failed;
600 }
601
602 set_bit(BTUSB_BULK_RUNNING, &data->flags);
603 btusb_submit_bulk_urb(hdev, GFP_KERNEL);
604
605 done:
606 usb_autopm_put_interface(data->intf);
607 return 0;
608
609 failed:
610 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
611 clear_bit(HCI_RUNNING, &hdev->flags);
612 usb_autopm_put_interface(data->intf);
613 return err;
614 }
615
616 static void btusb_stop_traffic(struct btusb_data *data)
617 {
618 usb_kill_anchored_urbs(&data->intr_anchor);
619 usb_kill_anchored_urbs(&data->bulk_anchor);
620 usb_kill_anchored_urbs(&data->isoc_anchor);
621 }
622
623 static int btusb_close(struct hci_dev *hdev)
624 {
625 struct btusb_data *data = hdev->driver_data;
626 int err;
627
628 BT_DBG("%s", hdev->name);
629
630 if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
631 return 0;
632
633 cancel_work_sync(&data->work);
634 cancel_work_sync(&data->waker);
635
636 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
637 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
638 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
639
640 btusb_stop_traffic(data);
641 err = usb_autopm_get_interface(data->intf);
642 if (err < 0)
643 goto failed;
644
645 data->intf->needs_remote_wakeup = 0;
646 usb_autopm_put_interface(data->intf);
647
648 failed:
649 usb_scuttle_anchored_urbs(&data->deferred);
650 return 0;
651 }
652
653 static int btusb_flush(struct hci_dev *hdev)
654 {
655 struct btusb_data *data = hdev->driver_data;
656
657 BT_DBG("%s", hdev->name);
658
659 usb_kill_anchored_urbs(&data->tx_anchor);
660
661 return 0;
662 }
663
664 static int btusb_send_frame(struct sk_buff *skb)
665 {
666 struct hci_dev *hdev = (struct hci_dev *) skb->dev;
667 struct btusb_data *data = hdev->driver_data;
668 struct usb_ctrlrequest *dr;
669 struct urb *urb;
670 unsigned int pipe;
671 int err;
672
673 BT_DBG("%s", hdev->name);
674
675 if (!test_bit(HCI_RUNNING, &hdev->flags))
676 return -EBUSY;
677
678 switch (bt_cb(skb)->pkt_type) {
679 case HCI_COMMAND_PKT:
680 urb = usb_alloc_urb(0, GFP_ATOMIC);
681 if (!urb)
682 return -ENOMEM;
683
684 dr = kmalloc(sizeof(*dr), GFP_ATOMIC);
685 if (!dr) {
686 usb_free_urb(urb);
687 return -ENOMEM;
688 }
689
690 dr->bRequestType = data->cmdreq_type;
691 dr->bRequest = 0;
692 dr->wIndex = 0;
693 dr->wValue = 0;
694 dr->wLength = __cpu_to_le16(skb->len);
695
696 pipe = usb_sndctrlpipe(data->udev, 0x00);
697
698 usb_fill_control_urb(urb, data->udev, pipe, (void *) dr,
699 skb->data, skb->len, btusb_tx_complete, skb);
700
701 hdev->stat.cmd_tx++;
702 break;
703
704 case HCI_ACLDATA_PKT:
705 if (!data->bulk_tx_ep || (hdev->conn_hash.acl_num < 1 &&
706 hdev->conn_hash.le_num < 1))
707 return -ENODEV;
708
709 urb = usb_alloc_urb(0, GFP_ATOMIC);
710 if (!urb)
711 return -ENOMEM;
712
713 pipe = usb_sndbulkpipe(data->udev,
714 data->bulk_tx_ep->bEndpointAddress);
715
716 usb_fill_bulk_urb(urb, data->udev, pipe,
717 skb->data, skb->len, btusb_tx_complete, skb);
718
719 hdev->stat.acl_tx++;
720 break;
721
722 case HCI_SCODATA_PKT:
723 if (!data->isoc_tx_ep || hdev->conn_hash.sco_num < 1)
724 return -ENODEV;
725
726 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_ATOMIC);
727 if (!urb)
728 return -ENOMEM;
729
730 pipe = usb_sndisocpipe(data->udev,
731 data->isoc_tx_ep->bEndpointAddress);
732
733 usb_fill_int_urb(urb, data->udev, pipe,
734 skb->data, skb->len, btusb_isoc_tx_complete,
735 skb, data->isoc_tx_ep->bInterval);
736
737 urb->transfer_flags = URB_ISO_ASAP;
738
739 __fill_isoc_descriptor(urb, skb->len,
740 le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
741
742 hdev->stat.sco_tx++;
743 goto skip_waking;
744
745 default:
746 return -EILSEQ;
747 }
748
749 err = inc_tx(data);
750 if (err) {
751 usb_anchor_urb(urb, &data->deferred);
752 schedule_work(&data->waker);
753 err = 0;
754 goto done;
755 }
756
757 skip_waking:
758 usb_anchor_urb(urb, &data->tx_anchor);
759
760 err = usb_submit_urb(urb, GFP_ATOMIC);
761 if (err < 0) {
762 BT_ERR("%s urb %p submission failed", hdev->name, urb);
763 kfree(urb->setup_packet);
764 usb_unanchor_urb(urb);
765 } else {
766 usb_mark_last_busy(data->udev);
767 }
768
769 usb_free_urb(urb);
770
771 done:
772 return err;
773 }
774
775 static void btusb_destruct(struct hci_dev *hdev)
776 {
777 struct btusb_data *data = hdev->driver_data;
778
779 BT_DBG("%s", hdev->name);
780
781 kfree(data);
782 }
783
784 static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
785 {
786 struct btusb_data *data = hdev->driver_data;
787
788 BT_DBG("%s evt %d", hdev->name, evt);
789
790 if (hdev->conn_hash.sco_num != data->sco_num) {
791 data->sco_num = hdev->conn_hash.sco_num;
792 schedule_work(&data->work);
793 }
794 }
795
796 static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
797 {
798 struct btusb_data *data = hdev->driver_data;
799 struct usb_interface *intf = data->isoc;
800 struct usb_endpoint_descriptor *ep_desc;
801 int i, err;
802
803 if (!data->isoc)
804 return -ENODEV;
805
806 err = usb_set_interface(data->udev, 1, altsetting);
807 if (err < 0) {
808 BT_ERR("%s setting interface failed (%d)", hdev->name, -err);
809 return err;
810 }
811
812 data->isoc_altsetting = altsetting;
813
814 data->isoc_tx_ep = NULL;
815 data->isoc_rx_ep = NULL;
816
817 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
818 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
819
820 if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
821 data->isoc_tx_ep = ep_desc;
822 continue;
823 }
824
825 if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
826 data->isoc_rx_ep = ep_desc;
827 continue;
828 }
829 }
830
831 if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
832 BT_ERR("%s invalid SCO descriptors", hdev->name);
833 return -ENODEV;
834 }
835
836 return 0;
837 }
838
839 static void btusb_work(struct work_struct *work)
840 {
841 struct btusb_data *data = container_of(work, struct btusb_data, work);
842 struct hci_dev *hdev = data->hdev;
843 int err;
844
845 if (hdev->conn_hash.sco_num > 0) {
846 if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
847 err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
848 if (err < 0) {
849 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
850 usb_kill_anchored_urbs(&data->isoc_anchor);
851 return;
852 }
853
854 set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
855 }
856 if (data->isoc_altsetting != 2) {
857 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
858 usb_kill_anchored_urbs(&data->isoc_anchor);
859
860 if (__set_isoc_interface(hdev, 2) < 0)
861 return;
862 }
863
864 if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
865 if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
866 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
867 else
868 btusb_submit_isoc_urb(hdev, GFP_KERNEL);
869 }
870 } else {
871 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
872 usb_kill_anchored_urbs(&data->isoc_anchor);
873
874 __set_isoc_interface(hdev, 0);
875 if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
876 usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
877 }
878 }
879
880 static void btusb_waker(struct work_struct *work)
881 {
882 struct btusb_data *data = container_of(work, struct btusb_data, waker);
883 int err;
884
885 err = usb_autopm_get_interface(data->intf);
886 if (err < 0)
887 return;
888
889 usb_autopm_put_interface(data->intf);
890 }
891
892 static int btusb_probe(struct usb_interface *intf,
893 const struct usb_device_id *id)
894 {
895 struct usb_endpoint_descriptor *ep_desc;
896 struct btusb_data *data;
897 struct hci_dev *hdev;
898 int i, err;
899
900 BT_DBG("intf %p id %p", intf, id);
901
902 /* interface numbers are hardcoded in the spec */
903 if (intf->cur_altsetting->desc.bInterfaceNumber != 0)
904 return -ENODEV;
905
906 if (!id->driver_info) {
907 const struct usb_device_id *match;
908 match = usb_match_id(intf, blacklist_table);
909 if (match)
910 id = match;
911 }
912
913 if (id->driver_info == BTUSB_IGNORE)
914 return -ENODEV;
915
916 if (ignore_dga && id->driver_info & BTUSB_DIGIANSWER)
917 return -ENODEV;
918
919 if (ignore_csr && id->driver_info & BTUSB_CSR)
920 return -ENODEV;
921
922 if (ignore_sniffer && id->driver_info & BTUSB_SNIFFER)
923 return -ENODEV;
924
925 if (id->driver_info & BTUSB_ATH3012) {
926 struct usb_device *udev = interface_to_usbdev(intf);
927
928 /* Old firmware would otherwise let ath3k driver load
929 * patch and sysconfig files */
930 if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001)
931 return -ENODEV;
932 }
933
934 data = kzalloc(sizeof(*data), GFP_KERNEL);
935 if (!data)
936 return -ENOMEM;
937
938 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
939 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
940
941 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
942 data->intr_ep = ep_desc;
943 continue;
944 }
945
946 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
947 data->bulk_tx_ep = ep_desc;
948 continue;
949 }
950
951 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
952 data->bulk_rx_ep = ep_desc;
953 continue;
954 }
955 }
956
957 if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep) {
958 kfree(data);
959 return -ENODEV;
960 }
961
962 data->cmdreq_type = USB_TYPE_CLASS;
963
964 data->udev = interface_to_usbdev(intf);
965 data->intf = intf;
966
967 spin_lock_init(&data->lock);
968
969 INIT_WORK(&data->work, btusb_work);
970 INIT_WORK(&data->waker, btusb_waker);
971 spin_lock_init(&data->txlock);
972
973 init_usb_anchor(&data->tx_anchor);
974 init_usb_anchor(&data->intr_anchor);
975 init_usb_anchor(&data->bulk_anchor);
976 init_usb_anchor(&data->isoc_anchor);
977 init_usb_anchor(&data->deferred);
978
979 hdev = hci_alloc_dev();
980 if (!hdev) {
981 kfree(data);
982 return -ENOMEM;
983 }
984
985 hdev->bus = HCI_USB;
986 hdev->driver_data = data;
987
988 data->hdev = hdev;
989
990 SET_HCIDEV_DEV(hdev, &intf->dev);
991
992 hdev->open = btusb_open;
993 hdev->close = btusb_close;
994 hdev->flush = btusb_flush;
995 hdev->send = btusb_send_frame;
996 hdev->destruct = btusb_destruct;
997 hdev->notify = btusb_notify;
998
999 hdev->owner = THIS_MODULE;
1000
1001 /* Interface numbers are hardcoded in the specification */
1002 data->isoc = usb_ifnum_to_if(data->udev, 1);
1003
1004 if (!reset)
1005 set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks);
1006
1007 if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
1008 if (!disable_scofix)
1009 set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
1010 }
1011
1012 if (id->driver_info & BTUSB_BROKEN_ISOC)
1013 data->isoc = NULL;
1014
1015 if (id->driver_info & BTUSB_DIGIANSWER) {
1016 data->cmdreq_type = USB_TYPE_VENDOR;
1017 set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks);
1018 }
1019
1020 if (id->driver_info & BTUSB_CSR) {
1021 struct usb_device *udev = data->udev;
1022
1023 /* Old firmware would otherwise execute USB reset */
1024 if (le16_to_cpu(udev->descriptor.bcdDevice) < 0x117)
1025 set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks);
1026 }
1027
1028 if (id->driver_info & BTUSB_SNIFFER) {
1029 struct usb_device *udev = data->udev;
1030
1031 /* New sniffer firmware has crippled HCI interface */
1032 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
1033 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
1034
1035 data->isoc = NULL;
1036 }
1037
1038 if (id->driver_info & BTUSB_BCM92035) {
1039 unsigned char cmd[] = { 0x3b, 0xfc, 0x01, 0x00 };
1040 struct sk_buff *skb;
1041
1042 skb = bt_skb_alloc(sizeof(cmd), GFP_KERNEL);
1043 if (skb) {
1044 memcpy(skb_put(skb, sizeof(cmd)), cmd, sizeof(cmd));
1045 skb_queue_tail(&hdev->driver_init, skb);
1046 }
1047 }
1048
1049 if (data->isoc) {
1050 err = usb_driver_claim_interface(&btusb_driver,
1051 data->isoc, data);
1052 if (err < 0) {
1053 hci_free_dev(hdev);
1054 kfree(data);
1055 return err;
1056 }
1057 }
1058
1059 err = hci_register_dev(hdev);
1060 if (err < 0) {
1061 hci_free_dev(hdev);
1062 kfree(data);
1063 return err;
1064 }
1065
1066 usb_set_intfdata(intf, data);
1067
1068 return 0;
1069 }
1070
1071 static void btusb_disconnect(struct usb_interface *intf)
1072 {
1073 struct btusb_data *data = usb_get_intfdata(intf);
1074 struct hci_dev *hdev;
1075
1076 BT_DBG("intf %p", intf);
1077
1078 if (!data)
1079 return;
1080
1081 hdev = data->hdev;
1082
1083 __hci_dev_hold(hdev);
1084
1085 usb_set_intfdata(data->intf, NULL);
1086
1087 if (data->isoc)
1088 usb_set_intfdata(data->isoc, NULL);
1089
1090 hci_unregister_dev(hdev);
1091
1092 if (intf == data->isoc)
1093 usb_driver_release_interface(&btusb_driver, data->intf);
1094 else if (data->isoc)
1095 usb_driver_release_interface(&btusb_driver, data->isoc);
1096
1097 __hci_dev_put(hdev);
1098
1099 hci_free_dev(hdev);
1100 }
1101
1102 #ifdef CONFIG_PM
1103 static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
1104 {
1105 struct btusb_data *data = usb_get_intfdata(intf);
1106
1107 BT_DBG("intf %p", intf);
1108
1109 if (data->suspend_count++)
1110 return 0;
1111
1112 spin_lock_irq(&data->txlock);
1113 if (!((message.event & PM_EVENT_AUTO) && data->tx_in_flight)) {
1114 set_bit(BTUSB_SUSPENDING, &data->flags);
1115 spin_unlock_irq(&data->txlock);
1116 } else {
1117 spin_unlock_irq(&data->txlock);
1118 data->suspend_count--;
1119 return -EBUSY;
1120 }
1121
1122 cancel_work_sync(&data->work);
1123
1124 btusb_stop_traffic(data);
1125 usb_kill_anchored_urbs(&data->tx_anchor);
1126
1127 return 0;
1128 }
1129
1130 static void play_deferred(struct btusb_data *data)
1131 {
1132 struct urb *urb;
1133 int err;
1134
1135 while ((urb = usb_get_from_anchor(&data->deferred))) {
1136 err = usb_submit_urb(urb, GFP_ATOMIC);
1137 if (err < 0)
1138 break;
1139
1140 data->tx_in_flight++;
1141 }
1142 usb_scuttle_anchored_urbs(&data->deferred);
1143 }
1144
1145 static int btusb_resume(struct usb_interface *intf)
1146 {
1147 struct btusb_data *data = usb_get_intfdata(intf);
1148 struct hci_dev *hdev = data->hdev;
1149 int err = 0;
1150
1151 BT_DBG("intf %p", intf);
1152
1153 if (--data->suspend_count)
1154 return 0;
1155
1156 if (!test_bit(HCI_RUNNING, &hdev->flags))
1157 goto done;
1158
1159 if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
1160 err = btusb_submit_intr_urb(hdev, GFP_NOIO);
1161 if (err < 0) {
1162 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1163 goto failed;
1164 }
1165 }
1166
1167 if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
1168 err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
1169 if (err < 0) {
1170 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
1171 goto failed;
1172 }
1173
1174 btusb_submit_bulk_urb(hdev, GFP_NOIO);
1175 }
1176
1177 if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
1178 if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
1179 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1180 else
1181 btusb_submit_isoc_urb(hdev, GFP_NOIO);
1182 }
1183
1184 spin_lock_irq(&data->txlock);
1185 play_deferred(data);
1186 clear_bit(BTUSB_SUSPENDING, &data->flags);
1187 spin_unlock_irq(&data->txlock);
1188 schedule_work(&data->work);
1189
1190 return 0;
1191
1192 failed:
1193 usb_scuttle_anchored_urbs(&data->deferred);
1194 done:
1195 spin_lock_irq(&data->txlock);
1196 clear_bit(BTUSB_SUSPENDING, &data->flags);
1197 spin_unlock_irq(&data->txlock);
1198
1199 return err;
1200 }
1201 #endif
1202
1203 static struct usb_driver btusb_driver = {
1204 .name = "btusb",
1205 .probe = btusb_probe,
1206 .disconnect = btusb_disconnect,
1207 #ifdef CONFIG_PM
1208 .suspend = btusb_suspend,
1209 .resume = btusb_resume,
1210 #endif
1211 .id_table = btusb_table,
1212 .supports_autosuspend = 1,
1213 };
1214
1215 static int __init btusb_init(void)
1216 {
1217 BT_INFO("Generic Bluetooth USB driver ver %s", VERSION);
1218
1219 return usb_register(&btusb_driver);
1220 }
1221
1222 static void __exit btusb_exit(void)
1223 {
1224 usb_deregister(&btusb_driver);
1225 }
1226
1227 module_init(btusb_init);
1228 module_exit(btusb_exit);
1229
1230 module_param(ignore_dga, bool, 0644);
1231 MODULE_PARM_DESC(ignore_dga, "Ignore devices with id 08fd:0001");
1232
1233 module_param(ignore_csr, bool, 0644);
1234 MODULE_PARM_DESC(ignore_csr, "Ignore devices with id 0a12:0001");
1235
1236 module_param(ignore_sniffer, bool, 0644);
1237 MODULE_PARM_DESC(ignore_sniffer, "Ignore devices with id 0a12:0002");
1238
1239 module_param(disable_scofix, bool, 0644);
1240 MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
1241
1242 module_param(force_scofix, bool, 0644);
1243 MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
1244
1245 module_param(reset, bool, 0644);
1246 MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
1247
1248 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
1249 MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
1250 MODULE_VERSION(VERSION);
1251 MODULE_LICENSE("GPL");
ubuntu-zesty-kernel mirror