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