]> err.no Git - linux-2.6/blob - drivers/bluetooth/btusb.c
Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/roland...
[linux-2.6] / drivers / bluetooth / btusb.c
1 /*
2  *
3  *  Generic Bluetooth USB driver
4  *
5  *  Copyright (C) 2005-2007  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 CONFIG_BT_HCIBTUSB_DEBUG
39 #ifndef CONFIG_BT_HCIBTUSB_DEBUG
40 #undef  BT_DBG
41 #define BT_DBG(D...)
42 #endif
43
44 #define VERSION "0.1"
45
46 static struct usb_device_id btusb_table[] = {
47         /* Generic Bluetooth USB device */
48         { USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
49
50         { }     /* Terminating entry */
51 };
52
53 MODULE_DEVICE_TABLE(usb, btusb_table);
54
55 static struct usb_device_id blacklist_table[] = {
56         { }     /* Terminating entry */
57 };
58
59 #define BTUSB_INTR_RUNNING      0
60 #define BTUSB_BULK_RUNNING      1
61
62 struct btusb_data {
63         struct hci_dev       *hdev;
64         struct usb_device    *udev;
65
66         spinlock_t lock;
67
68         unsigned long flags;
69
70         struct work_struct work;
71
72         struct usb_anchor tx_anchor;
73         struct usb_anchor intr_anchor;
74         struct usb_anchor bulk_anchor;
75
76         struct usb_endpoint_descriptor *intr_ep;
77         struct usb_endpoint_descriptor *bulk_tx_ep;
78         struct usb_endpoint_descriptor *bulk_rx_ep;
79 };
80
81 static void btusb_intr_complete(struct urb *urb)
82 {
83         struct hci_dev *hdev = urb->context;
84         struct btusb_data *data = hdev->driver_data;
85         int err;
86
87         BT_DBG("%s urb %p status %d count %d", hdev->name,
88                                         urb, urb->status, urb->actual_length);
89
90         if (!test_bit(HCI_RUNNING, &hdev->flags))
91                 return;
92
93         if (urb->status == 0) {
94                 if (hci_recv_fragment(hdev, HCI_EVENT_PKT,
95                                                 urb->transfer_buffer,
96                                                 urb->actual_length) < 0) {
97                         BT_ERR("%s corrupted event packet", hdev->name);
98                         hdev->stat.err_rx++;
99                 }
100         }
101
102         if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
103                 return;
104
105         usb_anchor_urb(urb, &data->intr_anchor);
106
107         err = usb_submit_urb(urb, GFP_ATOMIC);
108         if (err < 0) {
109                 BT_ERR("%s urb %p failed to resubmit (%d)",
110                                                 hdev->name, urb, -err);
111                 usb_unanchor_urb(urb);
112         }
113 }
114
115 static inline int btusb_submit_intr_urb(struct hci_dev *hdev)
116 {
117         struct btusb_data *data = hdev->driver_data;
118         struct urb *urb;
119         unsigned char *buf;
120         unsigned int pipe;
121         int err, size;
122
123         BT_DBG("%s", hdev->name);
124
125         urb = usb_alloc_urb(0, GFP_ATOMIC);
126         if (!urb)
127                 return -ENOMEM;
128
129         size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
130
131         buf = kmalloc(size, GFP_ATOMIC);
132         if (!buf) {
133                 usb_free_urb(urb);
134                 return -ENOMEM;
135         }
136
137         pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
138
139         usb_fill_int_urb(urb, data->udev, pipe, buf, size,
140                                                 btusb_intr_complete, hdev,
141                                                 data->intr_ep->bInterval);
142
143         urb->transfer_flags |= URB_FREE_BUFFER;
144
145         usb_anchor_urb(urb, &data->intr_anchor);
146
147         err = usb_submit_urb(urb, GFP_ATOMIC);
148         if (err < 0) {
149                 BT_ERR("%s urb %p submission failed (%d)",
150                                                 hdev->name, urb, -err);
151                 usb_unanchor_urb(urb);
152                 kfree(buf);
153         }
154
155         usb_free_urb(urb);
156
157         return err;
158 }
159
160 static void btusb_bulk_complete(struct urb *urb)
161 {
162         struct hci_dev *hdev = urb->context;
163         struct btusb_data *data = hdev->driver_data;
164         int err;
165
166         BT_DBG("%s urb %p status %d count %d", hdev->name,
167                                         urb, urb->status, urb->actual_length);
168
169         if (!test_bit(HCI_RUNNING, &hdev->flags))
170                 return;
171
172         if (urb->status == 0) {
173                 if (hci_recv_fragment(hdev, HCI_ACLDATA_PKT,
174                                                 urb->transfer_buffer,
175                                                 urb->actual_length) < 0) {
176                         BT_ERR("%s corrupted ACL packet", hdev->name);
177                         hdev->stat.err_rx++;
178                 }
179         }
180
181         if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
182                 return;
183
184         usb_anchor_urb(urb, &data->bulk_anchor);
185
186         err = usb_submit_urb(urb, GFP_ATOMIC);
187         if (err < 0) {
188                 BT_ERR("%s urb %p failed to resubmit (%d)",
189                                                 hdev->name, urb, -err);
190                 usb_unanchor_urb(urb);
191         }
192 }
193
194 static inline int btusb_submit_bulk_urb(struct hci_dev *hdev)
195 {
196         struct btusb_data *data = hdev->driver_data;
197         struct urb *urb;
198         unsigned char *buf;
199         unsigned int pipe;
200         int err, size;
201
202         BT_DBG("%s", hdev->name);
203
204         urb = usb_alloc_urb(0, GFP_KERNEL);
205         if (!urb)
206                 return -ENOMEM;
207
208         size = le16_to_cpu(data->bulk_rx_ep->wMaxPacketSize);
209
210         buf = kmalloc(size, GFP_KERNEL);
211         if (!buf) {
212                 usb_free_urb(urb);
213                 return -ENOMEM;
214         }
215
216         pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
217
218         usb_fill_bulk_urb(urb, data->udev, pipe,
219                                         buf, size, btusb_bulk_complete, hdev);
220
221         urb->transfer_flags |= URB_FREE_BUFFER;
222
223         usb_anchor_urb(urb, &data->bulk_anchor);
224
225         err = usb_submit_urb(urb, GFP_KERNEL);
226         if (err < 0) {
227                 BT_ERR("%s urb %p submission failed (%d)",
228                                                 hdev->name, urb, -err);
229                 usb_unanchor_urb(urb);
230                 kfree(buf);
231         }
232
233         usb_free_urb(urb);
234
235         return err;
236 }
237
238 static void btusb_tx_complete(struct urb *urb)
239 {
240         struct sk_buff *skb = urb->context;
241         struct hci_dev *hdev = (struct hci_dev *) skb->dev;
242
243         BT_DBG("%s urb %p status %d count %d", hdev->name,
244                                         urb, urb->status, urb->actual_length);
245
246         if (!test_bit(HCI_RUNNING, &hdev->flags))
247                 goto done;
248
249         if (!urb->status)
250                 hdev->stat.byte_tx += urb->transfer_buffer_length;
251         else
252                 hdev->stat.err_tx++;
253
254 done:
255         kfree(urb->setup_packet);
256
257         kfree_skb(skb);
258 }
259
260 static int btusb_open(struct hci_dev *hdev)
261 {
262         struct btusb_data *data = hdev->driver_data;
263         int err;
264
265         BT_DBG("%s", hdev->name);
266
267         if (test_and_set_bit(HCI_RUNNING, &hdev->flags))
268                 return 0;
269
270         if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
271                 return 0;
272
273         err = btusb_submit_intr_urb(hdev);
274         if (err < 0) {
275                 clear_bit(BTUSB_INTR_RUNNING, &hdev->flags);
276                 clear_bit(HCI_RUNNING, &hdev->flags);
277         }
278
279         return err;
280 }
281
282 static int btusb_close(struct hci_dev *hdev)
283 {
284         struct btusb_data *data = hdev->driver_data;
285
286         BT_DBG("%s", hdev->name);
287
288         if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
289                 return 0;
290
291         clear_bit(BTUSB_BULK_RUNNING, &data->flags);
292         usb_kill_anchored_urbs(&data->bulk_anchor);
293
294         clear_bit(BTUSB_INTR_RUNNING, &data->flags);
295         usb_kill_anchored_urbs(&data->intr_anchor);
296
297         return 0;
298 }
299
300 static int btusb_flush(struct hci_dev *hdev)
301 {
302         struct btusb_data *data = hdev->driver_data;
303
304         BT_DBG("%s", hdev->name);
305
306         usb_kill_anchored_urbs(&data->tx_anchor);
307
308         return 0;
309 }
310
311 static int btusb_send_frame(struct sk_buff *skb)
312 {
313         struct hci_dev *hdev = (struct hci_dev *) skb->dev;
314         struct btusb_data *data = hdev->driver_data;
315         struct usb_ctrlrequest *dr;
316         struct urb *urb;
317         unsigned int pipe;
318         int err;
319
320         BT_DBG("%s", hdev->name);
321
322         if (!test_bit(HCI_RUNNING, &hdev->flags))
323                 return -EBUSY;
324
325         switch (bt_cb(skb)->pkt_type) {
326         case HCI_COMMAND_PKT:
327                 urb = usb_alloc_urb(0, GFP_ATOMIC);
328                 if (!urb)
329                         return -ENOMEM;
330
331                 dr = kmalloc(sizeof(*dr), GFP_ATOMIC);
332                 if (!dr) {
333                         usb_free_urb(urb);
334                         return -ENOMEM;
335                 }
336
337                 dr->bRequestType = USB_TYPE_CLASS;
338                 dr->bRequest     = 0;
339                 dr->wIndex       = 0;
340                 dr->wValue       = 0;
341                 dr->wLength      = __cpu_to_le16(skb->len);
342
343                 pipe = usb_sndctrlpipe(data->udev, 0x00);
344
345                 usb_fill_control_urb(urb, data->udev, pipe, (void *) dr,
346                                 skb->data, skb->len, btusb_tx_complete, skb);
347
348                 hdev->stat.cmd_tx++;
349                 break;
350
351         case HCI_ACLDATA_PKT:
352                 urb = usb_alloc_urb(0, GFP_ATOMIC);
353                 if (!urb)
354                         return -ENOMEM;
355
356                 pipe = usb_sndbulkpipe(data->udev,
357                                         data->bulk_tx_ep->bEndpointAddress);
358
359                 usb_fill_bulk_urb(urb, data->udev, pipe,
360                                 skb->data, skb->len, btusb_tx_complete, skb);
361
362                 hdev->stat.acl_tx++;
363                 break;
364
365         case HCI_SCODATA_PKT:
366                 hdev->stat.sco_tx++;
367                 kfree_skb(skb);
368                 return 0;
369
370         default:
371                 return -EILSEQ;
372         }
373
374         usb_anchor_urb(urb, &data->tx_anchor);
375
376         err = usb_submit_urb(urb, GFP_ATOMIC);
377         if (err < 0) {
378                 BT_ERR("%s urb %p submission failed", hdev->name, urb);
379                 kfree(urb->setup_packet);
380                 usb_unanchor_urb(urb);
381         }
382
383         usb_free_urb(urb);
384
385         return err;
386 }
387
388 static void btusb_destruct(struct hci_dev *hdev)
389 {
390         struct btusb_data *data = hdev->driver_data;
391
392         BT_DBG("%s", hdev->name);
393
394         kfree(data);
395 }
396
397 static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
398 {
399         struct btusb_data *data = hdev->driver_data;
400
401         BT_DBG("%s evt %d", hdev->name, evt);
402
403         if (evt == HCI_NOTIFY_CONN_ADD || evt == HCI_NOTIFY_CONN_DEL)
404                 schedule_work(&data->work);
405 }
406
407 static void btusb_work(struct work_struct *work)
408 {
409         struct btusb_data *data = container_of(work, struct btusb_data, work);
410         struct hci_dev *hdev = data->hdev;
411
412         if (hdev->conn_hash.acl_num == 0) {
413                 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
414                 usb_kill_anchored_urbs(&data->bulk_anchor);
415                 return;
416         }
417
418         if (!test_and_set_bit(BTUSB_BULK_RUNNING, &data->flags)) {
419                 if (btusb_submit_bulk_urb(hdev) < 0)
420                         clear_bit(BTUSB_BULK_RUNNING, &data->flags);
421                 else
422                         btusb_submit_bulk_urb(hdev);
423         }
424 }
425
426 static int btusb_probe(struct usb_interface *intf,
427                                 const struct usb_device_id *id)
428 {
429         struct usb_endpoint_descriptor *ep_desc;
430         struct btusb_data *data;
431         struct hci_dev *hdev;
432         int i, err;
433
434         BT_DBG("intf %p id %p", intf, id);
435
436         if (intf->cur_altsetting->desc.bInterfaceNumber != 0)
437                 return -ENODEV;
438
439         if (!id->driver_info) {
440                 const struct usb_device_id *match;
441                 match = usb_match_id(intf, blacklist_table);
442                 if (match)
443                         id = match;
444         }
445
446         data = kzalloc(sizeof(*data), GFP_KERNEL);
447         if (!data)
448                 return -ENOMEM;
449
450         for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
451                 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
452
453                 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
454                         data->intr_ep = ep_desc;
455                         continue;
456                 }
457
458                 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
459                         data->bulk_tx_ep = ep_desc;
460                         continue;
461                 }
462
463                 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
464                         data->bulk_rx_ep = ep_desc;
465                         continue;
466                 }
467         }
468
469         if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep) {
470                 kfree(data);
471                 return -ENODEV;
472         }
473
474         data->udev = interface_to_usbdev(intf);
475
476         spin_lock_init(&data->lock);
477
478         INIT_WORK(&data->work, btusb_work);
479
480         init_usb_anchor(&data->tx_anchor);
481         init_usb_anchor(&data->intr_anchor);
482         init_usb_anchor(&data->bulk_anchor);
483
484         hdev = hci_alloc_dev();
485         if (!hdev) {
486                 kfree(data);
487                 return -ENOMEM;
488         }
489
490         hdev->type = HCI_USB;
491         hdev->driver_data = data;
492
493         data->hdev = hdev;
494
495         SET_HCIDEV_DEV(hdev, &intf->dev);
496
497         hdev->open     = btusb_open;
498         hdev->close    = btusb_close;
499         hdev->flush    = btusb_flush;
500         hdev->send     = btusb_send_frame;
501         hdev->destruct = btusb_destruct;
502         hdev->notify   = btusb_notify;
503
504         hdev->owner = THIS_MODULE;
505
506         set_bit(HCI_QUIRK_RESET_ON_INIT, &hdev->quirks);
507
508         err = hci_register_dev(hdev);
509         if (err < 0) {
510                 hci_free_dev(hdev);
511                 kfree(data);
512                 return err;
513         }
514
515         usb_set_intfdata(intf, data);
516
517         return 0;
518 }
519
520 static void btusb_disconnect(struct usb_interface *intf)
521 {
522         struct btusb_data *data = usb_get_intfdata(intf);
523         struct hci_dev *hdev;
524
525         BT_DBG("intf %p", intf);
526
527         if (!data)
528                 return;
529
530         hdev = data->hdev;
531
532         usb_set_intfdata(intf, NULL);
533
534         hci_unregister_dev(hdev);
535
536         hci_free_dev(hdev);
537 }
538
539 static struct usb_driver btusb_driver = {
540         .name           = "btusb",
541         .probe          = btusb_probe,
542         .disconnect     = btusb_disconnect,
543         .id_table       = btusb_table,
544 };
545
546 static int __init btusb_init(void)
547 {
548         BT_INFO("Generic Bluetooth USB driver ver %s", VERSION);
549
550         return usb_register(&btusb_driver);
551 }
552
553 static void __exit btusb_exit(void)
554 {
555         usb_deregister(&btusb_driver);
556 }
557
558 module_init(btusb_init);
559 module_exit(btusb_exit);
560
561 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
562 MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
563 MODULE_VERSION(VERSION);
564 MODULE_LICENSE("GPL");