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