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