Merge rsync://rsync.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[linux-2.6] / drivers / bluetooth / hci_usb.c
1 /* 
2    HCI USB driver for Linux Bluetooth protocol stack (BlueZ)
3    Copyright (C) 2000-2001 Qualcomm Incorporated
4    Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
5
6    Copyright (C) 2003 Maxim Krasnyansky <maxk@qualcomm.com>
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 version 2 as
10    published by the Free Software Foundation;
11
12    THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
13    OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
14    FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
15    IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
16    CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES 
17    WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 
18    ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 
19    OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
20
21    ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, 
22    COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS 
23    SOFTWARE IS DISCLAIMED.
24 */
25
26 /*
27  * Bluetooth HCI USB driver.
28  * Based on original USB Bluetooth driver for Linux kernel
29  *    Copyright (c) 2000 Greg Kroah-Hartman        <greg@kroah.com>
30  *    Copyright (c) 2000 Mark Douglas Corner       <mcorner@umich.edu>
31  *
32  */
33
34 #include <linux/config.h>
35 #include <linux/module.h>
36
37 #include <linux/kernel.h>
38 #include <linux/init.h>
39 #include <linux/sched.h>
40 #include <linux/unistd.h>
41 #include <linux/types.h>
42 #include <linux/interrupt.h>
43 #include <linux/moduleparam.h>
44
45 #include <linux/slab.h>
46 #include <linux/errno.h>
47 #include <linux/string.h>
48 #include <linux/skbuff.h>
49
50 #include <linux/usb.h>
51
52 #include <net/bluetooth/bluetooth.h>
53 #include <net/bluetooth/hci_core.h>
54
55 #include "hci_usb.h"
56
57 #ifndef CONFIG_BT_HCIUSB_DEBUG
58 #undef  BT_DBG
59 #define BT_DBG(D...)
60 #endif
61
62 #ifndef CONFIG_BT_HCIUSB_ZERO_PACKET
63 #undef  URB_ZERO_PACKET
64 #define URB_ZERO_PACKET 0
65 #endif
66
67 static int ignore = 0;
68 static int ignore_dga = 0;
69 static int ignore_csr = 0;
70 static int ignore_sniffer = 0;
71 static int reset = 0;
72
73 #ifdef CONFIG_BT_HCIUSB_SCO
74 static int isoc = 2;
75 #endif
76
77 #define VERSION "2.9"
78
79 static struct usb_driver hci_usb_driver; 
80
81 static struct usb_device_id bluetooth_ids[] = {
82         /* Generic Bluetooth USB device */
83         { USB_DEVICE_INFO(HCI_DEV_CLASS, HCI_DEV_SUBCLASS, HCI_DEV_PROTOCOL) },
84
85         /* AVM BlueFRITZ! USB v2.0 */
86         { USB_DEVICE(0x057c, 0x3800) },
87
88         /* Bluetooth Ultraport Module from IBM */
89         { USB_DEVICE(0x04bf, 0x030a) },
90
91         /* ALPS Modules with non-standard id */
92         { USB_DEVICE(0x044e, 0x3001) },
93         { USB_DEVICE(0x044e, 0x3002) },
94
95         /* Ericsson with non-standard id */
96         { USB_DEVICE(0x0bdb, 0x1002) },
97
98         { }     /* Terminating entry */
99 };
100
101 MODULE_DEVICE_TABLE (usb, bluetooth_ids);
102
103 static struct usb_device_id blacklist_ids[] = {
104         /* CSR BlueCore devices */
105         { USB_DEVICE(0x0a12, 0x0001), .driver_info = HCI_CSR },
106
107         /* Broadcom BCM2033 without firmware */
108         { USB_DEVICE(0x0a5c, 0x2033), .driver_info = HCI_IGNORE },
109
110         /* Broadcom BCM2035 */
111         { USB_DEVICE(0x0a5c, 0x200a), .driver_info = HCI_RESET | HCI_BROKEN_ISOC },
112         { USB_DEVICE(0x0a5c, 0x2009), .driver_info = HCI_BCM92035 },
113
114         /* Microsoft Wireless Transceiver for Bluetooth 2.0 */
115         { USB_DEVICE(0x045e, 0x009c), .driver_info = HCI_RESET },
116
117         /* Kensington Bluetooth USB adapter */
118         { USB_DEVICE(0x047d, 0x105d), .driver_info = HCI_RESET },
119
120         /* ISSC Bluetooth Adapter v3.1 */
121         { USB_DEVICE(0x1131, 0x1001), .driver_info = HCI_RESET },
122
123         /* RTX Telecom based adapter with buggy SCO support */
124         { USB_DEVICE(0x0400, 0x0807), .driver_info = HCI_BROKEN_ISOC },
125
126         /* Digianswer devices */
127         { USB_DEVICE(0x08fd, 0x0001), .driver_info = HCI_DIGIANSWER },
128         { USB_DEVICE(0x08fd, 0x0002), .driver_info = HCI_IGNORE },
129
130         /* CSR BlueCore Bluetooth Sniffer */
131         { USB_DEVICE(0x0a12, 0x0002), .driver_info = HCI_SNIFFER },
132
133         { }     /* Terminating entry */
134 };
135
136 static struct _urb *_urb_alloc(int isoc, gfp_t gfp)
137 {
138         struct _urb *_urb = kmalloc(sizeof(struct _urb) +
139                                 sizeof(struct usb_iso_packet_descriptor) * isoc, gfp);
140         if (_urb) {
141                 memset(_urb, 0, sizeof(*_urb));
142                 usb_init_urb(&_urb->urb);
143         }
144         return _urb;
145 }
146
147 static struct _urb *_urb_dequeue(struct _urb_queue *q)
148 {
149         struct _urb *_urb = NULL;
150         unsigned long flags;
151         spin_lock_irqsave(&q->lock, flags);
152         {
153                 struct list_head *head = &q->head;
154                 struct list_head *next = head->next;
155                 if (next != head) {
156                         _urb = list_entry(next, struct _urb, list);
157                         list_del(next); _urb->queue = NULL;
158                 }
159         }
160         spin_unlock_irqrestore(&q->lock, flags);
161         return _urb;
162 }
163
164 static void hci_usb_rx_complete(struct urb *urb, struct pt_regs *regs);
165 static void hci_usb_tx_complete(struct urb *urb, struct pt_regs *regs);
166
167 #define __pending_tx(husb, type)  (&husb->pending_tx[type-1])
168 #define __pending_q(husb, type)   (&husb->pending_q[type-1])
169 #define __completed_q(husb, type) (&husb->completed_q[type-1])
170 #define __transmit_q(husb, type)  (&husb->transmit_q[type-1])
171 #define __reassembly(husb, type)  (husb->reassembly[type-1])
172
173 static inline struct _urb *__get_completed(struct hci_usb *husb, int type)
174 {
175         return _urb_dequeue(__completed_q(husb, type)); 
176 }
177
178 #ifdef CONFIG_BT_HCIUSB_SCO
179 static void __fill_isoc_desc(struct urb *urb, int len, int mtu)
180 {
181         int offset = 0, i;
182
183         BT_DBG("len %d mtu %d", len, mtu);
184
185         for (i=0; i < HCI_MAX_ISOC_FRAMES && len >= mtu; i++, offset += mtu, len -= mtu) {
186                 urb->iso_frame_desc[i].offset = offset;
187                 urb->iso_frame_desc[i].length = mtu;
188                 BT_DBG("desc %d offset %d len %d", i, offset, mtu);
189         }
190         if (len && i < HCI_MAX_ISOC_FRAMES) {
191                 urb->iso_frame_desc[i].offset = offset;
192                 urb->iso_frame_desc[i].length = len;
193                 BT_DBG("desc %d offset %d len %d", i, offset, len);
194                 i++;
195         }
196         urb->number_of_packets = i;
197 }
198 #endif
199
200 static int hci_usb_intr_rx_submit(struct hci_usb *husb)
201 {
202         struct _urb *_urb;
203         struct urb *urb;
204         int err, pipe, interval, size;
205         void *buf;
206
207         BT_DBG("%s", husb->hdev->name);
208
209         size = le16_to_cpu(husb->intr_in_ep->desc.wMaxPacketSize);
210
211         buf = kmalloc(size, GFP_ATOMIC);
212         if (!buf)
213                 return -ENOMEM;
214
215         _urb = _urb_alloc(0, GFP_ATOMIC);
216         if (!_urb) {
217                 kfree(buf);
218                 return -ENOMEM;
219         }
220         _urb->type = HCI_EVENT_PKT;
221         _urb_queue_tail(__pending_q(husb, _urb->type), _urb);
222
223         urb = &_urb->urb;
224         pipe     = usb_rcvintpipe(husb->udev, husb->intr_in_ep->desc.bEndpointAddress);
225         interval = husb->intr_in_ep->desc.bInterval;
226         usb_fill_int_urb(urb, husb->udev, pipe, buf, size, hci_usb_rx_complete, husb, interval);
227         
228         err = usb_submit_urb(urb, GFP_ATOMIC);
229         if (err) {
230                 BT_ERR("%s intr rx submit failed urb %p err %d",
231                                 husb->hdev->name, urb, err);
232                 _urb_unlink(_urb);
233                 _urb_free(_urb);
234                 kfree(buf);
235         }
236         return err;
237 }
238
239 static int hci_usb_bulk_rx_submit(struct hci_usb *husb)
240 {
241         struct _urb *_urb;
242         struct urb *urb;
243         int err, pipe, size = HCI_MAX_FRAME_SIZE;
244         void *buf;
245
246         buf = kmalloc(size, GFP_ATOMIC);
247         if (!buf)
248                 return -ENOMEM;
249
250         _urb = _urb_alloc(0, GFP_ATOMIC);
251         if (!_urb) {
252                 kfree(buf);
253                 return -ENOMEM;
254         }
255         _urb->type = HCI_ACLDATA_PKT;
256         _urb_queue_tail(__pending_q(husb, _urb->type), _urb);
257
258         urb  = &_urb->urb;
259         pipe = usb_rcvbulkpipe(husb->udev, husb->bulk_in_ep->desc.bEndpointAddress);
260         usb_fill_bulk_urb(urb, husb->udev, pipe, buf, size, hci_usb_rx_complete, husb);
261         urb->transfer_flags = 0;
262
263         BT_DBG("%s urb %p", husb->hdev->name, urb);
264
265         err = usb_submit_urb(urb, GFP_ATOMIC);
266         if (err) {
267                 BT_ERR("%s bulk rx submit failed urb %p err %d",
268                                 husb->hdev->name, urb, err);
269                 _urb_unlink(_urb);
270                 _urb_free(_urb);
271                 kfree(buf);
272         }
273         return err;
274 }
275
276 #ifdef CONFIG_BT_HCIUSB_SCO
277 static int hci_usb_isoc_rx_submit(struct hci_usb *husb)
278 {
279         struct _urb *_urb;
280         struct urb *urb;
281         int err, mtu, size;
282         void *buf;
283
284         mtu  = le16_to_cpu(husb->isoc_in_ep->desc.wMaxPacketSize);
285         size = mtu * HCI_MAX_ISOC_FRAMES;
286
287         buf = kmalloc(size, GFP_ATOMIC);
288         if (!buf)
289                 return -ENOMEM;
290
291         _urb = _urb_alloc(HCI_MAX_ISOC_FRAMES, GFP_ATOMIC);
292         if (!_urb) {
293                 kfree(buf);
294                 return -ENOMEM;
295         }
296         _urb->type = HCI_SCODATA_PKT;
297         _urb_queue_tail(__pending_q(husb, _urb->type), _urb);
298
299         urb = &_urb->urb;
300
301         urb->context  = husb;
302         urb->dev      = husb->udev;
303         urb->pipe     = usb_rcvisocpipe(husb->udev, husb->isoc_in_ep->desc.bEndpointAddress);
304         urb->complete = hci_usb_rx_complete;
305
306         urb->interval = husb->isoc_in_ep->desc.bInterval;
307
308         urb->transfer_buffer_length = size;
309         urb->transfer_buffer = buf;
310         urb->transfer_flags  = URB_ISO_ASAP;
311
312         __fill_isoc_desc(urb, size, mtu);
313
314         BT_DBG("%s urb %p", husb->hdev->name, urb);
315
316         err = usb_submit_urb(urb, GFP_ATOMIC);
317         if (err) {
318                 BT_ERR("%s isoc rx submit failed urb %p err %d",
319                                 husb->hdev->name, urb, err);
320                 _urb_unlink(_urb);
321                 _urb_free(_urb);
322                 kfree(buf);
323         }
324         return err;
325 }
326 #endif
327
328 /* Initialize device */
329 static int hci_usb_open(struct hci_dev *hdev)
330 {
331         struct hci_usb *husb = (struct hci_usb *) hdev->driver_data;
332         int i, err;
333         unsigned long flags;
334
335         BT_DBG("%s", hdev->name);
336
337         if (test_and_set_bit(HCI_RUNNING, &hdev->flags))
338                 return 0;
339
340         write_lock_irqsave(&husb->completion_lock, flags);
341
342         err = hci_usb_intr_rx_submit(husb);
343         if (!err) {
344                 for (i = 0; i < HCI_MAX_BULK_RX; i++)
345                         hci_usb_bulk_rx_submit(husb);
346
347 #ifdef CONFIG_BT_HCIUSB_SCO
348                 if (husb->isoc_iface)
349                         for (i = 0; i < HCI_MAX_ISOC_RX; i++)
350                                 hci_usb_isoc_rx_submit(husb);
351 #endif
352         } else {
353                 clear_bit(HCI_RUNNING, &hdev->flags);
354         }
355
356         write_unlock_irqrestore(&husb->completion_lock, flags);
357         return err;
358 }
359
360 /* Reset device */
361 static int hci_usb_flush(struct hci_dev *hdev)
362 {
363         struct hci_usb *husb = (struct hci_usb *) hdev->driver_data;
364         int i;
365
366         BT_DBG("%s", hdev->name);
367
368         for (i = 0; i < 4; i++)
369                 skb_queue_purge(&husb->transmit_q[i]);
370         return 0;
371 }
372
373 static void hci_usb_unlink_urbs(struct hci_usb *husb)
374 {
375         int i;
376
377         BT_DBG("%s", husb->hdev->name);
378
379         for (i = 0; i < 4; i++) {
380                 struct _urb *_urb;
381                 struct urb *urb;
382
383                 /* Kill pending requests */
384                 while ((_urb = _urb_dequeue(&husb->pending_q[i]))) {
385                         urb = &_urb->urb;
386                         BT_DBG("%s unlinking _urb %p type %d urb %p", 
387                                         husb->hdev->name, _urb, _urb->type, urb);
388                         usb_kill_urb(urb);
389                         _urb_queue_tail(__completed_q(husb, _urb->type), _urb);
390                 }
391
392                 /* Release completed requests */
393                 while ((_urb = _urb_dequeue(&husb->completed_q[i]))) {
394                         urb = &_urb->urb;
395                         BT_DBG("%s freeing _urb %p type %d urb %p",
396                                         husb->hdev->name, _urb, _urb->type, urb);
397                         kfree(urb->setup_packet);
398                         kfree(urb->transfer_buffer);
399                         _urb_free(_urb);
400                 }
401
402                 /* Release reassembly buffers */
403                 if (husb->reassembly[i]) {
404                         kfree_skb(husb->reassembly[i]);
405                         husb->reassembly[i] = NULL;
406                 }
407         }
408 }
409
410 /* Close device */
411 static int hci_usb_close(struct hci_dev *hdev)
412 {
413         struct hci_usb *husb = (struct hci_usb *) hdev->driver_data;
414         unsigned long flags;
415
416         if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
417                 return 0;
418
419         BT_DBG("%s", hdev->name);
420
421         /* Synchronize with completion handlers */
422         write_lock_irqsave(&husb->completion_lock, flags);
423         write_unlock_irqrestore(&husb->completion_lock, flags);
424
425         hci_usb_unlink_urbs(husb);
426         hci_usb_flush(hdev);
427         return 0;
428 }
429
430 static int __tx_submit(struct hci_usb *husb, struct _urb *_urb)
431 {
432         struct urb *urb = &_urb->urb;
433         int err;
434
435         BT_DBG("%s urb %p type %d", husb->hdev->name, urb, _urb->type);
436
437         _urb_queue_tail(__pending_q(husb, _urb->type), _urb);
438         err = usb_submit_urb(urb, GFP_ATOMIC);
439         if (err) {
440                 BT_ERR("%s tx submit failed urb %p type %d err %d",
441                                 husb->hdev->name, urb, _urb->type, err);
442                 _urb_unlink(_urb);
443                 _urb_queue_tail(__completed_q(husb, _urb->type), _urb);
444         } else
445                 atomic_inc(__pending_tx(husb, _urb->type));
446
447         return err;
448 }
449
450 static inline int hci_usb_send_ctrl(struct hci_usb *husb, struct sk_buff *skb)
451 {
452         struct _urb *_urb = __get_completed(husb, bt_cb(skb)->pkt_type);
453         struct usb_ctrlrequest *dr;
454         struct urb *urb;
455
456         if (!_urb) {
457                 _urb = _urb_alloc(0, GFP_ATOMIC);
458                 if (!_urb)
459                         return -ENOMEM;
460                 _urb->type = bt_cb(skb)->pkt_type;
461
462                 dr = kmalloc(sizeof(*dr), GFP_ATOMIC);
463                 if (!dr) {
464                         _urb_free(_urb);
465                         return -ENOMEM;
466                 }
467         } else
468                 dr = (void *) _urb->urb.setup_packet;
469
470         dr->bRequestType = husb->ctrl_req;
471         dr->bRequest = 0;
472         dr->wIndex   = 0;
473         dr->wValue   = 0;
474         dr->wLength  = __cpu_to_le16(skb->len);
475
476         urb = &_urb->urb;
477         usb_fill_control_urb(urb, husb->udev, usb_sndctrlpipe(husb->udev, 0),
478                 (void *) dr, skb->data, skb->len, hci_usb_tx_complete, husb);
479
480         BT_DBG("%s skb %p len %d", husb->hdev->name, skb, skb->len);
481         
482         _urb->priv = skb;
483         return __tx_submit(husb, _urb);
484 }
485
486 static inline int hci_usb_send_bulk(struct hci_usb *husb, struct sk_buff *skb)
487 {
488         struct _urb *_urb = __get_completed(husb, bt_cb(skb)->pkt_type);
489         struct urb *urb;
490         int pipe;
491
492         if (!_urb) {
493                 _urb = _urb_alloc(0, GFP_ATOMIC);
494                 if (!_urb)
495                         return -ENOMEM;
496                 _urb->type = bt_cb(skb)->pkt_type;
497         }
498
499         urb  = &_urb->urb;
500         pipe = usb_sndbulkpipe(husb->udev, husb->bulk_out_ep->desc.bEndpointAddress);
501         usb_fill_bulk_urb(urb, husb->udev, pipe, skb->data, skb->len, 
502                         hci_usb_tx_complete, husb);
503         urb->transfer_flags = URB_ZERO_PACKET;
504
505         BT_DBG("%s skb %p len %d", husb->hdev->name, skb, skb->len);
506
507         _urb->priv = skb;
508         return __tx_submit(husb, _urb);
509 }
510
511 #ifdef CONFIG_BT_HCIUSB_SCO
512 static inline int hci_usb_send_isoc(struct hci_usb *husb, struct sk_buff *skb)
513 {
514         struct _urb *_urb = __get_completed(husb, bt_cb(skb)->pkt_type);
515         struct urb *urb;
516
517         if (!_urb) {
518                 _urb = _urb_alloc(HCI_MAX_ISOC_FRAMES, GFP_ATOMIC);
519                 if (!_urb)
520                         return -ENOMEM;
521                 _urb->type = bt_cb(skb)->pkt_type;
522         }
523
524         BT_DBG("%s skb %p len %d", husb->hdev->name, skb, skb->len);
525
526         urb = &_urb->urb;
527
528         urb->context  = husb;
529         urb->dev      = husb->udev;
530         urb->pipe     = usb_sndisocpipe(husb->udev, husb->isoc_out_ep->desc.bEndpointAddress);
531         urb->complete = hci_usb_tx_complete;
532         urb->transfer_flags = URB_ISO_ASAP;
533
534         urb->interval = husb->isoc_out_ep->desc.bInterval;
535
536         urb->transfer_buffer = skb->data;
537         urb->transfer_buffer_length = skb->len;
538
539         __fill_isoc_desc(urb, skb->len, le16_to_cpu(husb->isoc_out_ep->desc.wMaxPacketSize));
540
541         _urb->priv = skb;
542         return __tx_submit(husb, _urb);
543 }
544 #endif
545
546 static void hci_usb_tx_process(struct hci_usb *husb)
547 {
548         struct sk_buff_head *q;
549         struct sk_buff *skb;
550
551         BT_DBG("%s", husb->hdev->name);
552
553         do {
554                 clear_bit(HCI_USB_TX_WAKEUP, &husb->state);
555
556                 /* Process command queue */
557                 q = __transmit_q(husb, HCI_COMMAND_PKT);
558                 if (!atomic_read(__pending_tx(husb, HCI_COMMAND_PKT)) &&
559                                 (skb = skb_dequeue(q))) {
560                         if (hci_usb_send_ctrl(husb, skb) < 0)
561                                 skb_queue_head(q, skb);
562                 }
563
564 #ifdef CONFIG_BT_HCIUSB_SCO
565                 /* Process SCO queue */
566                 q = __transmit_q(husb, HCI_SCODATA_PKT);
567                 if (atomic_read(__pending_tx(husb, HCI_SCODATA_PKT)) < HCI_MAX_ISOC_TX &&
568                                 (skb = skb_dequeue(q))) {
569                         if (hci_usb_send_isoc(husb, skb) < 0)
570                                 skb_queue_head(q, skb);
571                 }
572 #endif
573
574                 /* Process ACL queue */
575                 q = __transmit_q(husb, HCI_ACLDATA_PKT);
576                 while (atomic_read(__pending_tx(husb, HCI_ACLDATA_PKT)) < HCI_MAX_BULK_TX &&
577                                 (skb = skb_dequeue(q))) {
578                         if (hci_usb_send_bulk(husb, skb) < 0) {
579                                 skb_queue_head(q, skb);
580                                 break;
581                         }
582                 }
583         } while(test_bit(HCI_USB_TX_WAKEUP, &husb->state));
584 }
585
586 static inline void hci_usb_tx_wakeup(struct hci_usb *husb)
587 {
588         /* Serialize TX queue processing to avoid data reordering */
589         if (!test_and_set_bit(HCI_USB_TX_PROCESS, &husb->state)) {
590                 hci_usb_tx_process(husb);
591                 clear_bit(HCI_USB_TX_PROCESS, &husb->state);
592         } else
593                 set_bit(HCI_USB_TX_WAKEUP, &husb->state);
594 }
595
596 /* Send frames from HCI layer */
597 static int hci_usb_send_frame(struct sk_buff *skb)
598 {
599         struct hci_dev *hdev = (struct hci_dev *) skb->dev;
600         struct hci_usb *husb;
601
602         if (!hdev) {
603                 BT_ERR("frame for uknown device (hdev=NULL)");
604                 return -ENODEV;
605         }
606
607         if (!test_bit(HCI_RUNNING, &hdev->flags))
608                 return -EBUSY;
609
610         BT_DBG("%s type %d len %d", hdev->name, bt_cb(skb)->pkt_type, skb->len);
611
612         husb = (struct hci_usb *) hdev->driver_data;
613
614         switch (bt_cb(skb)->pkt_type) {
615         case HCI_COMMAND_PKT:
616                 hdev->stat.cmd_tx++;
617                 break;
618
619         case HCI_ACLDATA_PKT:
620                 hdev->stat.acl_tx++;
621                 break;
622
623 #ifdef CONFIG_BT_HCIUSB_SCO
624         case HCI_SCODATA_PKT:
625                 hdev->stat.sco_tx++;
626                 break;
627 #endif
628
629         default:
630                 kfree_skb(skb);
631                 return 0;
632         }
633
634         read_lock(&husb->completion_lock);
635
636         skb_queue_tail(__transmit_q(husb, bt_cb(skb)->pkt_type), skb);
637         hci_usb_tx_wakeup(husb);
638
639         read_unlock(&husb->completion_lock);
640         return 0;
641 }
642
643 static inline int __recv_frame(struct hci_usb *husb, int type, void *data, int count)
644 {
645         BT_DBG("%s type %d data %p count %d", husb->hdev->name, type, data, count);
646
647         husb->hdev->stat.byte_rx += count;
648
649         while (count) {
650                 struct sk_buff *skb = __reassembly(husb, type);
651                 struct { int expect; } *scb;
652                 int len = 0;
653         
654                 if (!skb) {
655                         /* Start of the frame */
656
657                         switch (type) {
658                         case HCI_EVENT_PKT:
659                                 if (count >= HCI_EVENT_HDR_SIZE) {
660                                         struct hci_event_hdr *h = data;
661                                         len = HCI_EVENT_HDR_SIZE + h->plen;
662                                 } else
663                                         return -EILSEQ;
664                                 break;
665
666                         case HCI_ACLDATA_PKT:
667                                 if (count >= HCI_ACL_HDR_SIZE) {
668                                         struct hci_acl_hdr *h = data;
669                                         len = HCI_ACL_HDR_SIZE + __le16_to_cpu(h->dlen);
670                                 } else
671                                         return -EILSEQ;
672                                 break;
673 #ifdef CONFIG_BT_HCIUSB_SCO
674                         case HCI_SCODATA_PKT:
675                                 if (count >= HCI_SCO_HDR_SIZE) {
676                                         struct hci_sco_hdr *h = data;
677                                         len = HCI_SCO_HDR_SIZE + h->dlen;
678                                 } else
679                                         return -EILSEQ;
680                                 break;
681 #endif
682                         }
683                         BT_DBG("new packet len %d", len);
684
685                         skb = bt_skb_alloc(len, GFP_ATOMIC);
686                         if (!skb) {
687                                 BT_ERR("%s no memory for the packet", husb->hdev->name);
688                                 return -ENOMEM;
689                         }
690                         skb->dev = (void *) husb->hdev;
691                         bt_cb(skb)->pkt_type = type;
692         
693                         __reassembly(husb, type) = skb;
694
695                         scb = (void *) skb->cb;
696                         scb->expect = len;
697                 } else {
698                         /* Continuation */
699                         scb = (void *) skb->cb;
700                         len = scb->expect;
701                 }
702
703                 len = min(len, count);
704                 
705                 memcpy(skb_put(skb, len), data, len);
706
707                 scb->expect -= len;
708                 if (!scb->expect) {
709                         /* Complete frame */
710                         __reassembly(husb, type) = NULL;
711                         bt_cb(skb)->pkt_type = type;
712                         hci_recv_frame(skb);
713                 }
714
715                 count -= len; data += len;
716         }
717         return 0;
718 }
719
720 static void hci_usb_rx_complete(struct urb *urb, struct pt_regs *regs)
721 {
722         struct _urb *_urb = container_of(urb, struct _urb, urb);
723         struct hci_usb *husb = (void *) urb->context;
724         struct hci_dev *hdev = husb->hdev;
725         int err, count = urb->actual_length;
726
727         BT_DBG("%s urb %p type %d status %d count %d flags %x", hdev->name, urb,
728                         _urb->type, urb->status, count, urb->transfer_flags);
729
730         read_lock(&husb->completion_lock);
731
732         if (!test_bit(HCI_RUNNING, &hdev->flags))
733                 goto unlock;
734
735         if (urb->status || !count)
736                 goto resubmit;
737
738         if (_urb->type == HCI_SCODATA_PKT) {
739 #ifdef CONFIG_BT_HCIUSB_SCO
740                 int i;
741                 for (i=0; i < urb->number_of_packets; i++) {
742                         BT_DBG("desc %d status %d offset %d len %d", i,
743                                         urb->iso_frame_desc[i].status,
744                                         urb->iso_frame_desc[i].offset,
745                                         urb->iso_frame_desc[i].actual_length);
746         
747                         if (!urb->iso_frame_desc[i].status)
748                                 __recv_frame(husb, _urb->type, 
749                                         urb->transfer_buffer + urb->iso_frame_desc[i].offset,
750                                         urb->iso_frame_desc[i].actual_length);
751                 }
752 #else
753                 ;
754 #endif
755         } else {
756                 err = __recv_frame(husb, _urb->type, urb->transfer_buffer, count);
757                 if (err < 0) { 
758                         BT_ERR("%s corrupted packet: type %d count %d",
759                                         husb->hdev->name, _urb->type, count);
760                         hdev->stat.err_rx++;
761                 }
762         }
763
764 resubmit:
765         urb->dev = husb->udev;
766         err = usb_submit_urb(urb, GFP_ATOMIC);
767         BT_DBG("%s urb %p type %d resubmit status %d", hdev->name, urb,
768                         _urb->type, err);
769
770 unlock:
771         read_unlock(&husb->completion_lock);
772 }
773
774 static void hci_usb_tx_complete(struct urb *urb, struct pt_regs *regs)
775 {
776         struct _urb *_urb = container_of(urb, struct _urb, urb);
777         struct hci_usb *husb = (void *) urb->context;
778         struct hci_dev *hdev = husb->hdev;
779
780         BT_DBG("%s urb %p status %d flags %x", hdev->name, urb,
781                         urb->status, urb->transfer_flags);
782
783         atomic_dec(__pending_tx(husb, _urb->type));
784
785         urb->transfer_buffer = NULL;
786         kfree_skb((struct sk_buff *) _urb->priv);
787
788         if (!test_bit(HCI_RUNNING, &hdev->flags))
789                 return;
790
791         if (!urb->status)
792                 hdev->stat.byte_tx += urb->transfer_buffer_length;
793         else
794                 hdev->stat.err_tx++;
795
796         read_lock(&husb->completion_lock);
797
798         _urb_unlink(_urb);
799         _urb_queue_tail(__completed_q(husb, _urb->type), _urb);
800
801         hci_usb_tx_wakeup(husb);
802
803         read_unlock(&husb->completion_lock);
804 }
805
806 static void hci_usb_destruct(struct hci_dev *hdev)
807 {
808         struct hci_usb *husb = (struct hci_usb *) hdev->driver_data;
809
810         BT_DBG("%s", hdev->name);
811
812         kfree(husb);
813 }
814
815 static void hci_usb_notify(struct hci_dev *hdev, unsigned int evt)
816 {
817         BT_DBG("%s evt %d", hdev->name, evt);
818 }
819
820 static int hci_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
821 {
822         struct usb_device *udev = interface_to_usbdev(intf);
823         struct usb_host_endpoint *bulk_out_ep = NULL;
824         struct usb_host_endpoint *bulk_in_ep = NULL;
825         struct usb_host_endpoint *intr_in_ep = NULL;
826         struct usb_host_endpoint  *ep;
827         struct usb_host_interface *uif;
828         struct usb_interface *isoc_iface;
829         struct hci_usb *husb;
830         struct hci_dev *hdev;
831         int i, e, size, isoc_ifnum, isoc_alts;
832
833         BT_DBG("udev %p intf %p", udev, intf);
834
835         if (!id->driver_info) {
836                 const struct usb_device_id *match;
837                 match = usb_match_id(intf, blacklist_ids);
838                 if (match)
839                         id = match;
840         }
841
842         if (ignore || id->driver_info & HCI_IGNORE)
843                 return -ENODEV;
844
845         if (ignore_dga && id->driver_info & HCI_DIGIANSWER)
846                 return -ENODEV;
847
848         if (ignore_csr && id->driver_info & HCI_CSR)
849                 return -ENODEV;
850
851         if (ignore_sniffer && id->driver_info & HCI_SNIFFER)
852                 return -ENODEV;
853
854         if (intf->cur_altsetting->desc.bInterfaceNumber > 0)
855                 return -ENODEV;
856
857         /* Find endpoints that we need */
858         uif = intf->cur_altsetting;
859         for (e = 0; e < uif->desc.bNumEndpoints; e++) {
860                 ep = &uif->endpoint[e];
861
862                 switch (ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
863                 case USB_ENDPOINT_XFER_INT:
864                         if (ep->desc.bEndpointAddress & USB_DIR_IN)
865                                 intr_in_ep = ep;
866                         break;
867
868                 case USB_ENDPOINT_XFER_BULK:
869                         if (ep->desc.bEndpointAddress & USB_DIR_IN)
870                                 bulk_in_ep  = ep;
871                         else
872                                 bulk_out_ep = ep;
873                         break;
874                 }
875         }
876
877         if (!bulk_in_ep || !bulk_out_ep || !intr_in_ep) {
878                 BT_DBG("Bulk endpoints not found");
879                 goto done;
880         }
881
882         if (!(husb = kzalloc(sizeof(struct hci_usb), GFP_KERNEL))) {
883                 BT_ERR("Can't allocate: control structure");
884                 goto done;
885         }
886
887         husb->udev = udev;
888         husb->bulk_out_ep = bulk_out_ep;
889         husb->bulk_in_ep  = bulk_in_ep;
890         husb->intr_in_ep  = intr_in_ep;
891
892         if (id->driver_info & HCI_DIGIANSWER)
893                 husb->ctrl_req = USB_TYPE_VENDOR;
894         else
895                 husb->ctrl_req = USB_TYPE_CLASS;
896
897         /* Find isochronous endpoints that we can use */
898         size = 0; 
899         isoc_iface = NULL;
900         isoc_alts  = 0;
901         isoc_ifnum = 1;
902
903 #ifdef CONFIG_BT_HCIUSB_SCO
904         if (isoc && !(id->driver_info & (HCI_BROKEN_ISOC | HCI_SNIFFER)))
905                 isoc_iface = usb_ifnum_to_if(udev, isoc_ifnum);
906
907         if (isoc_iface) {
908                 int a;
909                 struct usb_host_endpoint *isoc_out_ep = NULL;
910                 struct usb_host_endpoint *isoc_in_ep = NULL;
911
912                 for (a = 0; a < isoc_iface->num_altsetting; a++) {
913                         uif = &isoc_iface->altsetting[a];
914                         for (e = 0; e < uif->desc.bNumEndpoints; e++) {
915                                 ep = &uif->endpoint[e];
916
917                                 switch (ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
918                                 case USB_ENDPOINT_XFER_ISOC:
919                                         if (le16_to_cpu(ep->desc.wMaxPacketSize) < size ||
920                                                         uif->desc.bAlternateSetting != isoc)
921                                                 break;
922                                         size = le16_to_cpu(ep->desc.wMaxPacketSize);
923
924                                         isoc_alts = uif->desc.bAlternateSetting;
925
926                                         if (ep->desc.bEndpointAddress & USB_DIR_IN)
927                                                 isoc_in_ep  = ep;
928                                         else
929                                                 isoc_out_ep = ep;
930                                         break;
931                                 }
932                         }
933                 }
934
935                 if (!isoc_in_ep || !isoc_out_ep)
936                         BT_DBG("Isoc endpoints not found");
937                 else {
938                         BT_DBG("isoc ifnum %d alts %d", isoc_ifnum, isoc_alts);
939                         if (usb_driver_claim_interface(&hci_usb_driver, isoc_iface, husb) != 0)
940                                 BT_ERR("Can't claim isoc interface");
941                         else if (usb_set_interface(udev, isoc_ifnum, isoc_alts)) {
942                                 BT_ERR("Can't set isoc interface settings");
943                                 husb->isoc_iface = isoc_iface;
944                                 usb_driver_release_interface(&hci_usb_driver, isoc_iface);
945                                 husb->isoc_iface = NULL;
946                         } else {
947                                 husb->isoc_iface  = isoc_iface;
948                                 husb->isoc_in_ep  = isoc_in_ep;
949                                 husb->isoc_out_ep = isoc_out_ep;
950                         }
951                 }
952         }
953 #endif
954
955         rwlock_init(&husb->completion_lock);
956
957         for (i = 0; i < 4; i++) {
958                 skb_queue_head_init(&husb->transmit_q[i]);
959                 _urb_queue_init(&husb->pending_q[i]);
960                 _urb_queue_init(&husb->completed_q[i]);
961         }
962
963         /* Initialize and register HCI device */
964         hdev = hci_alloc_dev();
965         if (!hdev) {
966                 BT_ERR("Can't allocate HCI device");
967                 goto probe_error;
968         }
969
970         husb->hdev = hdev;
971
972         hdev->type = HCI_USB;
973         hdev->driver_data = husb;
974         SET_HCIDEV_DEV(hdev, &intf->dev);
975
976         hdev->open     = hci_usb_open;
977         hdev->close    = hci_usb_close;
978         hdev->flush    = hci_usb_flush;
979         hdev->send     = hci_usb_send_frame;
980         hdev->destruct = hci_usb_destruct;
981         hdev->notify   = hci_usb_notify;
982
983         hdev->owner = THIS_MODULE;
984
985         if (reset || id->driver_info & HCI_RESET)
986                 set_bit(HCI_QUIRK_RESET_ON_INIT, &hdev->quirks);
987
988         if (id->driver_info & HCI_SNIFFER) {
989                 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
990                         set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
991         }
992
993         if (id->driver_info & HCI_BCM92035) {
994                 unsigned char cmd[] = { 0x3b, 0xfc, 0x01, 0x00 };
995                 struct sk_buff *skb;
996
997                 skb = bt_skb_alloc(sizeof(cmd), GFP_KERNEL);
998                 if (skb) {
999                         memcpy(skb_put(skb, sizeof(cmd)), cmd, sizeof(cmd));
1000                         skb_queue_tail(&hdev->driver_init, skb);
1001                 }
1002         }
1003
1004         if (hci_register_dev(hdev) < 0) {
1005                 BT_ERR("Can't register HCI device");
1006                 hci_free_dev(hdev);
1007                 goto probe_error;
1008         }
1009
1010         usb_set_intfdata(intf, husb);
1011         return 0;
1012
1013 probe_error:
1014         if (husb->isoc_iface)
1015                 usb_driver_release_interface(&hci_usb_driver, husb->isoc_iface);
1016         kfree(husb);
1017
1018 done:
1019         return -EIO;
1020 }
1021
1022 static void hci_usb_disconnect(struct usb_interface *intf)
1023 {
1024         struct hci_usb *husb = usb_get_intfdata(intf);
1025         struct hci_dev *hdev;
1026
1027         if (!husb || intf == husb->isoc_iface)
1028                 return;
1029
1030         usb_set_intfdata(intf, NULL);
1031         hdev = husb->hdev;
1032
1033         BT_DBG("%s", hdev->name);
1034
1035         hci_usb_close(hdev);
1036
1037         if (husb->isoc_iface)
1038                 usb_driver_release_interface(&hci_usb_driver, husb->isoc_iface);
1039
1040         if (hci_unregister_dev(hdev) < 0)
1041                 BT_ERR("Can't unregister HCI device %s", hdev->name);
1042
1043         hci_free_dev(hdev);
1044 }
1045
1046 static struct usb_driver hci_usb_driver = {
1047         .name           = "hci_usb",
1048         .probe          = hci_usb_probe,
1049         .disconnect     = hci_usb_disconnect,
1050         .id_table       = bluetooth_ids,
1051 };
1052
1053 static int __init hci_usb_init(void)
1054 {
1055         int err;
1056
1057         BT_INFO("HCI USB driver ver %s", VERSION);
1058
1059         if ((err = usb_register(&hci_usb_driver)) < 0)
1060                 BT_ERR("Failed to register HCI USB driver");
1061
1062         return err;
1063 }
1064
1065 static void __exit hci_usb_exit(void)
1066 {
1067         usb_deregister(&hci_usb_driver);
1068 }
1069
1070 module_init(hci_usb_init);
1071 module_exit(hci_usb_exit);
1072
1073 module_param(ignore, bool, 0644);
1074 MODULE_PARM_DESC(ignore, "Ignore devices from the matching table");
1075
1076 module_param(ignore_dga, bool, 0644);
1077 MODULE_PARM_DESC(ignore_dga, "Ignore devices with id 08fd:0001");
1078
1079 module_param(ignore_csr, bool, 0644);
1080 MODULE_PARM_DESC(ignore_csr, "Ignore devices with id 0a12:0001");
1081
1082 module_param(ignore_sniffer, bool, 0644);
1083 MODULE_PARM_DESC(ignore_sniffer, "Ignore devices with id 0a12:0002");
1084
1085 module_param(reset, bool, 0644);
1086 MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
1087
1088 #ifdef CONFIG_BT_HCIUSB_SCO
1089 module_param(isoc, int, 0644);
1090 MODULE_PARM_DESC(isoc, "Set isochronous transfers for SCO over HCI support");
1091 #endif
1092
1093 MODULE_AUTHOR("Maxim Krasnyansky <maxk@qualcomm.com>, Marcel Holtmann <marcel@holtmann.org>");
1094 MODULE_DESCRIPTION("Bluetooth HCI USB driver ver " VERSION);
1095 MODULE_VERSION(VERSION);
1096 MODULE_LICENSE("GPL");