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