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/module.h>
  25 #include <linux/usb.h>
  26 #include <linux/firmware.h>
  27 #include <asm/unaligned.h>
  28
  29 #include <net/bluetooth/bluetooth.h>
  30 #include <net/bluetooth/hci_core.h>
  31
  32 #include "btintel.h"
  33 #include "btbcm.h"
  34 #include "btrtl.h"
  35
  36 #define VERSION "0.8"
  37
  38 static bool disable_scofix;
  39 static bool force_scofix;
  40
  41 static bool reset = true;
  42
  43 static struct usb_driver btusb_driver;
  44
  45 #define BTUSB_IGNORE            0x01
  46 #define BTUSB_DIGIANSWER        0x02
  47 #define BTUSB_CSR               0x04
  48 #define BTUSB_SNIFFER           0x08
  49 #define BTUSB_BCM92035          0x10
  50 #define BTUSB_BROKEN_ISOC       0x20
  51 #define BTUSB_WRONG_SCO_MTU     0x40
  52 #define BTUSB_ATH3012           0x80
  53 #define BTUSB_INTEL             0x100
  54 #define BTUSB_INTEL_BOOT        0x200
  55 #define BTUSB_BCM_PATCHRAM      0x400
  56 #define BTUSB_MARVELL           0x800
  57 #define BTUSB_SWAVE             0x1000
  58 #define BTUSB_INTEL_NEW         0x2000
  59 #define BTUSB_AMP               0x4000
  60 #define BTUSB_QCA_ROME          0x8000
  61 #define BTUSB_BCM_APPLE         0x10000
  62 #define BTUSB_REALTEK           0x20000
  63 #define BTUSB_BCM2045           0x40000
  64
  65 static const struct usb_device_id btusb_table[] = {
  66         /* Generic Bluetooth USB device */
  67         { USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
  68
  69         /* Generic Bluetooth AMP device */
  70         { USB_DEVICE_INFO(0xe0, 0x01, 0x04), .driver_info = BTUSB_AMP },
  71
  72         /* Generic Bluetooth USB interface */
  73         { USB_INTERFACE_INFO(0xe0, 0x01, 0x01) },
  74
  75         /* Apple-specific (Broadcom) devices */
  76         { USB_VENDOR_AND_INTERFACE_INFO(0x05ac, 0xff, 0x01, 0x01),
  77           .driver_info = BTUSB_BCM_APPLE },
  78
  79         /* MediaTek MT76x0E */
  80         { USB_DEVICE(0x0e8d, 0x763f) },
  81
  82         /* Broadcom SoftSailing reporting vendor specific */
  83         { USB_DEVICE(0x0a5c, 0x21e1) },
  84
  85         /* Apple MacBookPro 7,1 */
  86         { USB_DEVICE(0x05ac, 0x8213) },
  87
  88         /* Apple iMac11,1 */
  89         { USB_DEVICE(0x05ac, 0x8215) },
  90
  91         /* Apple MacBookPro6,2 */
  92         { USB_DEVICE(0x05ac, 0x8218) },
  93
  94         /* Apple MacBookAir3,1, MacBookAir3,2 */
  95         { USB_DEVICE(0x05ac, 0x821b) },
  96
  97         /* Apple MacBookAir4,1 */
  98         { USB_DEVICE(0x05ac, 0x821f) },
  99
 100         /* Apple MacBookPro8,2 */
 101         { USB_DEVICE(0x05ac, 0x821a) },
 102
 103         /* Apple MacMini5,1 */
 104         { USB_DEVICE(0x05ac, 0x8281) },
 105
 106         /* AVM BlueFRITZ! USB v2.0 */
 107         { USB_DEVICE(0x057c, 0x3800), .driver_info = BTUSB_SWAVE },
 108
 109         /* Bluetooth Ultraport Module from IBM */
 110         { USB_DEVICE(0x04bf, 0x030a) },
 111
 112         /* ALPS Modules with non-standard id */
 113         { USB_DEVICE(0x044e, 0x3001) },
 114         { USB_DEVICE(0x044e, 0x3002) },
 115
 116         /* Ericsson with non-standard id */
 117         { USB_DEVICE(0x0bdb, 0x1002) },
 118
 119         /* Canyon CN-BTU1 with HID interfaces */
 120         { USB_DEVICE(0x0c10, 0x0000) },
 121
 122         /* Broadcom BCM20702A0 */
 123         { USB_DEVICE(0x413c, 0x8197) },
 124
 125         /* Broadcom BCM20702B0 (Dynex/Insignia) */
 126         { USB_DEVICE(0x19ff, 0x0239), .driver_info = BTUSB_BCM_PATCHRAM },
 127
 128         /* Broadcom BCM43142A0 (Foxconn/Lenovo) */
 129         { USB_DEVICE(0x105b, 0xe065), .driver_info = BTUSB_BCM_PATCHRAM },
 130
 131         /* Foxconn - Hon Hai */
 132         { USB_VENDOR_AND_INTERFACE_INFO(0x0489, 0xff, 0x01, 0x01),
 133           .driver_info = BTUSB_BCM_PATCHRAM },
 134
 135         /* Lite-On Technology - Broadcom based */
 136         { USB_VENDOR_AND_INTERFACE_INFO(0x04ca, 0xff, 0x01, 0x01),
 137           .driver_info = BTUSB_BCM_PATCHRAM },
 138
 139         /* Broadcom devices with vendor specific id */
 140         { USB_VENDOR_AND_INTERFACE_INFO(0x0a5c, 0xff, 0x01, 0x01),
 141           .driver_info = BTUSB_BCM_PATCHRAM },
 142
 143         /* ASUSTek Computer - Broadcom based */
 144         { USB_VENDOR_AND_INTERFACE_INFO(0x0b05, 0xff, 0x01, 0x01),
 145           .driver_info = BTUSB_BCM_PATCHRAM },
 146
 147         /* Belkin F8065bf - Broadcom based */
 148         { USB_VENDOR_AND_INTERFACE_INFO(0x050d, 0xff, 0x01, 0x01),
 149           .driver_info = BTUSB_BCM_PATCHRAM },
 150
 151         /* IMC Networks - Broadcom based */
 152         { USB_VENDOR_AND_INTERFACE_INFO(0x13d3, 0xff, 0x01, 0x01),
 153           .driver_info = BTUSB_BCM_PATCHRAM },
 154
 155         /* Intel Bluetooth USB Bootloader (RAM module) */
 156         { USB_DEVICE(0x8087, 0x0a5a),
 157           .driver_info = BTUSB_INTEL_BOOT | BTUSB_BROKEN_ISOC },
 158
 159         { }     /* Terminating entry */
 160 };
 161
 162 MODULE_DEVICE_TABLE(usb, btusb_table);
 163
 164 static const struct usb_device_id blacklist_table[] = {
 165         /* CSR BlueCore devices */
 166         { USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
 167
 168         /* Broadcom BCM2033 without firmware */
 169         { USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
 170
 171         /* Broadcom BCM2045 devices */
 172         { USB_DEVICE(0x0a5c, 0x2045), .driver_info = BTUSB_BCM2045 },
 173
 174         /* Atheros 3011 with sflash firmware */
 175         { USB_DEVICE(0x0489, 0xe027), .driver_info = BTUSB_IGNORE },
 176         { USB_DEVICE(0x0489, 0xe03d), .driver_info = BTUSB_IGNORE },
 177         { USB_DEVICE(0x04f2, 0xaff1), .driver_info = BTUSB_IGNORE },
 178         { USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
 179         { USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
 180         { USB_DEVICE(0x0cf3, 0xe019), .driver_info = BTUSB_IGNORE },
 181         { USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
 182
 183         /* Atheros AR9285 Malbec with sflash firmware */
 184         { USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
 185
 186         /* Atheros 3012 with sflash firmware */
 187         { USB_DEVICE(0x0489, 0xe04d), .driver_info = BTUSB_ATH3012 },
 188         { USB_DEVICE(0x0489, 0xe04e), .driver_info = BTUSB_ATH3012 },
 189         { USB_DEVICE(0x0489, 0xe056), .driver_info = BTUSB_ATH3012 },
 190         { USB_DEVICE(0x0489, 0xe057), .driver_info = BTUSB_ATH3012 },
 191         { USB_DEVICE(0x0489, 0xe05f), .driver_info = BTUSB_ATH3012 },
 192         { USB_DEVICE(0x0489, 0xe076), .driver_info = BTUSB_ATH3012 },
 193         { USB_DEVICE(0x0489, 0xe078), .driver_info = BTUSB_ATH3012 },
 194         { USB_DEVICE(0x04c5, 0x1330), .driver_info = BTUSB_ATH3012 },
 195         { USB_DEVICE(0x04ca, 0x3004), .driver_info = BTUSB_ATH3012 },
 196         { USB_DEVICE(0x04ca, 0x3005), .driver_info = BTUSB_ATH3012 },
 197         { USB_DEVICE(0x04ca, 0x3006), .driver_info = BTUSB_ATH3012 },
 198         { USB_DEVICE(0x04ca, 0x3007), .driver_info = BTUSB_ATH3012 },
 199         { USB_DEVICE(0x04ca, 0x3008), .driver_info = BTUSB_ATH3012 },
 200         { USB_DEVICE(0x04ca, 0x300b), .driver_info = BTUSB_ATH3012 },
 201         { USB_DEVICE(0x04ca, 0x300d), .driver_info = BTUSB_ATH3012 },
 202         { USB_DEVICE(0x04ca, 0x300f), .driver_info = BTUSB_ATH3012 },
 203         { USB_DEVICE(0x04ca, 0x3010), .driver_info = BTUSB_ATH3012 },
 204         { USB_DEVICE(0x0930, 0x0219), .driver_info = BTUSB_ATH3012 },
 205         { USB_DEVICE(0x0930, 0x021c), .driver_info = BTUSB_ATH3012 },
 206         { USB_DEVICE(0x0930, 0x0220), .driver_info = BTUSB_ATH3012 },
 207         { USB_DEVICE(0x0930, 0x0227), .driver_info = BTUSB_ATH3012 },
 208         { USB_DEVICE(0x0b05, 0x17d0), .driver_info = BTUSB_ATH3012 },
 209         { USB_DEVICE(0x0cf3, 0x0036), .driver_info = BTUSB_ATH3012 },
 210         { USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
 211         { USB_DEVICE(0x0cf3, 0x3008), .driver_info = BTUSB_ATH3012 },
 212         { USB_DEVICE(0x0cf3, 0x311d), .driver_info = BTUSB_ATH3012 },
 213         { USB_DEVICE(0x0cf3, 0x311e), .driver_info = BTUSB_ATH3012 },
 214         { USB_DEVICE(0x0cf3, 0x311f), .driver_info = BTUSB_ATH3012 },
 215         { USB_DEVICE(0x0cf3, 0x3121), .driver_info = BTUSB_ATH3012 },
 216         { USB_DEVICE(0x0cf3, 0x817a), .driver_info = BTUSB_ATH3012 },
 217         { USB_DEVICE(0x0cf3, 0x817b), .driver_info = BTUSB_ATH3012 },
 218         { USB_DEVICE(0x0cf3, 0xe003), .driver_info = BTUSB_ATH3012 },
 219         { USB_DEVICE(0x0cf3, 0xe004), .driver_info = BTUSB_ATH3012 },
 220         { USB_DEVICE(0x0cf3, 0xe005), .driver_info = BTUSB_ATH3012 },
 221         { USB_DEVICE(0x0cf3, 0xe006), .driver_info = BTUSB_ATH3012 },
 222         { USB_DEVICE(0x13d3, 0x3362), .driver_info = BTUSB_ATH3012 },
 223         { USB_DEVICE(0x13d3, 0x3375), .driver_info = BTUSB_ATH3012 },
 224         { USB_DEVICE(0x13d3, 0x3393), .driver_info = BTUSB_ATH3012 },
 225         { USB_DEVICE(0x13d3, 0x3402), .driver_info = BTUSB_ATH3012 },
 226         { USB_DEVICE(0x13d3, 0x3408), .driver_info = BTUSB_ATH3012 },
 227         { USB_DEVICE(0x13d3, 0x3423), .driver_info = BTUSB_ATH3012 },
 228         { USB_DEVICE(0x13d3, 0x3432), .driver_info = BTUSB_ATH3012 },
 229         { USB_DEVICE(0x13d3, 0x3474), .driver_info = BTUSB_ATH3012 },
 230
 231         /* Atheros AR5BBU12 with sflash firmware */
 232         { USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
 233
 234         /* Atheros AR5BBU12 with sflash firmware */
 235         { USB_DEVICE(0x0489, 0xe036), .driver_info = BTUSB_ATH3012 },
 236         { USB_DEVICE(0x0489, 0xe03c), .driver_info = BTUSB_ATH3012 },
 237
 238         /* QCA ROME chipset */
 239         { USB_DEVICE(0x0cf3, 0xe007), .driver_info = BTUSB_QCA_ROME },
 240         { USB_DEVICE(0x0cf3, 0xe300), .driver_info = BTUSB_QCA_ROME },
 241         { USB_DEVICE(0x0cf3, 0xe360), .driver_info = BTUSB_QCA_ROME },
 242
 243         /* Broadcom BCM2035 */
 244         { USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
 245         { USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
 246         { USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
 247
 248         /* Broadcom BCM2045 */
 249         { USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
 250         { USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
 251
 252         /* IBM/Lenovo ThinkPad with Broadcom chip */
 253         { USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
 254         { USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
 255
 256         /* HP laptop with Broadcom chip */
 257         { USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
 258
 259         /* Dell laptop with Broadcom chip */
 260         { USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
 261
 262         /* Dell Wireless 370 and 410 devices */
 263         { USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
 264         { USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
 265
 266         /* Belkin F8T012 and F8T013 devices */
 267         { USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
 268         { USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
 269
 270         /* Asus WL-BTD202 device */
 271         { USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
 272
 273         /* Kensington Bluetooth USB adapter */
 274         { USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
 275
 276         /* RTX Telecom based adapters with buggy SCO support */
 277         { USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
 278         { USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
 279
 280         /* CONWISE Technology based adapters with buggy SCO support */
 281         { USB_DEVICE(0x0e5e, 0x6622), .driver_info = BTUSB_BROKEN_ISOC },
 282
 283         /* Roper Class 1 Bluetooth Dongle (Silicon Wave based) */
 284         { USB_DEVICE(0x1310, 0x0001), .driver_info = BTUSB_SWAVE },
 285
 286         /* Digianswer devices */
 287         { USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
 288         { USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
 289
 290         /* CSR BlueCore Bluetooth Sniffer */
 291         { USB_DEVICE(0x0a12, 0x0002),
 292           .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
 293
 294         /* Frontline ComProbe Bluetooth Sniffer */
 295         { USB_DEVICE(0x16d3, 0x0002),
 296           .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
 297
 298         /* Marvell Bluetooth devices */
 299         { USB_DEVICE(0x1286, 0x2044), .driver_info = BTUSB_MARVELL },
 300         { USB_DEVICE(0x1286, 0x2046), .driver_info = BTUSB_MARVELL },
 301
 302         /* Intel Bluetooth devices */
 303         { USB_DEVICE(0x8087, 0x07da), .driver_info = BTUSB_CSR },
 304         { USB_DEVICE(0x8087, 0x07dc), .driver_info = BTUSB_INTEL },
 305         { USB_DEVICE(0x8087, 0x0a2a), .driver_info = BTUSB_INTEL },
 306         { USB_DEVICE(0x8087, 0x0a2b), .driver_info = BTUSB_INTEL_NEW },
 307
 308         /* Other Intel Bluetooth devices */
 309         { USB_VENDOR_AND_INTERFACE_INFO(0x8087, 0xe0, 0x01, 0x01),
 310           .driver_info = BTUSB_IGNORE },
 311
 312         /* Realtek Bluetooth devices */
 313         { USB_VENDOR_AND_INTERFACE_INFO(0x0bda, 0xe0, 0x01, 0x01),
 314           .driver_info = BTUSB_REALTEK },
 315
 316         /* Additional Realtek 8723AE Bluetooth devices */
 317         { USB_DEVICE(0x0930, 0x021d), .driver_info = BTUSB_REALTEK },
 318         { USB_DEVICE(0x13d3, 0x3394), .driver_info = BTUSB_REALTEK },
 319
 320         /* Additional Realtek 8723BE Bluetooth devices */
 321         { USB_DEVICE(0x0489, 0xe085), .driver_info = BTUSB_REALTEK },
 322         { USB_DEVICE(0x0489, 0xe08b), .driver_info = BTUSB_REALTEK },
 323         { USB_DEVICE(0x13d3, 0x3410), .driver_info = BTUSB_REALTEK },
 324         { USB_DEVICE(0x13d3, 0x3416), .driver_info = BTUSB_REALTEK },
 325         { USB_DEVICE(0x13d3, 0x3459), .driver_info = BTUSB_REALTEK },
 326
 327         /* Additional Realtek 8821AE Bluetooth devices */
 328         { USB_DEVICE(0x0b05, 0x17dc), .driver_info = BTUSB_REALTEK },
 329         { USB_DEVICE(0x13d3, 0x3414), .driver_info = BTUSB_REALTEK },
 330         { USB_DEVICE(0x13d3, 0x3458), .driver_info = BTUSB_REALTEK },
 331         { USB_DEVICE(0x13d3, 0x3461), .driver_info = BTUSB_REALTEK },
 332         { USB_DEVICE(0x13d3, 0x3462), .driver_info = BTUSB_REALTEK },
 333
 334         /* Silicon Wave based devices */
 335         { USB_DEVICE(0x0c10, 0x0000), .driver_info = BTUSB_SWAVE },
 336
 337         { }     /* Terminating entry */
 338 };
 339
 340 #define BTUSB_MAX_ISOC_FRAMES   10
 341
 342 #define BTUSB_INTR_RUNNING      0
 343 #define BTUSB_BULK_RUNNING      1
 344 #define BTUSB_ISOC_RUNNING      2
 345 #define BTUSB_SUSPENDING        3
 346 #define BTUSB_DID_ISO_RESUME    4
 347 #define BTUSB_BOOTLOADER        5
 348 #define BTUSB_DOWNLOADING       6
 349 #define BTUSB_FIRMWARE_LOADED   7
 350 #define BTUSB_FIRMWARE_FAILED   8
 351 #define BTUSB_BOOTING           9
 352 #define BTUSB_RESET_RESUME      10
 353 #define BTUSB_DIAG_RUNNING      11
 354
 355 struct btusb_data {
 356         struct hci_dev       *hdev;
 357         struct usb_device    *udev;
 358         struct usb_interface *intf;
 359         struct usb_interface *isoc;
 360         struct usb_interface *diag;
 361
 362         unsigned long flags;
 363
 364         struct work_struct work;
 365         struct work_struct waker;
 366
 367         struct usb_anchor deferred;
 368         struct usb_anchor tx_anchor;
 369         int tx_in_flight;
 370         spinlock_t txlock;
 371
 372         struct usb_anchor intr_anchor;
 373         struct usb_anchor bulk_anchor;
 374         struct usb_anchor isoc_anchor;
 375         struct usb_anchor diag_anchor;
 376         spinlock_t rxlock;
 377
 378         struct sk_buff *evt_skb;
 379         struct sk_buff *acl_skb;
 380         struct sk_buff *sco_skb;
 381
 382         struct usb_endpoint_descriptor *intr_ep;
 383         struct usb_endpoint_descriptor *bulk_tx_ep;
 384         struct usb_endpoint_descriptor *bulk_rx_ep;
 385         struct usb_endpoint_descriptor *isoc_tx_ep;
 386         struct usb_endpoint_descriptor *isoc_rx_ep;
 387         struct usb_endpoint_descriptor *diag_tx_ep;
 388         struct usb_endpoint_descriptor *diag_rx_ep;
 389
 390         __u8 cmdreq_type;
 391         __u8 cmdreq;
 392
 393         unsigned int sco_num;
 394         int isoc_altsetting;
 395         int suspend_count;
 396
 397         int (*recv_event)(struct hci_dev *hdev, struct sk_buff *skb);
 398         int (*recv_bulk)(struct btusb_data *data, void *buffer, int count);
 399
 400         int (*setup_on_usb)(struct hci_dev *hdev);
 401 };
 402
 403 static inline void btusb_free_frags(struct btusb_data *data)
 404 {
 405         unsigned long flags;
 406
 407         spin_lock_irqsave(&data->rxlock, flags);
 408
 409         kfree_skb(data->evt_skb);
 410         data->evt_skb = NULL;
 411
 412         kfree_skb(data->acl_skb);
 413         data->acl_skb = NULL;
 414
 415         kfree_skb(data->sco_skb);
 416         data->sco_skb = NULL;
 417
 418         spin_unlock_irqrestore(&data->rxlock, flags);
 419 }
 420
 421 static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count)
 422 {
 423         struct sk_buff *skb;
 424         int err = 0;
 425
 426         spin_lock(&data->rxlock);
 427         skb = data->evt_skb;
 428
 429         while (count) {
 430                 int len;
 431
 432                 if (!skb) {
 433                         skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC);
 434                         if (!skb) {
 435                                 err = -ENOMEM;
 436                                 break;
 437                         }
 438
 439                         bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
 440                         bt_cb(skb)->expect = HCI_EVENT_HDR_SIZE;
 441                 }
 442
 443                 len = min_t(uint, bt_cb(skb)->expect, count);
 444                 memcpy(skb_put(skb, len), buffer, len);
 445
 446                 count -= len;
 447                 buffer += len;
 448                 bt_cb(skb)->expect -= len;
 449
 450                 if (skb->len == HCI_EVENT_HDR_SIZE) {
 451                         /* Complete event header */
 452                         bt_cb(skb)->expect = hci_event_hdr(skb)->plen;
 453
 454                         if (skb_tailroom(skb) < bt_cb(skb)->expect) {
 455                                 kfree_skb(skb);
 456                                 skb = NULL;
 457
 458                                 err = -EILSEQ;
 459                                 break;
 460                         }
 461                 }
 462
 463                 if (bt_cb(skb)->expect == 0) {
 464                         /* Complete frame */
 465                         data->recv_event(data->hdev, skb);
 466                         skb = NULL;
 467                 }
 468         }
 469
 470         data->evt_skb = skb;
 471         spin_unlock(&data->rxlock);
 472
 473         return err;
 474 }
 475
 476 static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count)
 477 {
 478         struct sk_buff *skb;
 479         int err = 0;
 480
 481         spin_lock(&data->rxlock);
 482         skb = data->acl_skb;
 483
 484         while (count) {
 485                 int len;
 486
 487                 if (!skb) {
 488                         skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
 489                         if (!skb) {
 490                                 err = -ENOMEM;
 491                                 break;
 492                         }
 493
 494                         bt_cb(skb)->pkt_type = HCI_ACLDATA_PKT;
 495                         bt_cb(skb)->expect = HCI_ACL_HDR_SIZE;
 496                 }
 497
 498                 len = min_t(uint, bt_cb(skb)->expect, count);
 499                 memcpy(skb_put(skb, len), buffer, len);
 500
 501                 count -= len;
 502                 buffer += len;
 503                 bt_cb(skb)->expect -= len;
 504
 505                 if (skb->len == HCI_ACL_HDR_SIZE) {
 506                         __le16 dlen = hci_acl_hdr(skb)->dlen;
 507
 508                         /* Complete ACL header */
 509                         bt_cb(skb)->expect = __le16_to_cpu(dlen);
 510
 511                         if (skb_tailroom(skb) < bt_cb(skb)->expect) {
 512                                 kfree_skb(skb);
 513                                 skb = NULL;
 514
 515                                 err = -EILSEQ;
 516                                 break;
 517                         }
 518                 }
 519
 520                 if (bt_cb(skb)->expect == 0) {
 521                         /* Complete frame */
 522                         hci_recv_frame(data->hdev, skb);
 523                         skb = NULL;
 524                 }
 525         }
 526
 527         data->acl_skb = skb;
 528         spin_unlock(&data->rxlock);
 529
 530         return err;
 531 }
 532
 533 static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count)
 534 {
 535         struct sk_buff *skb;
 536         int err = 0;
 537
 538         spin_lock(&data->rxlock);
 539         skb = data->sco_skb;
 540
 541         while (count) {
 542                 int len;
 543
 544                 if (!skb) {
 545                         skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC);
 546                         if (!skb) {
 547                                 err = -ENOMEM;
 548                                 break;
 549                         }
 550
 551                         bt_cb(skb)->pkt_type = HCI_SCODATA_PKT;
 552                         bt_cb(skb)->expect = HCI_SCO_HDR_SIZE;
 553                 }
 554
 555                 len = min_t(uint, bt_cb(skb)->expect, count);
 556                 memcpy(skb_put(skb, len), buffer, len);
 557
 558                 count -= len;
 559                 buffer += len;
 560                 bt_cb(skb)->expect -= len;
 561
 562                 if (skb->len == HCI_SCO_HDR_SIZE) {
 563                         /* Complete SCO header */
 564                         bt_cb(skb)->expect = hci_sco_hdr(skb)->dlen;
 565
 566                         if (skb_tailroom(skb) < bt_cb(skb)->expect) {
 567                                 kfree_skb(skb);
 568                                 skb = NULL;
 569
 570                                 err = -EILSEQ;
 571                                 break;
 572                         }
 573                 }
 574
 575                 if (bt_cb(skb)->expect == 0) {
 576                         /* Complete frame */
 577                         hci_recv_frame(data->hdev, skb);
 578                         skb = NULL;
 579                 }
 580         }
 581
 582         data->sco_skb = skb;
 583         spin_unlock(&data->rxlock);
 584
 585         return err;
 586 }
 587
 588 static void btusb_intr_complete(struct urb *urb)
 589 {
 590         struct hci_dev *hdev = urb->context;
 591         struct btusb_data *data = hci_get_drvdata(hdev);
 592         int err;
 593
 594         BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 595                urb->actual_length);
 596
 597         if (!test_bit(HCI_RUNNING, &hdev->flags))
 598                 return;
 599
 600         if (urb->status == 0) {
 601                 hdev->stat.byte_rx += urb->actual_length;
 602
 603                 if (btusb_recv_intr(data, urb->transfer_buffer,
 604                                     urb->actual_length) < 0) {
 605                         BT_ERR("%s corrupted event packet", hdev->name);
 606                         hdev->stat.err_rx++;
 607                 }
 608         } else if (urb->status == -ENOENT) {
 609                 /* Avoid suspend failed when usb_kill_urb */
 610                 return;
 611         }
 612
 613         if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
 614                 return;
 615
 616         usb_mark_last_busy(data->udev);
 617         usb_anchor_urb(urb, &data->intr_anchor);
 618
 619         err = usb_submit_urb(urb, GFP_ATOMIC);
 620         if (err < 0) {
 621                 /* -EPERM: urb is being killed;
 622                  * -ENODEV: device got disconnected */
 623                 if (err != -EPERM && err != -ENODEV)
 624                         BT_ERR("%s urb %p failed to resubmit (%d)",
 625                                hdev->name, urb, -err);
 626                 usb_unanchor_urb(urb);
 627         }
 628 }
 629
 630 static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
 631 {
 632         struct btusb_data *data = hci_get_drvdata(hdev);
 633         struct urb *urb;
 634         unsigned char *buf;
 635         unsigned int pipe;
 636         int err, size;
 637
 638         BT_DBG("%s", hdev->name);
 639
 640         if (!data->intr_ep)
 641                 return -ENODEV;
 642
 643         urb = usb_alloc_urb(0, mem_flags);
 644         if (!urb)
 645                 return -ENOMEM;
 646
 647         size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
 648
 649         buf = kmalloc(size, mem_flags);
 650         if (!buf) {
 651                 usb_free_urb(urb);
 652                 return -ENOMEM;
 653         }
 654
 655         pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
 656
 657         usb_fill_int_urb(urb, data->udev, pipe, buf, size,
 658                          btusb_intr_complete, hdev, data->intr_ep->bInterval);
 659
 660         urb->transfer_flags |= URB_FREE_BUFFER;
 661
 662         usb_anchor_urb(urb, &data->intr_anchor);
 663
 664         err = usb_submit_urb(urb, mem_flags);
 665         if (err < 0) {
 666                 if (err != -EPERM && err != -ENODEV)
 667                         BT_ERR("%s urb %p submission failed (%d)",
 668                                hdev->name, urb, -err);
 669                 usb_unanchor_urb(urb);
 670         }
 671
 672         usb_free_urb(urb);
 673
 674         return err;
 675 }
 676
 677 static void btusb_bulk_complete(struct urb *urb)
 678 {
 679         struct hci_dev *hdev = urb->context;
 680         struct btusb_data *data = hci_get_drvdata(hdev);
 681         int err;
 682
 683         BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 684                urb->actual_length);
 685
 686         if (!test_bit(HCI_RUNNING, &hdev->flags))
 687                 return;
 688
 689         if (urb->status == 0) {
 690                 hdev->stat.byte_rx += urb->actual_length;
 691
 692                 if (data->recv_bulk(data, urb->transfer_buffer,
 693                                     urb->actual_length) < 0) {
 694                         BT_ERR("%s corrupted ACL packet", hdev->name);
 695                         hdev->stat.err_rx++;
 696                 }
 697         } else if (urb->status == -ENOENT) {
 698                 /* Avoid suspend failed when usb_kill_urb */
 699                 return;
 700         }
 701
 702         if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
 703                 return;
 704
 705         usb_anchor_urb(urb, &data->bulk_anchor);
 706         usb_mark_last_busy(data->udev);
 707
 708         err = usb_submit_urb(urb, GFP_ATOMIC);
 709         if (err < 0) {
 710                 /* -EPERM: urb is being killed;
 711                  * -ENODEV: device got disconnected */
 712                 if (err != -EPERM && err != -ENODEV)
 713                         BT_ERR("%s urb %p failed to resubmit (%d)",
 714                                hdev->name, urb, -err);
 715                 usb_unanchor_urb(urb);
 716         }
 717 }
 718
 719 static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
 720 {
 721         struct btusb_data *data = hci_get_drvdata(hdev);
 722         struct urb *urb;
 723         unsigned char *buf;
 724         unsigned int pipe;
 725         int err, size = HCI_MAX_FRAME_SIZE;
 726
 727         BT_DBG("%s", hdev->name);
 728
 729         if (!data->bulk_rx_ep)
 730                 return -ENODEV;
 731
 732         urb = usb_alloc_urb(0, mem_flags);
 733         if (!urb)
 734                 return -ENOMEM;
 735
 736         buf = kmalloc(size, mem_flags);
 737         if (!buf) {
 738                 usb_free_urb(urb);
 739                 return -ENOMEM;
 740         }
 741
 742         pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
 743
 744         usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
 745                           btusb_bulk_complete, hdev);
 746
 747         urb->transfer_flags |= URB_FREE_BUFFER;
 748
 749         usb_mark_last_busy(data->udev);
 750         usb_anchor_urb(urb, &data->bulk_anchor);
 751
 752         err = usb_submit_urb(urb, mem_flags);
 753         if (err < 0) {
 754                 if (err != -EPERM && err != -ENODEV)
 755                         BT_ERR("%s urb %p submission failed (%d)",
 756                                hdev->name, urb, -err);
 757                 usb_unanchor_urb(urb);
 758         }
 759
 760         usb_free_urb(urb);
 761
 762         return err;
 763 }
 764
 765 static void btusb_isoc_complete(struct urb *urb)
 766 {
 767         struct hci_dev *hdev = urb->context;
 768         struct btusb_data *data = hci_get_drvdata(hdev);
 769         int i, err;
 770
 771         BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 772                urb->actual_length);
 773
 774         if (!test_bit(HCI_RUNNING, &hdev->flags))
 775                 return;
 776
 777         if (urb->status == 0) {
 778                 for (i = 0; i < urb->number_of_packets; i++) {
 779                         unsigned int offset = urb->iso_frame_desc[i].offset;
 780                         unsigned int length = urb->iso_frame_desc[i].actual_length;
 781
 782                         if (urb->iso_frame_desc[i].status)
 783                                 continue;
 784
 785                         hdev->stat.byte_rx += length;
 786
 787                         if (btusb_recv_isoc(data, urb->transfer_buffer + offset,
 788                                             length) < 0) {
 789                                 BT_ERR("%s corrupted SCO packet", hdev->name);
 790                                 hdev->stat.err_rx++;
 791                         }
 792                 }
 793         } else if (urb->status == -ENOENT) {
 794                 /* Avoid suspend failed when usb_kill_urb */
 795                 return;
 796         }
 797
 798         if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
 799                 return;
 800
 801         usb_anchor_urb(urb, &data->isoc_anchor);
 802
 803         err = usb_submit_urb(urb, GFP_ATOMIC);
 804         if (err < 0) {
 805                 /* -EPERM: urb is being killed;
 806                  * -ENODEV: device got disconnected */
 807                 if (err != -EPERM && err != -ENODEV)
 808                         BT_ERR("%s urb %p failed to resubmit (%d)",
 809                                hdev->name, urb, -err);
 810                 usb_unanchor_urb(urb);
 811         }
 812 }
 813
 814 static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
 815 {
 816         int i, offset = 0;
 817
 818         BT_DBG("len %d mtu %d", len, mtu);
 819
 820         for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
 821                                         i++, offset += mtu, len -= mtu) {
 822                 urb->iso_frame_desc[i].offset = offset;
 823                 urb->iso_frame_desc[i].length = mtu;
 824         }
 825
 826         if (len && i < BTUSB_MAX_ISOC_FRAMES) {
 827                 urb->iso_frame_desc[i].offset = offset;
 828                 urb->iso_frame_desc[i].length = len;
 829                 i++;
 830         }
 831
 832         urb->number_of_packets = i;
 833 }
 834
 835 static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
 836 {
 837         struct btusb_data *data = hci_get_drvdata(hdev);
 838         struct urb *urb;
 839         unsigned char *buf;
 840         unsigned int pipe;
 841         int err, size;
 842
 843         BT_DBG("%s", hdev->name);
 844
 845         if (!data->isoc_rx_ep)
 846                 return -ENODEV;
 847
 848         urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
 849         if (!urb)
 850                 return -ENOMEM;
 851
 852         size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
 853                                                 BTUSB_MAX_ISOC_FRAMES;
 854
 855         buf = kmalloc(size, mem_flags);
 856         if (!buf) {
 857                 usb_free_urb(urb);
 858                 return -ENOMEM;
 859         }
 860
 861         pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
 862
 863         usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_isoc_complete,
 864                          hdev, data->isoc_rx_ep->bInterval);
 865
 866         urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
 867
 868         __fill_isoc_descriptor(urb, size,
 869                                le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
 870
 871         usb_anchor_urb(urb, &data->isoc_anchor);
 872
 873         err = usb_submit_urb(urb, mem_flags);
 874         if (err < 0) {
 875                 if (err != -EPERM && err != -ENODEV)
 876                         BT_ERR("%s urb %p submission failed (%d)",
 877                                hdev->name, urb, -err);
 878                 usb_unanchor_urb(urb);
 879         }
 880
 881         usb_free_urb(urb);
 882
 883         return err;
 884 }
 885
 886 static void btusb_diag_complete(struct urb *urb)
 887 {
 888         struct hci_dev *hdev = urb->context;
 889         struct btusb_data *data = hci_get_drvdata(hdev);
 890         int err;
 891
 892         BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 893                urb->actual_length);
 894
 895         if (urb->status == 0) {
 896                 struct sk_buff *skb;
 897
 898                 skb = bt_skb_alloc(urb->actual_length, GFP_ATOMIC);
 899                 if (skb) {
 900                         memcpy(skb_put(skb, urb->actual_length),
 901                                urb->transfer_buffer, urb->actual_length);
 902                         hci_recv_diag(hdev, skb);
 903                 }
 904         } else if (urb->status == -ENOENT) {
 905                 /* Avoid suspend failed when usb_kill_urb */
 906                 return;
 907         }
 908
 909         if (!test_bit(BTUSB_DIAG_RUNNING, &data->flags))
 910                 return;
 911
 912         usb_anchor_urb(urb, &data->diag_anchor);
 913         usb_mark_last_busy(data->udev);
 914
 915         err = usb_submit_urb(urb, GFP_ATOMIC);
 916         if (err < 0) {
 917                 /* -EPERM: urb is being killed;
 918                  * -ENODEV: device got disconnected */
 919                 if (err != -EPERM && err != -ENODEV)
 920                         BT_ERR("%s urb %p failed to resubmit (%d)",
 921                                hdev->name, urb, -err);
 922                 usb_unanchor_urb(urb);
 923         }
 924 }
 925
 926 static int btusb_submit_diag_urb(struct hci_dev *hdev, gfp_t mem_flags)
 927 {
 928         struct btusb_data *data = hci_get_drvdata(hdev);
 929         struct urb *urb;
 930         unsigned char *buf;
 931         unsigned int pipe;
 932         int err, size = HCI_MAX_FRAME_SIZE;
 933
 934         BT_DBG("%s", hdev->name);
 935
 936         if (!data->diag_rx_ep)
 937                 return -ENODEV;
 938
 939         urb = usb_alloc_urb(0, mem_flags);
 940         if (!urb)
 941                 return -ENOMEM;
 942
 943         buf = kmalloc(size, mem_flags);
 944         if (!buf) {
 945                 usb_free_urb(urb);
 946                 return -ENOMEM;
 947         }
 948
 949         pipe = usb_rcvbulkpipe(data->udev, data->diag_rx_ep->bEndpointAddress);
 950
 951         usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
 952                           btusb_diag_complete, hdev);
 953
 954         urb->transfer_flags |= URB_FREE_BUFFER;
 955
 956         usb_mark_last_busy(data->udev);
 957         usb_anchor_urb(urb, &data->diag_anchor);
 958
 959         err = usb_submit_urb(urb, mem_flags);
 960         if (err < 0) {
 961                 if (err != -EPERM && err != -ENODEV)
 962                         BT_ERR("%s urb %p submission failed (%d)",
 963                                hdev->name, urb, -err);
 964                 usb_unanchor_urb(urb);
 965         }
 966
 967         usb_free_urb(urb);
 968
 969         return err;
 970 }
 971
 972 static void btusb_tx_complete(struct urb *urb)
 973 {
 974         struct sk_buff *skb = urb->context;
 975         struct hci_dev *hdev = (struct hci_dev *)skb->dev;
 976         struct btusb_data *data = hci_get_drvdata(hdev);
 977
 978         BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 979                urb->actual_length);
 980
 981         if (!test_bit(HCI_RUNNING, &hdev->flags))
 982                 goto done;
 983
 984         if (!urb->status)
 985                 hdev->stat.byte_tx += urb->transfer_buffer_length;
 986         else
 987                 hdev->stat.err_tx++;
 988
 989 done:
 990         spin_lock(&data->txlock);
 991         data->tx_in_flight--;
 992         spin_unlock(&data->txlock);
 993
 994         kfree(urb->setup_packet);
 995
 996         kfree_skb(skb);
 997 }
 998
 999 static void btusb_isoc_tx_complete(struct urb *urb)
1000 {
1001         struct sk_buff *skb = urb->context;
1002         struct hci_dev *hdev = (struct hci_dev *)skb->dev;
1003
1004         BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1005                urb->actual_length);
1006
1007         if (!test_bit(HCI_RUNNING, &hdev->flags))
1008                 goto done;
1009
1010         if (!urb->status)
1011                 hdev->stat.byte_tx += urb->transfer_buffer_length;
1012         else
1013                 hdev->stat.err_tx++;
1014
1015 done:
1016         kfree(urb->setup_packet);
1017
1018         kfree_skb(skb);
1019 }
1020
1021 static int btusb_open(struct hci_dev *hdev)
1022 {
1023         struct btusb_data *data = hci_get_drvdata(hdev);
1024         int err;
1025
1026         BT_DBG("%s", hdev->name);
1027
1028         /* Patching USB firmware files prior to starting any URBs of HCI path
1029          * It is more safe to use USB bulk channel for downloading USB patch
1030          */
1031         if (data->setup_on_usb) {
1032                 err = data->setup_on_usb(hdev);
1033                 if (err < 0)
1034                         return err;
1035         }
1036
1037         err = usb_autopm_get_interface(data->intf);
1038         if (err < 0)
1039                 return err;
1040
1041         data->intf->needs_remote_wakeup = 1;
1042
1043         if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
1044                 goto done;
1045
1046         err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
1047         if (err < 0)
1048                 goto failed;
1049
1050         err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1051         if (err < 0) {
1052                 usb_kill_anchored_urbs(&data->intr_anchor);
1053                 goto failed;
1054         }
1055
1056         set_bit(BTUSB_BULK_RUNNING, &data->flags);
1057         btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1058
1059         if (data->diag) {
1060                 if (!btusb_submit_diag_urb(hdev, GFP_KERNEL))
1061                         set_bit(BTUSB_DIAG_RUNNING, &data->flags);
1062         }
1063
1064 done:
1065         usb_autopm_put_interface(data->intf);
1066         return 0;
1067
1068 failed:
1069         clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1070         usb_autopm_put_interface(data->intf);
1071         return err;
1072 }
1073
1074 static void btusb_stop_traffic(struct btusb_data *data)
1075 {
1076         usb_kill_anchored_urbs(&data->intr_anchor);
1077         usb_kill_anchored_urbs(&data->bulk_anchor);
1078         usb_kill_anchored_urbs(&data->isoc_anchor);
1079         usb_kill_anchored_urbs(&data->diag_anchor);
1080 }
1081
1082 static int btusb_close(struct hci_dev *hdev)
1083 {
1084         struct btusb_data *data = hci_get_drvdata(hdev);
1085         int err;
1086
1087         BT_DBG("%s", hdev->name);
1088
1089         cancel_work_sync(&data->work);
1090         cancel_work_sync(&data->waker);
1091
1092         clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1093         clear_bit(BTUSB_BULK_RUNNING, &data->flags);
1094         clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1095         clear_bit(BTUSB_DIAG_RUNNING, &data->flags);
1096
1097         btusb_stop_traffic(data);
1098         btusb_free_frags(data);
1099
1100         err = usb_autopm_get_interface(data->intf);
1101         if (err < 0)
1102                 goto failed;
1103
1104         data->intf->needs_remote_wakeup = 0;
1105         usb_autopm_put_interface(data->intf);
1106
1107 failed:
1108         usb_scuttle_anchored_urbs(&data->deferred);
1109         return 0;
1110 }
1111
1112 static int btusb_flush(struct hci_dev *hdev)
1113 {
1114         struct btusb_data *data = hci_get_drvdata(hdev);
1115
1116         BT_DBG("%s", hdev->name);
1117
1118         usb_kill_anchored_urbs(&data->tx_anchor);
1119         btusb_free_frags(data);
1120
1121         return 0;
1122 }
1123
1124 static struct urb *alloc_ctrl_urb(struct hci_dev *hdev, struct sk_buff *skb)
1125 {
1126         struct btusb_data *data = hci_get_drvdata(hdev);
1127         struct usb_ctrlrequest *dr;
1128         struct urb *urb;
1129         unsigned int pipe;
1130
1131         urb = usb_alloc_urb(0, GFP_KERNEL);
1132         if (!urb)
1133                 return ERR_PTR(-ENOMEM);
1134
1135         dr = kmalloc(sizeof(*dr), GFP_KERNEL);
1136         if (!dr) {
1137                 usb_free_urb(urb);
1138                 return ERR_PTR(-ENOMEM);
1139         }
1140
1141         dr->bRequestType = data->cmdreq_type;
1142         dr->bRequest     = data->cmdreq;
1143         dr->wIndex       = 0;
1144         dr->wValue       = 0;
1145         dr->wLength      = __cpu_to_le16(skb->len);
1146
1147         pipe = usb_sndctrlpipe(data->udev, 0x00);
1148
1149         usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
1150                              skb->data, skb->len, btusb_tx_complete, skb);
1151
1152         skb->dev = (void *)hdev;
1153
1154         return urb;
1155 }
1156
1157 static struct urb *alloc_bulk_urb(struct hci_dev *hdev, struct sk_buff *skb)
1158 {
1159         struct btusb_data *data = hci_get_drvdata(hdev);
1160         struct urb *urb;
1161         unsigned int pipe;
1162
1163         if (!data->bulk_tx_ep)
1164                 return ERR_PTR(-ENODEV);
1165
1166         urb = usb_alloc_urb(0, GFP_KERNEL);
1167         if (!urb)
1168                 return ERR_PTR(-ENOMEM);
1169
1170         pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress);
1171
1172         usb_fill_bulk_urb(urb, data->udev, pipe,
1173                           skb->data, skb->len, btusb_tx_complete, skb);
1174
1175         skb->dev = (void *)hdev;
1176
1177         return urb;
1178 }
1179
1180 static struct urb *alloc_isoc_urb(struct hci_dev *hdev, struct sk_buff *skb)
1181 {
1182         struct btusb_data *data = hci_get_drvdata(hdev);
1183         struct urb *urb;
1184         unsigned int pipe;
1185
1186         if (!data->isoc_tx_ep)
1187                 return ERR_PTR(-ENODEV);
1188
1189         urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_KERNEL);
1190         if (!urb)
1191                 return ERR_PTR(-ENOMEM);
1192
1193         pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress);
1194
1195         usb_fill_int_urb(urb, data->udev, pipe,
1196                          skb->data, skb->len, btusb_isoc_tx_complete,
1197                          skb, data->isoc_tx_ep->bInterval);
1198
1199         urb->transfer_flags  = URB_ISO_ASAP;
1200
1201         __fill_isoc_descriptor(urb, skb->len,
1202                                le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
1203
1204         skb->dev = (void *)hdev;
1205
1206         return urb;
1207 }
1208
1209 static int submit_tx_urb(struct hci_dev *hdev, struct urb *urb)
1210 {
1211         struct btusb_data *data = hci_get_drvdata(hdev);
1212         int err;
1213
1214         usb_anchor_urb(urb, &data->tx_anchor);
1215
1216         err = usb_submit_urb(urb, GFP_KERNEL);
1217         if (err < 0) {
1218                 if (err != -EPERM && err != -ENODEV)
1219                         BT_ERR("%s urb %p submission failed (%d)",
1220                                hdev->name, urb, -err);
1221                 kfree(urb->setup_packet);
1222                 usb_unanchor_urb(urb);
1223         } else {
1224                 usb_mark_last_busy(data->udev);
1225         }
1226
1227         usb_free_urb(urb);
1228         return err;
1229 }
1230
1231 static int submit_or_queue_tx_urb(struct hci_dev *hdev, struct urb *urb)
1232 {
1233         struct btusb_data *data = hci_get_drvdata(hdev);
1234         unsigned long flags;
1235         bool suspending;
1236
1237         spin_lock_irqsave(&data->txlock, flags);
1238         suspending = test_bit(BTUSB_SUSPENDING, &data->flags);
1239         if (!suspending)
1240                 data->tx_in_flight++;
1241         spin_unlock_irqrestore(&data->txlock, flags);
1242
1243         if (!suspending)
1244                 return submit_tx_urb(hdev, urb);
1245
1246         usb_anchor_urb(urb, &data->deferred);
1247         schedule_work(&data->waker);
1248
1249         usb_free_urb(urb);
1250         return 0;
1251 }
1252
1253 static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
1254 {
1255         struct urb *urb;
1256
1257         BT_DBG("%s", hdev->name);
1258
1259         switch (bt_cb(skb)->pkt_type) {
1260         case HCI_COMMAND_PKT:
1261                 urb = alloc_ctrl_urb(hdev, skb);
1262                 if (IS_ERR(urb))
1263                         return PTR_ERR(urb);
1264
1265                 hdev->stat.cmd_tx++;
1266                 return submit_or_queue_tx_urb(hdev, urb);
1267
1268         case HCI_ACLDATA_PKT:
1269                 urb = alloc_bulk_urb(hdev, skb);
1270                 if (IS_ERR(urb))
1271                         return PTR_ERR(urb);
1272
1273                 hdev->stat.acl_tx++;
1274                 return submit_or_queue_tx_urb(hdev, urb);
1275
1276         case HCI_SCODATA_PKT:
1277                 if (hci_conn_num(hdev, SCO_LINK) < 1)
1278                         return -ENODEV;
1279
1280                 urb = alloc_isoc_urb(hdev, skb);
1281                 if (IS_ERR(urb))
1282                         return PTR_ERR(urb);
1283
1284                 hdev->stat.sco_tx++;
1285                 return submit_tx_urb(hdev, urb);
1286         }
1287
1288         return -EILSEQ;
1289 }
1290
1291 static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
1292 {
1293         struct btusb_data *data = hci_get_drvdata(hdev);
1294
1295         BT_DBG("%s evt %d", hdev->name, evt);
1296
1297         if (hci_conn_num(hdev, SCO_LINK) != data->sco_num) {
1298                 data->sco_num = hci_conn_num(hdev, SCO_LINK);
1299                 schedule_work(&data->work);
1300         }
1301 }
1302
1303 static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
1304 {
1305         struct btusb_data *data = hci_get_drvdata(hdev);
1306         struct usb_interface *intf = data->isoc;
1307         struct usb_endpoint_descriptor *ep_desc;
1308         int i, err;
1309
1310         if (!data->isoc)
1311                 return -ENODEV;
1312
1313         err = usb_set_interface(data->udev, 1, altsetting);
1314         if (err < 0) {
1315                 BT_ERR("%s setting interface failed (%d)", hdev->name, -err);
1316                 return err;
1317         }
1318
1319         data->isoc_altsetting = altsetting;
1320
1321         data->isoc_tx_ep = NULL;
1322         data->isoc_rx_ep = NULL;
1323
1324         for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1325                 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1326
1327                 if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
1328                         data->isoc_tx_ep = ep_desc;
1329                         continue;
1330                 }
1331
1332                 if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
1333                         data->isoc_rx_ep = ep_desc;
1334                         continue;
1335                 }
1336         }
1337
1338         if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
1339                 BT_ERR("%s invalid SCO descriptors", hdev->name);
1340                 return -ENODEV;
1341         }
1342
1343         return 0;
1344 }
1345
1346 static void btusb_work(struct work_struct *work)
1347 {
1348         struct btusb_data *data = container_of(work, struct btusb_data, work);
1349         struct hci_dev *hdev = data->hdev;
1350         int new_alts;
1351         int err;
1352
1353         if (data->sco_num > 0) {
1354                 if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
1355                         err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
1356                         if (err < 0) {
1357                                 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1358                                 usb_kill_anchored_urbs(&data->isoc_anchor);
1359                                 return;
1360                         }
1361
1362                         set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
1363                 }
1364
1365                 if (hdev->voice_setting & 0x0020) {
1366                         static const int alts[3] = { 2, 4, 5 };
1367
1368                         new_alts = alts[data->sco_num - 1];
1369                 } else {
1370                         new_alts = data->sco_num;
1371                 }
1372
1373                 if (data->isoc_altsetting != new_alts) {
1374                         clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1375                         usb_kill_anchored_urbs(&data->isoc_anchor);
1376
1377                         /* When isochronous alternate setting needs to be
1378                          * changed, because SCO connection has been added
1379                          * or removed, a packet fragment may be left in the
1380                          * reassembling state. This could lead to wrongly
1381                          * assembled fragments.
1382                          *
1383                          * Clear outstanding fragment when selecting a new
1384                          * alternate setting.
1385                          */
1386                         spin_lock(&data->rxlock);
1387                         kfree_skb(data->sco_skb);
1388                         data->sco_skb = NULL;
1389                         spin_unlock(&data->rxlock);
1390
1391                         if (__set_isoc_interface(hdev, new_alts) < 0)
1392                                 return;
1393                 }
1394
1395                 if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
1396                         if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
1397                                 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1398                         else
1399                                 btusb_submit_isoc_urb(hdev, GFP_KERNEL);
1400                 }
1401         } else {
1402                 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1403                 usb_kill_anchored_urbs(&data->isoc_anchor);
1404
1405                 __set_isoc_interface(hdev, 0);
1406                 if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
1407                         usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
1408         }
1409 }
1410
1411 static void btusb_waker(struct work_struct *work)
1412 {
1413         struct btusb_data *data = container_of(work, struct btusb_data, waker);
1414         int err;
1415
1416         err = usb_autopm_get_interface(data->intf);
1417         if (err < 0)
1418                 return;
1419
1420         usb_autopm_put_interface(data->intf);
1421 }
1422
1423 static int btusb_setup_bcm92035(struct hci_dev *hdev)
1424 {
1425         struct sk_buff *skb;
1426         u8 val = 0x00;
1427
1428         BT_DBG("%s", hdev->name);
1429
1430         skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);
1431         if (IS_ERR(skb))
1432                 BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb));
1433         else
1434                 kfree_skb(skb);
1435
1436         return 0;
1437 }
1438
1439 static int btusb_setup_csr(struct hci_dev *hdev)
1440 {
1441         struct hci_rp_read_local_version *rp;
1442         struct sk_buff *skb;
1443
1444         BT_DBG("%s", hdev->name);
1445
1446         skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1447                              HCI_INIT_TIMEOUT);
1448         if (IS_ERR(skb)) {
1449                 int err = PTR_ERR(skb);
1450                 BT_ERR("%s: CSR: Local version failed (%d)", hdev->name, err);
1451                 return err;
1452         }
1453
1454         if (skb->len != sizeof(struct hci_rp_read_local_version)) {
1455                 BT_ERR("%s: CSR: Local version length mismatch", hdev->name);
1456                 kfree_skb(skb);
1457                 return -EIO;
1458         }
1459
1460         rp = (struct hci_rp_read_local_version *)skb->data;
1461
1462         /* Detect controllers which aren't real CSR ones. */
1463         if (le16_to_cpu(rp->manufacturer) != 10 ||
1464             le16_to_cpu(rp->lmp_subver) == 0x0c5c) {
1465                 /* Clear the reset quirk since this is not an actual
1466                  * early Bluetooth 1.1 device from CSR.
1467                  */
1468                 clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
1469
1470                 /* These fake CSR controllers have all a broken
1471                  * stored link key handling and so just disable it.
1472                  */
1473                 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
1474         }
1475
1476         kfree_skb(skb);
1477
1478         return 0;
1479 }
1480
1481 static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev,
1482                                                        struct intel_version *ver)
1483 {
1484         const struct firmware *fw;
1485         char fwname[64];
1486         int ret;
1487
1488         snprintf(fwname, sizeof(fwname),
1489                  "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq",
1490                  ver->hw_platform, ver->hw_variant, ver->hw_revision,
1491                  ver->fw_variant,  ver->fw_revision, ver->fw_build_num,
1492                  ver->fw_build_ww, ver->fw_build_yy);
1493
1494         ret = request_firmware(&fw, fwname, &hdev->dev);
1495         if (ret < 0) {
1496                 if (ret == -EINVAL) {
1497                         BT_ERR("%s Intel firmware file request failed (%d)",
1498                                hdev->name, ret);
1499                         return NULL;
1500                 }
1501
1502                 BT_ERR("%s failed to open Intel firmware file: %s(%d)",
1503                        hdev->name, fwname, ret);
1504
1505                 /* If the correct firmware patch file is not found, use the
1506                  * default firmware patch file instead
1507                  */
1508                 snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq",
1509                          ver->hw_platform, ver->hw_variant);
1510                 if (request_firmware(&fw, fwname, &hdev->dev) < 0) {
1511                         BT_ERR("%s failed to open default Intel fw file: %s",
1512                                hdev->name, fwname);
1513                         return NULL;
1514                 }
1515         }
1516
1517         BT_INFO("%s: Intel Bluetooth firmware file: %s", hdev->name, fwname);
1518
1519         return fw;
1520 }
1521
1522 static int btusb_setup_intel_patching(struct hci_dev *hdev,
1523                                       const struct firmware *fw,
1524                                       const u8 **fw_ptr, int *disable_patch)
1525 {
1526         struct sk_buff *skb;
1527         struct hci_command_hdr *cmd;
1528         const u8 *cmd_param;
1529         struct hci_event_hdr *evt = NULL;
1530         const u8 *evt_param = NULL;
1531         int remain = fw->size - (*fw_ptr - fw->data);
1532
1533         /* The first byte indicates the types of the patch command or event.
1534          * 0x01 means HCI command and 0x02 is HCI event. If the first bytes
1535          * in the current firmware buffer doesn't start with 0x01 or
1536          * the size of remain buffer is smaller than HCI command header,
1537          * the firmware file is corrupted and it should stop the patching
1538          * process.
1539          */
1540         if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) {
1541                 BT_ERR("%s Intel fw corrupted: invalid cmd read", hdev->name);
1542                 return -EINVAL;
1543         }
1544         (*fw_ptr)++;
1545         remain--;
1546
1547         cmd = (struct hci_command_hdr *)(*fw_ptr);
1548         *fw_ptr += sizeof(*cmd);
1549         remain -= sizeof(*cmd);
1550
1551         /* Ensure that the remain firmware data is long enough than the length
1552          * of command parameter. If not, the firmware file is corrupted.
1553          */
1554         if (remain < cmd->plen) {
1555                 BT_ERR("%s Intel fw corrupted: invalid cmd len", hdev->name);
1556                 return -EFAULT;
1557         }
1558
1559         /* If there is a command that loads a patch in the firmware
1560          * file, then enable the patch upon success, otherwise just
1561          * disable the manufacturer mode, for example patch activation
1562          * is not required when the default firmware patch file is used
1563          * because there are no patch data to load.
1564          */
1565         if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e)
1566                 *disable_patch = 0;
1567
1568         cmd_param = *fw_ptr;
1569         *fw_ptr += cmd->plen;
1570         remain -= cmd->plen;
1571
1572         /* This reads the expected events when the above command is sent to the
1573          * device. Some vendor commands expects more than one events, for
1574          * example command status event followed by vendor specific event.
1575          * For this case, it only keeps the last expected event. so the command
1576          * can be sent with __hci_cmd_sync_ev() which returns the sk_buff of
1577          * last expected event.
1578          */
1579         while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) {
1580                 (*fw_ptr)++;
1581                 remain--;
1582
1583                 evt = (struct hci_event_hdr *)(*fw_ptr);
1584                 *fw_ptr += sizeof(*evt);
1585                 remain -= sizeof(*evt);
1586
1587                 if (remain < evt->plen) {
1588                         BT_ERR("%s Intel fw corrupted: invalid evt len",
1589                                hdev->name);
1590                         return -EFAULT;
1591                 }
1592
1593                 evt_param = *fw_ptr;
1594                 *fw_ptr += evt->plen;
1595                 remain -= evt->plen;
1596         }
1597
1598         /* Every HCI commands in the firmware file has its correspond event.
1599          * If event is not found or remain is smaller than zero, the firmware
1600          * file is corrupted.
1601          */
1602         if (!evt || !evt_param || remain < 0) {
1603                 BT_ERR("%s Intel fw corrupted: invalid evt read", hdev->name);
1604                 return -EFAULT;
1605         }
1606
1607         skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen,
1608                                 cmd_param, evt->evt, HCI_INIT_TIMEOUT);
1609         if (IS_ERR(skb)) {
1610                 BT_ERR("%s sending Intel patch command (0x%4.4x) failed (%ld)",
1611                        hdev->name, cmd->opcode, PTR_ERR(skb));
1612                 return PTR_ERR(skb);
1613         }
1614
1615         /* It ensures that the returned event matches the event data read from
1616          * the firmware file. At fist, it checks the length and then
1617          * the contents of the event.
1618          */
1619         if (skb->len != evt->plen) {
1620                 BT_ERR("%s mismatch event length (opcode 0x%4.4x)", hdev->name,
1621                        le16_to_cpu(cmd->opcode));
1622                 kfree_skb(skb);
1623                 return -EFAULT;
1624         }
1625
1626         if (memcmp(skb->data, evt_param, evt->plen)) {
1627                 BT_ERR("%s mismatch event parameter (opcode 0x%4.4x)",
1628                        hdev->name, le16_to_cpu(cmd->opcode));
1629                 kfree_skb(skb);
1630                 return -EFAULT;
1631         }
1632         kfree_skb(skb);
1633
1634         return 0;
1635 }
1636
1637 static int btusb_setup_intel(struct hci_dev *hdev)
1638 {
1639         struct sk_buff *skb;
1640         const struct firmware *fw;
1641         const u8 *fw_ptr;
1642         int disable_patch;
1643         struct intel_version *ver;
1644
1645         const u8 mfg_enable[] = { 0x01, 0x00 };
1646         const u8 mfg_disable[] = { 0x00, 0x00 };
1647         const u8 mfg_reset_deactivate[] = { 0x00, 0x01 };
1648         const u8 mfg_reset_activate[] = { 0x00, 0x02 };
1649
1650         BT_DBG("%s", hdev->name);
1651
1652         /* The controller has a bug with the first HCI command sent to it
1653          * returning number of completed commands as zero. This would stall the
1654          * command processing in the Bluetooth core.
1655          *
1656          * As a workaround, send HCI Reset command first which will reset the
1657          * number of completed commands and allow normal command processing
1658          * from now on.
1659          */
1660         skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1661         if (IS_ERR(skb)) {
1662                 BT_ERR("%s sending initial HCI reset command failed (%ld)",
1663                        hdev->name, PTR_ERR(skb));
1664                 return PTR_ERR(skb);
1665         }
1666         kfree_skb(skb);
1667
1668         /* Read Intel specific controller version first to allow selection of
1669          * which firmware file to load.
1670          *
1671          * The returned information are hardware variant and revision plus
1672          * firmware variant, revision and build number.
1673          */
1674         skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT);
1675         if (IS_ERR(skb)) {
1676                 BT_ERR("%s reading Intel fw version command failed (%ld)",
1677                        hdev->name, PTR_ERR(skb));
1678                 return PTR_ERR(skb);
1679         }
1680
1681         if (skb->len != sizeof(*ver)) {
1682                 BT_ERR("%s Intel version event length mismatch", hdev->name);
1683                 kfree_skb(skb);
1684                 return -EIO;
1685         }
1686
1687         ver = (struct intel_version *)skb->data;
1688
1689         BT_INFO("%s: read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x",
1690                 hdev->name, ver->hw_platform, ver->hw_variant,
1691                 ver->hw_revision, ver->fw_variant,  ver->fw_revision,
1692                 ver->fw_build_num, ver->fw_build_ww, ver->fw_build_yy,
1693                 ver->fw_patch_num);
1694
1695         /* fw_patch_num indicates the version of patch the device currently
1696          * have. If there is no patch data in the device, it is always 0x00.
1697          * So, if it is other than 0x00, no need to patch the device again.
1698          */
1699         if (ver->fw_patch_num) {
1700                 BT_INFO("%s: Intel device is already patched. patch num: %02x",
1701                         hdev->name, ver->fw_patch_num);
1702                 kfree_skb(skb);
1703                 btintel_check_bdaddr(hdev);
1704                 return 0;
1705         }
1706
1707         /* Opens the firmware patch file based on the firmware version read
1708          * from the controller. If it fails to open the matching firmware
1709          * patch file, it tries to open the default firmware patch file.
1710          * If no patch file is found, allow the device to operate without
1711          * a patch.
1712          */
1713         fw = btusb_setup_intel_get_fw(hdev, ver);
1714         if (!fw) {
1715                 kfree_skb(skb);
1716                 btintel_check_bdaddr(hdev);
1717                 return 0;
1718         }
1719         fw_ptr = fw->data;
1720
1721         kfree_skb(skb);
1722
1723         /* This Intel specific command enables the manufacturer mode of the
1724          * controller.
1725          *
1726          * Only while this mode is enabled, the driver can download the
1727          * firmware patch data and configuration parameters.
1728          */
1729         skb = __hci_cmd_sync(hdev, 0xfc11, 2, mfg_enable, HCI_INIT_TIMEOUT);
1730         if (IS_ERR(skb)) {
1731                 BT_ERR("%s entering Intel manufacturer mode failed (%ld)",
1732                        hdev->name, PTR_ERR(skb));
1733                 release_firmware(fw);
1734                 return PTR_ERR(skb);
1735         }
1736
1737         kfree_skb(skb);
1738
1739         disable_patch = 1;
1740
1741         /* The firmware data file consists of list of Intel specific HCI
1742          * commands and its expected events. The first byte indicates the
1743          * type of the message, either HCI command or HCI event.
1744          *
1745          * It reads the command and its expected event from the firmware file,
1746          * and send to the controller. Once __hci_cmd_sync_ev() returns,
1747          * the returned event is compared with the event read from the firmware
1748          * file and it will continue until all the messages are downloaded to
1749          * the controller.
1750          *
1751          * Once the firmware patching is completed successfully,
1752          * the manufacturer mode is disabled with reset and activating the
1753          * downloaded patch.
1754          *
1755          * If the firmware patching fails, the manufacturer mode is
1756          * disabled with reset and deactivating the patch.
1757          *
1758          * If the default patch file is used, no reset is done when disabling
1759          * the manufacturer.
1760          */
1761         while (fw->size > fw_ptr - fw->data) {
1762                 int ret;
1763
1764                 ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr,
1765                                                  &disable_patch);
1766                 if (ret < 0)
1767                         goto exit_mfg_deactivate;
1768         }
1769
1770         release_firmware(fw);
1771
1772         if (disable_patch)
1773                 goto exit_mfg_disable;
1774
1775         /* Patching completed successfully and disable the manufacturer mode
1776          * with reset and activate the downloaded firmware patches.
1777          */
1778         skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_activate),
1779                              mfg_reset_activate, HCI_INIT_TIMEOUT);
1780         if (IS_ERR(skb)) {
1781                 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1782                        hdev->name, PTR_ERR(skb));
1783                 return PTR_ERR(skb);
1784         }
1785         kfree_skb(skb);
1786
1787         BT_INFO("%s: Intel Bluetooth firmware patch completed and activated",
1788                 hdev->name);
1789
1790         btintel_check_bdaddr(hdev);
1791         return 0;
1792
1793 exit_mfg_disable:
1794         /* Disable the manufacturer mode without reset */
1795         skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_disable), mfg_disable,
1796                              HCI_INIT_TIMEOUT);
1797         if (IS_ERR(skb)) {
1798                 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1799                        hdev->name, PTR_ERR(skb));
1800                 return PTR_ERR(skb);
1801         }
1802         kfree_skb(skb);
1803
1804         BT_INFO("%s: Intel Bluetooth firmware patch completed", hdev->name);
1805
1806         btintel_check_bdaddr(hdev);
1807         return 0;
1808
1809 exit_mfg_deactivate:
1810         release_firmware(fw);
1811
1812         /* Patching failed. Disable the manufacturer mode with reset and
1813          * deactivate the downloaded firmware patches.
1814          */
1815         skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_deactivate),
1816                              mfg_reset_deactivate, HCI_INIT_TIMEOUT);
1817         if (IS_ERR(skb)) {
1818                 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1819                        hdev->name, PTR_ERR(skb));
1820                 return PTR_ERR(skb);
1821         }
1822         kfree_skb(skb);
1823
1824         BT_INFO("%s: Intel Bluetooth firmware patch completed and deactivated",
1825                 hdev->name);
1826
1827         btintel_check_bdaddr(hdev);
1828         return 0;
1829 }
1830
1831 static int inject_cmd_complete(struct hci_dev *hdev, __u16 opcode)
1832 {
1833         struct sk_buff *skb;
1834         struct hci_event_hdr *hdr;
1835         struct hci_ev_cmd_complete *evt;
1836
1837         skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_ATOMIC);
1838         if (!skb)
1839                 return -ENOMEM;
1840
1841         hdr = (struct hci_event_hdr *)skb_put(skb, sizeof(*hdr));
1842         hdr->evt = HCI_EV_CMD_COMPLETE;
1843         hdr->plen = sizeof(*evt) + 1;
1844
1845         evt = (struct hci_ev_cmd_complete *)skb_put(skb, sizeof(*evt));
1846         evt->ncmd = 0x01;
1847         evt->opcode = cpu_to_le16(opcode);
1848
1849         *skb_put(skb, 1) = 0x00;
1850
1851         bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
1852
1853         return hci_recv_frame(hdev, skb);
1854 }
1855
1856 static int btusb_recv_bulk_intel(struct btusb_data *data, void *buffer,
1857                                  int count)
1858 {
1859         /* When the device is in bootloader mode, then it can send
1860          * events via the bulk endpoint. These events are treated the
1861          * same way as the ones received from the interrupt endpoint.
1862          */
1863         if (test_bit(BTUSB_BOOTLOADER, &data->flags))
1864                 return btusb_recv_intr(data, buffer, count);
1865
1866         return btusb_recv_bulk(data, buffer, count);
1867 }
1868
1869 static void btusb_intel_bootup(struct btusb_data *data, const void *ptr,
1870                                unsigned int len)
1871 {
1872         const struct intel_bootup *evt = ptr;
1873
1874         if (len != sizeof(*evt))
1875                 return;
1876
1877         if (test_and_clear_bit(BTUSB_BOOTING, &data->flags)) {
1878                 smp_mb__after_atomic();
1879                 wake_up_bit(&data->flags, BTUSB_BOOTING);
1880         }
1881 }
1882
1883 static void btusb_intel_secure_send_result(struct btusb_data *data,
1884                                            const void *ptr, unsigned int len)
1885 {
1886         const struct intel_secure_send_result *evt = ptr;
1887
1888         if (len != sizeof(*evt))
1889                 return;
1890
1891         if (evt->result)
1892                 set_bit(BTUSB_FIRMWARE_FAILED, &data->flags);
1893
1894         if (test_and_clear_bit(BTUSB_DOWNLOADING, &data->flags) &&
1895             test_bit(BTUSB_FIRMWARE_LOADED, &data->flags)) {
1896                 smp_mb__after_atomic();
1897                 wake_up_bit(&data->flags, BTUSB_DOWNLOADING);
1898         }
1899 }
1900
1901 static int btusb_recv_event_intel(struct hci_dev *hdev, struct sk_buff *skb)
1902 {
1903         struct btusb_data *data = hci_get_drvdata(hdev);
1904
1905         if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
1906                 struct hci_event_hdr *hdr = (void *)skb->data;
1907
1908                 if (skb->len > HCI_EVENT_HDR_SIZE && hdr->evt == 0xff &&
1909                     hdr->plen > 0) {
1910                         const void *ptr = skb->data + HCI_EVENT_HDR_SIZE + 1;
1911                         unsigned int len = skb->len - HCI_EVENT_HDR_SIZE - 1;
1912
1913                         switch (skb->data[2]) {
1914                         case 0x02:
1915                                 /* When switching to the operational firmware
1916                                  * the device sends a vendor specific event
1917                                  * indicating that the bootup completed.
1918                                  */
1919                                 btusb_intel_bootup(data, ptr, len);
1920                                 break;
1921                         case 0x06:
1922                                 /* When the firmware loading completes the
1923                                  * device sends out a vendor specific event
1924                                  * indicating the result of the firmware
1925                                  * loading.
1926                                  */
1927                                 btusb_intel_secure_send_result(data, ptr, len);
1928                                 break;
1929                         }
1930                 }
1931         }
1932
1933         return hci_recv_frame(hdev, skb);
1934 }
1935
1936 static int btusb_send_frame_intel(struct hci_dev *hdev, struct sk_buff *skb)
1937 {
1938         struct btusb_data *data = hci_get_drvdata(hdev);
1939         struct urb *urb;
1940
1941         BT_DBG("%s", hdev->name);
1942
1943         switch (bt_cb(skb)->pkt_type) {
1944         case HCI_COMMAND_PKT:
1945                 if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
1946                         struct hci_command_hdr *cmd = (void *)skb->data;
1947                         __u16 opcode = le16_to_cpu(cmd->opcode);
1948
1949                         /* When in bootloader mode and the command 0xfc09
1950                          * is received, it needs to be send down the
1951                          * bulk endpoint. So allocate a bulk URB instead.
1952                          */
1953                         if (opcode == 0xfc09)
1954                                 urb = alloc_bulk_urb(hdev, skb);
1955                         else
1956                                 urb = alloc_ctrl_urb(hdev, skb);
1957
1958                         /* When the 0xfc01 command is issued to boot into
1959                          * the operational firmware, it will actually not
1960                          * send a command complete event. To keep the flow
1961                          * control working inject that event here.
1962                          */
1963                         if (opcode == 0xfc01)
1964                                 inject_cmd_complete(hdev, opcode);
1965                 } else {
1966                         urb = alloc_ctrl_urb(hdev, skb);
1967                 }
1968                 if (IS_ERR(urb))
1969                         return PTR_ERR(urb);
1970
1971                 hdev->stat.cmd_tx++;
1972                 return submit_or_queue_tx_urb(hdev, urb);
1973
1974         case HCI_ACLDATA_PKT:
1975                 urb = alloc_bulk_urb(hdev, skb);
1976                 if (IS_ERR(urb))
1977                         return PTR_ERR(urb);
1978
1979                 hdev->stat.acl_tx++;
1980                 return submit_or_queue_tx_urb(hdev, urb);
1981
1982         case HCI_SCODATA_PKT:
1983                 if (hci_conn_num(hdev, SCO_LINK) < 1)
1984                         return -ENODEV;
1985
1986                 urb = alloc_isoc_urb(hdev, skb);
1987                 if (IS_ERR(urb))
1988                         return PTR_ERR(urb);
1989
1990                 hdev->stat.sco_tx++;
1991                 return submit_tx_urb(hdev, urb);
1992         }
1993
1994         return -EILSEQ;
1995 }
1996
1997 static int btusb_setup_intel_new(struct hci_dev *hdev)
1998 {
1999         static const u8 reset_param[] = { 0x00, 0x01, 0x00, 0x01,
2000                                           0x00, 0x08, 0x04, 0x00 };
2001         struct btusb_data *data = hci_get_drvdata(hdev);
2002         struct sk_buff *skb;
2003         struct intel_version *ver;
2004         struct intel_boot_params *params;
2005         const struct firmware *fw;
2006         const u8 *fw_ptr;
2007         u32 frag_len;
2008         char fwname[64];
2009         ktime_t calltime, delta, rettime;
2010         unsigned long long duration;
2011         int err;
2012
2013         BT_DBG("%s", hdev->name);
2014
2015         calltime = ktime_get();
2016
2017         /* Read the Intel version information to determine if the device
2018          * is in bootloader mode or if it already has operational firmware
2019          * loaded.
2020          */
2021         skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT);
2022         if (IS_ERR(skb)) {
2023                 BT_ERR("%s: Reading Intel version information failed (%ld)",
2024                        hdev->name, PTR_ERR(skb));
2025                 return PTR_ERR(skb);
2026         }
2027
2028         if (skb->len != sizeof(*ver)) {
2029                 BT_ERR("%s: Intel version event size mismatch", hdev->name);
2030                 kfree_skb(skb);
2031                 return -EILSEQ;
2032         }
2033
2034         ver = (struct intel_version *)skb->data;
2035
2036         /* The hardware platform number has a fixed value of 0x37 and
2037          * for now only accept this single value.
2038          */
2039         if (ver->hw_platform != 0x37) {
2040                 BT_ERR("%s: Unsupported Intel hardware platform (%u)",
2041                        hdev->name, ver->hw_platform);
2042                 kfree_skb(skb);
2043                 return -EINVAL;
2044         }
2045
2046         /* At the moment only the hardware variant iBT 3.0 (LnP/SfP) is
2047          * supported by this firmware loading method. This check has been
2048          * put in place to ensure correct forward compatibility options
2049          * when newer hardware variants come along.
2050          */
2051         if (ver->hw_variant != 0x0b) {
2052                 BT_ERR("%s: Unsupported Intel hardware variant (%u)",
2053                        hdev->name, ver->hw_variant);
2054                 kfree_skb(skb);
2055                 return -EINVAL;
2056         }
2057
2058         btintel_version_info(hdev, ver);
2059
2060         /* The firmware variant determines if the device is in bootloader
2061          * mode or is running operational firmware. The value 0x06 identifies
2062          * the bootloader and the value 0x23 identifies the operational
2063          * firmware.
2064          *
2065          * When the operational firmware is already present, then only
2066          * the check for valid Bluetooth device address is needed. This
2067          * determines if the device will be added as configured or
2068          * unconfigured controller.
2069          *
2070          * It is not possible to use the Secure Boot Parameters in this
2071          * case since that command is only available in bootloader mode.
2072          */
2073         if (ver->fw_variant == 0x23) {
2074                 kfree_skb(skb);
2075                 clear_bit(BTUSB_BOOTLOADER, &data->flags);
2076                 btintel_check_bdaddr(hdev);
2077                 return 0;
2078         }
2079
2080         /* If the device is not in bootloader mode, then the only possible
2081          * choice is to return an error and abort the device initialization.
2082          */
2083         if (ver->fw_variant != 0x06) {
2084                 BT_ERR("%s: Unsupported Intel firmware variant (%u)",
2085                        hdev->name, ver->fw_variant);
2086                 kfree_skb(skb);
2087                 return -ENODEV;
2088         }
2089
2090         kfree_skb(skb);
2091
2092         /* Read the secure boot parameters to identify the operating
2093          * details of the bootloader.
2094          */
2095         skb = __hci_cmd_sync(hdev, 0xfc0d, 0, NULL, HCI_INIT_TIMEOUT);
2096         if (IS_ERR(skb)) {
2097                 BT_ERR("%s: Reading Intel boot parameters failed (%ld)",
2098                        hdev->name, PTR_ERR(skb));
2099                 return PTR_ERR(skb);
2100         }
2101
2102         if (skb->len != sizeof(*params)) {
2103                 BT_ERR("%s: Intel boot parameters size mismatch", hdev->name);
2104                 kfree_skb(skb);
2105                 return -EILSEQ;
2106         }
2107
2108         params = (struct intel_boot_params *)skb->data;
2109
2110         BT_INFO("%s: Device revision is %u", hdev->name,
2111                 le16_to_cpu(params->dev_revid));
2112
2113         BT_INFO("%s: Secure boot is %s", hdev->name,
2114                 params->secure_boot ? "enabled" : "disabled");
2115
2116         BT_INFO("%s: OTP lock is %s", hdev->name,
2117                 params->otp_lock ? "enabled" : "disabled");
2118
2119         BT_INFO("%s: API lock is %s", hdev->name,
2120                 params->api_lock ? "enabled" : "disabled");
2121
2122         BT_INFO("%s: Debug lock is %s", hdev->name,
2123                 params->debug_lock ? "enabled" : "disabled");
2124
2125         BT_INFO("%s: Minimum firmware build %u week %u %u", hdev->name,
2126                 params->min_fw_build_nn, params->min_fw_build_cw,
2127                 2000 + params->min_fw_build_yy);
2128
2129         /* It is required that every single firmware fragment is acknowledged
2130          * with a command complete event. If the boot parameters indicate
2131          * that this bootloader does not send them, then abort the setup.
2132          */
2133         if (params->limited_cce != 0x00) {
2134                 BT_ERR("%s: Unsupported Intel firmware loading method (%u)",
2135                        hdev->name, params->limited_cce);
2136                 kfree_skb(skb);
2137                 return -EINVAL;
2138         }
2139
2140         /* If the OTP has no valid Bluetooth device address, then there will
2141          * also be no valid address for the operational firmware.
2142          */
2143         if (!bacmp(&params->otp_bdaddr, BDADDR_ANY)) {
2144                 BT_INFO("%s: No device address configured", hdev->name);
2145                 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
2146         }
2147
2148         /* With this Intel bootloader only the hardware variant and device
2149          * revision information are used to select the right firmware.
2150          *
2151          * Currently this bootloader support is limited to hardware variant
2152          * iBT 3.0 (LnP/SfP) which is identified by the value 11 (0x0b).
2153          */
2154         snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.sfi",
2155                  le16_to_cpu(params->dev_revid));
2156
2157         err = request_firmware(&fw, fwname, &hdev->dev);
2158         if (err < 0) {
2159                 BT_ERR("%s: Failed to load Intel firmware file (%d)",
2160                        hdev->name, err);
2161                 kfree_skb(skb);
2162                 return err;
2163         }
2164
2165         BT_INFO("%s: Found device firmware: %s", hdev->name, fwname);
2166
2167         /* Save the DDC file name for later use to apply once the firmware
2168          * downloading is done.
2169          */
2170         snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.ddc",
2171                  le16_to_cpu(params->dev_revid));
2172
2173         kfree_skb(skb);
2174
2175         if (fw->size < 644) {
2176                 BT_ERR("%s: Invalid size of firmware file (%zu)",
2177                        hdev->name, fw->size);
2178                 err = -EBADF;
2179                 goto done;
2180         }
2181
2182         set_bit(BTUSB_DOWNLOADING, &data->flags);
2183
2184         /* Start the firmware download transaction with the Init fragment
2185          * represented by the 128 bytes of CSS header.
2186          */
2187         err = btintel_secure_send(hdev, 0x00, 128, fw->data);
2188         if (err < 0) {
2189                 BT_ERR("%s: Failed to send firmware header (%d)",
2190                        hdev->name, err);
2191                 goto done;
2192         }
2193
2194         /* Send the 256 bytes of public key information from the firmware
2195          * as the PKey fragment.
2196          */
2197         err = btintel_secure_send(hdev, 0x03, 256, fw->data + 128);
2198         if (err < 0) {
2199                 BT_ERR("%s: Failed to send firmware public key (%d)",
2200                        hdev->name, err);
2201                 goto done;
2202         }
2203
2204         /* Send the 256 bytes of signature information from the firmware
2205          * as the Sign fragment.
2206          */
2207         err = btintel_secure_send(hdev, 0x02, 256, fw->data + 388);
2208         if (err < 0) {
2209                 BT_ERR("%s: Failed to send firmware signature (%d)",
2210                        hdev->name, err);
2211                 goto done;
2212         }
2213
2214         fw_ptr = fw->data + 644;
2215         frag_len = 0;
2216
2217         while (fw_ptr - fw->data < fw->size) {
2218                 struct hci_command_hdr *cmd = (void *)(fw_ptr + frag_len);
2219
2220                 frag_len += sizeof(*cmd) + cmd->plen;
2221
2222                 /* The parameter length of the secure send command requires
2223                  * a 4 byte alignment. It happens so that the firmware file
2224                  * contains proper Intel_NOP commands to align the fragments
2225                  * as needed.
2226                  *
2227                  * Send set of commands with 4 byte alignment from the
2228                  * firmware data buffer as a single Data fragement.
2229                  */
2230                 if (!(frag_len % 4)) {
2231                         err = btintel_secure_send(hdev, 0x01, frag_len, fw_ptr);
2232                         if (err < 0) {
2233                                 BT_ERR("%s: Failed to send firmware data (%d)",
2234                                        hdev->name, err);
2235                                 goto done;
2236                         }
2237
2238                         fw_ptr += frag_len;
2239                         frag_len = 0;
2240                 }
2241         }
2242
2243         set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2244
2245         BT_INFO("%s: Waiting for firmware download to complete", hdev->name);
2246
2247         /* Before switching the device into operational mode and with that
2248          * booting the loaded firmware, wait for the bootloader notification
2249          * that all fragments have been successfully received.
2250          *
2251          * When the event processing receives the notification, then the
2252          * BTUSB_DOWNLOADING flag will be cleared.
2253          *
2254          * The firmware loading should not take longer than 5 seconds
2255          * and thus just timeout if that happens and fail the setup
2256          * of this device.
2257          */
2258         err = wait_on_bit_timeout(&data->flags, BTUSB_DOWNLOADING,
2259                                   TASK_INTERRUPTIBLE,
2260                                   msecs_to_jiffies(5000));
2261         if (err == 1) {
2262                 BT_ERR("%s: Firmware loading interrupted", hdev->name);
2263                 err = -EINTR;
2264                 goto done;
2265         }
2266
2267         if (err) {
2268                 BT_ERR("%s: Firmware loading timeout", hdev->name);
2269                 err = -ETIMEDOUT;
2270                 goto done;
2271         }
2272
2273         if (test_bit(BTUSB_FIRMWARE_FAILED, &data->flags)) {
2274                 BT_ERR("%s: Firmware loading failed", hdev->name);
2275                 err = -ENOEXEC;
2276                 goto done;
2277         }
2278
2279         rettime = ktime_get();
2280         delta = ktime_sub(rettime, calltime);
2281         duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2282
2283         BT_INFO("%s: Firmware loaded in %llu usecs", hdev->name, duration);
2284
2285 done:
2286         release_firmware(fw);
2287
2288         if (err < 0)
2289                 return err;
2290
2291         calltime = ktime_get();
2292
2293         set_bit(BTUSB_BOOTING, &data->flags);
2294
2295         skb = __hci_cmd_sync(hdev, 0xfc01, sizeof(reset_param), reset_param,
2296                              HCI_INIT_TIMEOUT);
2297         if (IS_ERR(skb))
2298                 return PTR_ERR(skb);
2299
2300         kfree_skb(skb);
2301
2302         /* The bootloader will not indicate when the device is ready. This
2303          * is done by the operational firmware sending bootup notification.
2304          *
2305          * Booting into operational firmware should not take longer than
2306          * 1 second. However if that happens, then just fail the setup
2307          * since something went wrong.
2308          */
2309         BT_INFO("%s: Waiting for device to boot", hdev->name);
2310
2311         err = wait_on_bit_timeout(&data->flags, BTUSB_BOOTING,
2312                                   TASK_INTERRUPTIBLE,
2313                                   msecs_to_jiffies(1000));
2314
2315         if (err == 1) {
2316                 BT_ERR("%s: Device boot interrupted", hdev->name);
2317                 return -EINTR;
2318         }
2319
2320         if (err) {
2321                 BT_ERR("%s: Device boot timeout", hdev->name);
2322                 return -ETIMEDOUT;
2323         }
2324
2325         rettime = ktime_get();
2326         delta = ktime_sub(rettime, calltime);
2327         duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2328
2329         BT_INFO("%s: Device booted in %llu usecs", hdev->name, duration);
2330
2331         clear_bit(BTUSB_BOOTLOADER, &data->flags);
2332
2333         /* Once the device is running in operational mode, it needs to apply
2334          * the device configuration (DDC) parameters.
2335          *
2336          * The device can work without DDC parameters, so even if it fails
2337          * to load the file, no need to fail the setup.
2338          */
2339         btintel_load_ddc_config(hdev, fwname);
2340
2341         return 0;
2342 }
2343
2344 static int btusb_shutdown_intel(struct hci_dev *hdev)
2345 {
2346         struct sk_buff *skb;
2347         long ret;
2348
2349         /* Some platforms have an issue with BT LED when the interface is
2350          * down or BT radio is turned off, which takes 5 seconds to BT LED
2351          * goes off. This command turns off the BT LED immediately.
2352          */
2353         skb = __hci_cmd_sync(hdev, 0xfc3f, 0, NULL, HCI_INIT_TIMEOUT);
2354         if (IS_ERR(skb)) {
2355                 ret = PTR_ERR(skb);
2356                 BT_ERR("%s: turning off Intel device LED failed (%ld)",
2357                        hdev->name, ret);
2358                 return ret;
2359         }
2360         kfree_skb(skb);
2361
2362         return 0;
2363 }
2364
2365 static int btusb_set_bdaddr_marvell(struct hci_dev *hdev,
2366                                     const bdaddr_t *bdaddr)
2367 {
2368         struct sk_buff *skb;
2369         u8 buf[8];
2370         long ret;
2371
2372         buf[0] = 0xfe;
2373         buf[1] = sizeof(bdaddr_t);
2374         memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
2375
2376         skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT);
2377         if (IS_ERR(skb)) {
2378                 ret = PTR_ERR(skb);
2379                 BT_ERR("%s: changing Marvell device address failed (%ld)",
2380                        hdev->name, ret);
2381                 return ret;
2382         }
2383         kfree_skb(skb);
2384
2385         return 0;
2386 }
2387
2388 static int btusb_set_bdaddr_ath3012(struct hci_dev *hdev,
2389                                     const bdaddr_t *bdaddr)
2390 {
2391         struct sk_buff *skb;
2392         u8 buf[10];
2393         long ret;
2394
2395         buf[0] = 0x01;
2396         buf[1] = 0x01;
2397         buf[2] = 0x00;
2398         buf[3] = sizeof(bdaddr_t);
2399         memcpy(buf + 4, bdaddr, sizeof(bdaddr_t));
2400
2401         skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT);
2402         if (IS_ERR(skb)) {
2403                 ret = PTR_ERR(skb);
2404                 BT_ERR("%s: Change address command failed (%ld)",
2405                        hdev->name, ret);
2406                 return ret;
2407         }
2408         kfree_skb(skb);
2409
2410         return 0;
2411 }
2412
2413 #define QCA_DFU_PACKET_LEN      4096
2414
2415 #define QCA_GET_TARGET_VERSION  0x09
2416 #define QCA_CHECK_STATUS        0x05
2417 #define QCA_DFU_DOWNLOAD        0x01
2418
2419 #define QCA_SYSCFG_UPDATED      0x40
2420 #define QCA_PATCH_UPDATED       0x80
2421 #define QCA_DFU_TIMEOUT         3000
2422
2423 struct qca_version {
2424         __le32  rom_version;
2425         __le32  patch_version;
2426         __le32  ram_version;
2427         __le32  ref_clock;
2428         __u8    reserved[4];
2429 } __packed;
2430
2431 struct qca_rampatch_version {
2432         __le16  rom_version;
2433         __le16  patch_version;
2434 } __packed;
2435
2436 struct qca_device_info {
2437         u32     rom_version;
2438         u8      rampatch_hdr;   /* length of header in rampatch */
2439         u8      nvm_hdr;        /* length of header in NVM */
2440         u8      ver_offset;     /* offset of version structure in rampatch */
2441 };
2442
2443 static const struct qca_device_info qca_devices_table[] = {
2444         { 0x00000100, 20, 4, 10 }, /* Rome 1.0 */
2445         { 0x00000101, 20, 4, 10 }, /* Rome 1.1 */
2446         { 0x00000200, 28, 4, 18 }, /* Rome 2.0 */
2447         { 0x00000201, 28, 4, 18 }, /* Rome 2.1 */
2448         { 0x00000300, 28, 4, 18 }, /* Rome 3.0 */
2449         { 0x00000302, 28, 4, 18 }, /* Rome 3.2 */
2450 };
2451
2452 static int btusb_qca_send_vendor_req(struct hci_dev *hdev, u8 request,
2453                                      void *data, u16 size)
2454 {
2455         struct btusb_data *btdata = hci_get_drvdata(hdev);
2456         struct usb_device *udev = btdata->udev;
2457         int pipe, err;
2458         u8 *buf;
2459
2460         buf = kmalloc(size, GFP_KERNEL);
2461         if (!buf)
2462                 return -ENOMEM;
2463
2464         /* Found some of USB hosts have IOT issues with ours so that we should
2465          * not wait until HCI layer is ready.
2466          */
2467         pipe = usb_rcvctrlpipe(udev, 0);
2468         err = usb_control_msg(udev, pipe, request, USB_TYPE_VENDOR | USB_DIR_IN,
2469                               0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
2470         if (err < 0) {
2471                 BT_ERR("%s: Failed to access otp area (%d)", hdev->name, err);
2472                 goto done;
2473         }
2474
2475         memcpy(data, buf, size);
2476
2477 done:
2478         kfree(buf);
2479
2480         return err;
2481 }
2482
2483 static int btusb_setup_qca_download_fw(struct hci_dev *hdev,
2484                                        const struct firmware *firmware,
2485                                        size_t hdr_size)
2486 {
2487         struct btusb_data *btdata = hci_get_drvdata(hdev);
2488         struct usb_device *udev = btdata->udev;
2489         size_t count, size, sent = 0;
2490         int pipe, len, err;
2491         u8 *buf;
2492
2493         buf = kmalloc(QCA_DFU_PACKET_LEN, GFP_KERNEL);
2494         if (!buf)
2495                 return -ENOMEM;
2496
2497         count = firmware->size;
2498
2499         size = min_t(size_t, count, hdr_size);
2500         memcpy(buf, firmware->data, size);
2501
2502         /* USB patches should go down to controller through USB path
2503          * because binary format fits to go down through USB channel.
2504          * USB control path is for patching headers and USB bulk is for
2505          * patch body.
2506          */
2507         pipe = usb_sndctrlpipe(udev, 0);
2508         err = usb_control_msg(udev, pipe, QCA_DFU_DOWNLOAD, USB_TYPE_VENDOR,
2509                               0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
2510         if (err < 0) {
2511                 BT_ERR("%s: Failed to send headers (%d)", hdev->name, err);
2512                 goto done;
2513         }
2514
2515         sent += size;
2516         count -= size;
2517
2518         while (count) {
2519                 size = min_t(size_t, count, QCA_DFU_PACKET_LEN);
2520
2521                 memcpy(buf, firmware->data + sent, size);
2522
2523                 pipe = usb_sndbulkpipe(udev, 0x02);
2524                 err = usb_bulk_msg(udev, pipe, buf, size, &len,
2525                                    QCA_DFU_TIMEOUT);
2526                 if (err < 0) {
2527                         BT_ERR("%s: Failed to send body at %zd of %zd (%d)",
2528                                hdev->name, sent, firmware->size, err);
2529                         break;
2530                 }
2531
2532                 if (size != len) {
2533                         BT_ERR("%s: Failed to get bulk buffer", hdev->name);
2534                         err = -EILSEQ;
2535                         break;
2536                 }
2537
2538                 sent  += size;
2539                 count -= size;
2540         }
2541
2542 done:
2543         kfree(buf);
2544         return err;
2545 }
2546
2547 static int btusb_setup_qca_load_rampatch(struct hci_dev *hdev,
2548                                          struct qca_version *ver,
2549                                          const struct qca_device_info *info)
2550 {
2551         struct qca_rampatch_version *rver;
2552         const struct firmware *fw;
2553         u32 ver_rom, ver_patch;
2554         u16 rver_rom, rver_patch;
2555         char fwname[64];
2556         int err;
2557
2558         ver_rom = le32_to_cpu(ver->rom_version);
2559         ver_patch = le32_to_cpu(ver->patch_version);
2560
2561         snprintf(fwname, sizeof(fwname), "qca/rampatch_usb_%08x.bin", ver_rom);
2562
2563         err = request_firmware(&fw, fwname, &hdev->dev);
2564         if (err) {
2565                 BT_ERR("%s: failed to request rampatch file: %s (%d)",
2566                        hdev->name, fwname, err);
2567                 return err;
2568         }
2569
2570         BT_INFO("%s: using rampatch file: %s", hdev->name, fwname);
2571
2572         rver = (struct qca_rampatch_version *)(fw->data + info->ver_offset);
2573         rver_rom = le16_to_cpu(rver->rom_version);
2574         rver_patch = le16_to_cpu(rver->patch_version);
2575
2576         BT_INFO("%s: QCA: patch rome 0x%x build 0x%x, firmware rome 0x%x "
2577                 "build 0x%x", hdev->name, rver_rom, rver_patch, ver_rom,
2578                 ver_patch);
2579
2580         if (rver_rom != ver_rom || rver_patch <= ver_patch) {
2581                 BT_ERR("%s: rampatch file version did not match with firmware",
2582                        hdev->name);
2583                 err = -EINVAL;
2584                 goto done;
2585         }
2586
2587         err = btusb_setup_qca_download_fw(hdev, fw, info->rampatch_hdr);
2588
2589 done:
2590         release_firmware(fw);
2591
2592         return err;
2593 }
2594
2595 static int btusb_setup_qca_load_nvm(struct hci_dev *hdev,
2596                                     struct qca_version *ver,
2597                                     const struct qca_device_info *info)
2598 {
2599         const struct firmware *fw;
2600         char fwname[64];
2601         int err;
2602
2603         snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x.bin",
2604                  le32_to_cpu(ver->rom_version));
2605
2606         err = request_firmware(&fw, fwname, &hdev->dev);
2607         if (err) {
2608                 BT_ERR("%s: failed to request NVM file: %s (%d)",
2609                        hdev->name, fwname, err);
2610                 return err;
2611         }
2612
2613         BT_INFO("%s: using NVM file: %s", hdev->name, fwname);
2614
2615         err = btusb_setup_qca_download_fw(hdev, fw, info->nvm_hdr);
2616
2617         release_firmware(fw);
2618
2619         return err;
2620 }
2621
2622 static int btusb_setup_qca(struct hci_dev *hdev)
2623 {
2624         const struct qca_device_info *info = NULL;
2625         struct qca_version ver;
2626         u32 ver_rom;
2627         u8 status;
2628         int i, err;
2629
2630         err = btusb_qca_send_vendor_req(hdev, QCA_GET_TARGET_VERSION, &ver,
2631                                         sizeof(ver));
2632         if (err < 0)
2633                 return err;
2634
2635         ver_rom = le32_to_cpu(ver.rom_version);
2636         for (i = 0; i < ARRAY_SIZE(qca_devices_table); i++) {
2637                 if (ver_rom == qca_devices_table[i].rom_version)
2638                         info = &qca_devices_table[i];
2639         }
2640         if (!info) {
2641                 BT_ERR("%s: don't support firmware rome 0x%x", hdev->name,
2642                        ver_rom);
2643                 return -ENODEV;
2644         }
2645
2646         err = btusb_qca_send_vendor_req(hdev, QCA_CHECK_STATUS, &status,
2647                                         sizeof(status));
2648         if (err < 0)
2649                 return err;
2650
2651         if (!(status & QCA_PATCH_UPDATED)) {
2652                 err = btusb_setup_qca_load_rampatch(hdev, &ver, info);
2653                 if (err < 0)
2654                         return err;
2655         }
2656
2657         if (!(status & QCA_SYSCFG_UPDATED)) {
2658                 err = btusb_setup_qca_load_nvm(hdev, &ver, info);
2659                 if (err < 0)
2660                         return err;
2661         }
2662
2663         return 0;
2664 }
2665
2666 #ifdef CONFIG_BT_HCIBTUSB_BCM
2667 static inline int __set_diag_interface(struct hci_dev *hdev)
2668 {
2669         struct btusb_data *data = hci_get_drvdata(hdev);
2670         struct usb_interface *intf = data->diag;
2671         int i;
2672
2673         if (!data->diag)
2674                 return -ENODEV;
2675
2676         data->diag_tx_ep = NULL;
2677         data->diag_rx_ep = NULL;
2678
2679         for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
2680                 struct usb_endpoint_descriptor *ep_desc;
2681
2682                 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
2683
2684                 if (!data->diag_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
2685                         data->diag_tx_ep = ep_desc;
2686                         continue;
2687                 }
2688
2689                 if (!data->diag_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
2690                         data->diag_rx_ep = ep_desc;
2691                         continue;
2692                 }
2693         }
2694
2695         if (!data->diag_tx_ep || !data->diag_rx_ep) {
2696                 BT_ERR("%s invalid diagnostic descriptors", hdev->name);
2697                 return -ENODEV;
2698         }
2699
2700         return 0;
2701 }
2702
2703 static struct urb *alloc_diag_urb(struct hci_dev *hdev, bool enable)
2704 {
2705         struct btusb_data *data = hci_get_drvdata(hdev);
2706         struct sk_buff *skb;
2707         struct urb *urb;
2708         unsigned int pipe;
2709
2710         if (!data->diag_tx_ep)
2711                 return ERR_PTR(-ENODEV);
2712
2713         urb = usb_alloc_urb(0, GFP_KERNEL);
2714         if (!urb)
2715                 return ERR_PTR(-ENOMEM);
2716
2717         skb = bt_skb_alloc(2, GFP_KERNEL);
2718         if (!skb) {
2719                 usb_free_urb(urb);
2720                 return ERR_PTR(-ENOMEM);
2721         }
2722
2723         *skb_put(skb, 1) = 0xf0;
2724         *skb_put(skb, 1) = enable;
2725
2726         pipe = usb_sndbulkpipe(data->udev, data->diag_tx_ep->bEndpointAddress);
2727
2728         usb_fill_bulk_urb(urb, data->udev, pipe,
2729                           skb->data, skb->len, btusb_tx_complete, skb);
2730
2731         skb->dev = (void *)hdev;
2732
2733         return urb;
2734 }
2735
2736 static int btusb_bcm_set_diag(struct hci_dev *hdev, bool enable)
2737 {
2738         struct btusb_data *data = hci_get_drvdata(hdev);
2739         struct urb *urb;
2740
2741         if (!data->diag)
2742                 return -ENODEV;
2743
2744         if (!test_bit(HCI_RUNNING, &hdev->flags))
2745                 return -ENETDOWN;
2746
2747         urb = alloc_diag_urb(hdev, enable);
2748         if (IS_ERR(urb))
2749                 return PTR_ERR(urb);
2750
2751         return submit_or_queue_tx_urb(hdev, urb);
2752 }
2753 #endif
2754
2755 static int btusb_probe(struct usb_interface *intf,
2756                        const struct usb_device_id *id)
2757 {
2758         struct usb_endpoint_descriptor *ep_desc;
2759         struct btusb_data *data;
2760         struct hci_dev *hdev;
2761         int i, err;
2762
2763         BT_DBG("intf %p id %p", intf, id);
2764
2765         /* interface numbers are hardcoded in the spec */
2766         if (intf->cur_altsetting->desc.bInterfaceNumber != 0)
2767                 return -ENODEV;
2768
2769         if (!id->driver_info) {
2770                 const struct usb_device_id *match;
2771
2772                 match = usb_match_id(intf, blacklist_table);
2773                 if (match)
2774                         id = match;
2775         }
2776
2777         if (id->driver_info == BTUSB_IGNORE)
2778                 return -ENODEV;
2779
2780         if (id->driver_info & BTUSB_ATH3012) {
2781                 struct usb_device *udev = interface_to_usbdev(intf);
2782
2783                 /* Old firmware would otherwise let ath3k driver load
2784                  * patch and sysconfig files */
2785                 if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001)
2786                         return -ENODEV;
2787         }
2788
2789         data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
2790         if (!data)
2791                 return -ENOMEM;
2792
2793         for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
2794                 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
2795
2796                 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
2797                         data->intr_ep = ep_desc;
2798                         continue;
2799                 }
2800
2801                 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
2802                         data->bulk_tx_ep = ep_desc;
2803                         continue;
2804                 }
2805
2806                 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
2807                         data->bulk_rx_ep = ep_desc;
2808                         continue;
2809                 }
2810         }
2811
2812         if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep)
2813                 return -ENODEV;
2814
2815         if (id->driver_info & BTUSB_AMP) {
2816                 data->cmdreq_type = USB_TYPE_CLASS | 0x01;
2817                 data->cmdreq = 0x2b;
2818         } else {
2819                 data->cmdreq_type = USB_TYPE_CLASS;
2820                 data->cmdreq = 0x00;
2821         }
2822
2823         data->udev = interface_to_usbdev(intf);
2824         data->intf = intf;
2825
2826         INIT_WORK(&data->work, btusb_work);
2827         INIT_WORK(&data->waker, btusb_waker);
2828         init_usb_anchor(&data->deferred);
2829         init_usb_anchor(&data->tx_anchor);
2830         spin_lock_init(&data->txlock);
2831
2832         init_usb_anchor(&data->intr_anchor);
2833         init_usb_anchor(&data->bulk_anchor);
2834         init_usb_anchor(&data->isoc_anchor);
2835         init_usb_anchor(&data->diag_anchor);
2836         spin_lock_init(&data->rxlock);
2837
2838         if (id->driver_info & BTUSB_INTEL_NEW) {
2839                 data->recv_event = btusb_recv_event_intel;
2840                 data->recv_bulk = btusb_recv_bulk_intel;
2841                 set_bit(BTUSB_BOOTLOADER, &data->flags);
2842         } else {
2843                 data->recv_event = hci_recv_frame;
2844                 data->recv_bulk = btusb_recv_bulk;
2845         }
2846
2847         hdev = hci_alloc_dev();
2848         if (!hdev)
2849                 return -ENOMEM;
2850
2851         hdev->bus = HCI_USB;
2852         hci_set_drvdata(hdev, data);
2853
2854         if (id->driver_info & BTUSB_AMP)
2855                 hdev->dev_type = HCI_AMP;
2856         else
2857                 hdev->dev_type = HCI_BREDR;
2858
2859         data->hdev = hdev;
2860
2861         SET_HCIDEV_DEV(hdev, &intf->dev);
2862
2863         hdev->open   = btusb_open;
2864         hdev->close  = btusb_close;
2865         hdev->flush  = btusb_flush;
2866         hdev->send   = btusb_send_frame;
2867         hdev->notify = btusb_notify;
2868
2869         if (id->driver_info & BTUSB_BCM2045)
2870                 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
2871
2872         if (id->driver_info & BTUSB_BCM92035)
2873                 hdev->setup = btusb_setup_bcm92035;
2874
2875 #ifdef CONFIG_BT_HCIBTUSB_BCM
2876         if (id->driver_info & BTUSB_BCM_PATCHRAM) {
2877                 hdev->setup = btbcm_setup_patchram;
2878                 hdev->set_diag = btusb_bcm_set_diag;
2879                 hdev->set_bdaddr = btbcm_set_bdaddr;
2880
2881                 /* Broadcom LM_DIAG Interface numbers are hardcoded */
2882                 data->diag = usb_ifnum_to_if(data->udev, 2);
2883         }
2884
2885         if (id->driver_info & BTUSB_BCM_APPLE) {
2886                 hdev->setup = btbcm_setup_apple;
2887                 hdev->set_diag = btusb_bcm_set_diag;
2888
2889                 /* Broadcom LM_DIAG Interface numbers are hardcoded */
2890                 data->diag = usb_ifnum_to_if(data->udev, 2);
2891         }
2892 #endif
2893
2894         if (id->driver_info & BTUSB_INTEL) {
2895                 hdev->setup = btusb_setup_intel;
2896                 hdev->shutdown = btusb_shutdown_intel;
2897                 hdev->set_diag = btintel_set_diag_mfg;
2898                 hdev->set_bdaddr = btintel_set_bdaddr;
2899                 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
2900                 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
2901                 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
2902         }
2903
2904         if (id->driver_info & BTUSB_INTEL_NEW) {
2905                 hdev->send = btusb_send_frame_intel;
2906                 hdev->setup = btusb_setup_intel_new;
2907                 hdev->hw_error = btintel_hw_error;
2908                 hdev->set_diag = btintel_set_diag;
2909                 hdev->set_bdaddr = btintel_set_bdaddr;
2910                 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
2911                 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
2912         }
2913
2914         if (id->driver_info & BTUSB_MARVELL)
2915                 hdev->set_bdaddr = btusb_set_bdaddr_marvell;
2916
2917         if (id->driver_info & BTUSB_SWAVE) {
2918                 set_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks);
2919                 set_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks);
2920         }
2921
2922         if (id->driver_info & BTUSB_INTEL_BOOT)
2923                 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2924
2925         if (id->driver_info & BTUSB_ATH3012) {
2926                 hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
2927                 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
2928                 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
2929         }
2930
2931         if (id->driver_info & BTUSB_QCA_ROME) {
2932                 data->setup_on_usb = btusb_setup_qca;
2933                 hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
2934         }
2935
2936 #ifdef CONFIG_BT_HCIBTUSB_RTL
2937         if (id->driver_info & BTUSB_REALTEK) {
2938                 hdev->setup = btrtl_setup_realtek;
2939
2940                 /* Realtek devices lose their updated firmware over suspend,
2941                  * but the USB hub doesn't notice any status change.
2942                  * Explicitly request a device reset on resume.
2943                  */
2944                 set_bit(BTUSB_RESET_RESUME, &data->flags);
2945         }
2946 #endif
2947
2948         if (id->driver_info & BTUSB_AMP) {
2949                 /* AMP controllers do not support SCO packets */
2950                 data->isoc = NULL;
2951         } else {
2952                 /* Interface numbers are hardcoded in the specification */
2953                 data->isoc = usb_ifnum_to_if(data->udev, 1);
2954         }
2955
2956         if (!reset)
2957                 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2958
2959         if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
2960                 if (!disable_scofix)
2961                         set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
2962         }
2963
2964         if (id->driver_info & BTUSB_BROKEN_ISOC)
2965                 data->isoc = NULL;
2966
2967         if (id->driver_info & BTUSB_DIGIANSWER) {
2968                 data->cmdreq_type = USB_TYPE_VENDOR;
2969                 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2970         }
2971
2972         if (id->driver_info & BTUSB_CSR) {
2973                 struct usb_device *udev = data->udev;
2974                 u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice);
2975
2976                 /* Old firmware would otherwise execute USB reset */
2977                 if (bcdDevice < 0x117)
2978                         set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2979
2980                 /* Fake CSR devices with broken commands */
2981                 if (bcdDevice <= 0x100 || bcdDevice == 0x134)
2982                         hdev->setup = btusb_setup_csr;
2983
2984                 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
2985         }
2986
2987         if (id->driver_info & BTUSB_SNIFFER) {
2988                 struct usb_device *udev = data->udev;
2989
2990                 /* New sniffer firmware has crippled HCI interface */
2991                 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
2992                         set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2993         }
2994
2995         if (id->driver_info & BTUSB_INTEL_BOOT) {
2996                 /* A bug in the bootloader causes that interrupt interface is
2997                  * only enabled after receiving SetInterface(0, AltSetting=0).
2998                  */
2999                 err = usb_set_interface(data->udev, 0, 0);
3000                 if (err < 0) {
3001                         BT_ERR("failed to set interface 0, alt 0 %d", err);
3002                         hci_free_dev(hdev);
3003                         return err;
3004                 }
3005         }
3006
3007         if (data->isoc) {
3008                 err = usb_driver_claim_interface(&btusb_driver,
3009                                                  data->isoc, data);
3010                 if (err < 0) {
3011                         hci_free_dev(hdev);
3012                         return err;
3013                 }
3014         }
3015
3016 #ifdef CONFIG_BT_HCIBTUSB_BCM
3017         if (data->diag) {
3018                 if (!usb_driver_claim_interface(&btusb_driver,
3019                                                 data->diag, data))
3020                         __set_diag_interface(hdev);
3021                 else
3022                         data->diag = NULL;
3023         }
3024 #endif
3025
3026         err = hci_register_dev(hdev);
3027         if (err < 0) {
3028                 hci_free_dev(hdev);
3029                 return err;
3030         }
3031
3032         usb_set_intfdata(intf, data);
3033
3034         return 0;
3035 }
3036
3037 static void btusb_disconnect(struct usb_interface *intf)
3038 {
3039         struct btusb_data *data = usb_get_intfdata(intf);
3040         struct hci_dev *hdev;
3041
3042         BT_DBG("intf %p", intf);
3043
3044         if (!data)
3045                 return;
3046
3047         hdev = data->hdev;
3048         usb_set_intfdata(data->intf, NULL);
3049
3050         if (data->isoc)
3051                 usb_set_intfdata(data->isoc, NULL);
3052
3053         if (data->diag)
3054                 usb_set_intfdata(data->diag, NULL);
3055
3056         hci_unregister_dev(hdev);
3057
3058         if (intf == data->intf) {
3059                 if (data->isoc)
3060                         usb_driver_release_interface(&btusb_driver, data->isoc);
3061                 if (data->diag)
3062                         usb_driver_release_interface(&btusb_driver, data->diag);
3063         } else if (intf == data->isoc) {
3064                 if (data->diag)
3065                         usb_driver_release_interface(&btusb_driver, data->diag);
3066                 usb_driver_release_interface(&btusb_driver, data->intf);
3067         } else if (intf == data->diag) {
3068                 usb_driver_release_interface(&btusb_driver, data->intf);
3069                 if (data->isoc)
3070                         usb_driver_release_interface(&btusb_driver, data->isoc);
3071         }
3072
3073         hci_free_dev(hdev);
3074 }
3075
3076 #ifdef CONFIG_PM
3077 static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
3078 {
3079         struct btusb_data *data = usb_get_intfdata(intf);
3080
3081         BT_DBG("intf %p", intf);
3082
3083         if (data->suspend_count++)
3084                 return 0;
3085
3086         spin_lock_irq(&data->txlock);
3087         if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) {
3088                 set_bit(BTUSB_SUSPENDING, &data->flags);
3089                 spin_unlock_irq(&data->txlock);
3090         } else {
3091                 spin_unlock_irq(&data->txlock);
3092                 data->suspend_count--;
3093                 return -EBUSY;
3094         }
3095
3096         cancel_work_sync(&data->work);
3097
3098         btusb_stop_traffic(data);
3099         usb_kill_anchored_urbs(&data->tx_anchor);
3100
3101         /* Optionally request a device reset on resume, but only when
3102          * wakeups are disabled. If wakeups are enabled we assume the
3103          * device will stay powered up throughout suspend.
3104          */
3105         if (test_bit(BTUSB_RESET_RESUME, &data->flags) &&
3106             !device_may_wakeup(&data->udev->dev))
3107                 data->udev->reset_resume = 1;
3108
3109         return 0;
3110 }
3111
3112 static void play_deferred(struct btusb_data *data)
3113 {
3114         struct urb *urb;
3115         int err;
3116
3117         while ((urb = usb_get_from_anchor(&data->deferred))) {
3118                 err = usb_submit_urb(urb, GFP_ATOMIC);
3119                 if (err < 0)
3120                         break;
3121
3122                 data->tx_in_flight++;
3123         }
3124         usb_scuttle_anchored_urbs(&data->deferred);
3125 }
3126
3127 static int btusb_resume(struct usb_interface *intf)
3128 {
3129         struct btusb_data *data = usb_get_intfdata(intf);
3130         struct hci_dev *hdev = data->hdev;
3131         int err = 0;
3132
3133         BT_DBG("intf %p", intf);
3134
3135         if (--data->suspend_count)
3136                 return 0;
3137
3138         if (!test_bit(HCI_RUNNING, &hdev->flags))
3139                 goto done;
3140
3141         if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
3142                 err = btusb_submit_intr_urb(hdev, GFP_NOIO);
3143                 if (err < 0) {
3144                         clear_bit(BTUSB_INTR_RUNNING, &data->flags);
3145                         goto failed;
3146                 }
3147         }
3148
3149         if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
3150                 err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
3151                 if (err < 0) {
3152                         clear_bit(BTUSB_BULK_RUNNING, &data->flags);
3153                         goto failed;
3154                 }
3155
3156                 btusb_submit_bulk_urb(hdev, GFP_NOIO);
3157         }
3158
3159         if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
3160                 if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
3161                         clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
3162                 else
3163                         btusb_submit_isoc_urb(hdev, GFP_NOIO);
3164         }
3165
3166         spin_lock_irq(&data->txlock);
3167         play_deferred(data);
3168         clear_bit(BTUSB_SUSPENDING, &data->flags);
3169         spin_unlock_irq(&data->txlock);
3170         schedule_work(&data->work);
3171
3172         return 0;
3173
3174 failed:
3175         usb_scuttle_anchored_urbs(&data->deferred);
3176 done:
3177         spin_lock_irq(&data->txlock);
3178         clear_bit(BTUSB_SUSPENDING, &data->flags);
3179         spin_unlock_irq(&data->txlock);
3180
3181         return err;
3182 }
3183 #endif
3184
3185 static struct usb_driver btusb_driver = {
3186         .name           = "btusb",
3187         .probe          = btusb_probe,
3188         .disconnect     = btusb_disconnect,
3189 #ifdef CONFIG_PM
3190         .suspend        = btusb_suspend,
3191         .resume         = btusb_resume,
3192 #endif
3193         .id_table       = btusb_table,
3194         .supports_autosuspend = 1,
3195         .disable_hub_initiated_lpm = 1,
3196 };
3197
3198 module_usb_driver(btusb_driver);
3199
3200 module_param(disable_scofix, bool, 0644);
3201 MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
3202
3203 module_param(force_scofix, bool, 0644);
3204 MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
3205
3206 module_param(reset, bool, 0644);
3207 MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
3208
3209 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
3210 MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
3211 MODULE_VERSION(VERSION);
3212 MODULE_LICENSE("GPL");