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 unsigned long flags; 1376 1377 clear_bit(BTUSB_ISOC_RUNNING, &data->flags); 1378 usb_kill_anchored_urbs(&data->isoc_anchor); 1379 1380 /* When isochronous alternate setting needs to be 1381 * changed, because SCO connection has been added 1382 * or removed, a packet fragment may be left in the 1383 * reassembling state. This could lead to wrongly 1384 * assembled fragments. 1385 * 1386 * Clear outstanding fragment when selecting a new 1387 * alternate setting. 1388 */ 1389 spin_lock_irqsave(&data->rxlock, flags); 1390 kfree_skb(data->sco_skb); 1391 data->sco_skb = NULL; 1392 spin_unlock_irqrestore(&data->rxlock, flags); 1393 1394 if (__set_isoc_interface(hdev, new_alts) < 0) 1395 return; 1396 } 1397 1398 if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) { 1399 if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0) 1400 clear_bit(BTUSB_ISOC_RUNNING, &data->flags); 1401 else 1402 btusb_submit_isoc_urb(hdev, GFP_KERNEL); 1403 } 1404 } else { 1405 clear_bit(BTUSB_ISOC_RUNNING, &data->flags); 1406 usb_kill_anchored_urbs(&data->isoc_anchor); 1407 1408 __set_isoc_interface(hdev, 0); 1409 if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags)) 1410 usb_autopm_put_interface(data->isoc ? data->isoc : data->intf); 1411 } 1412 } 1413 1414 static void btusb_waker(struct work_struct *work) 1415 { 1416 struct btusb_data *data = container_of(work, struct btusb_data, waker); 1417 int err; 1418 1419 err = usb_autopm_get_interface(data->intf); 1420 if (err < 0) 1421 return; 1422 1423 usb_autopm_put_interface(data->intf); 1424 } 1425 1426 static int btusb_setup_bcm92035(struct hci_dev *hdev) 1427 { 1428 struct sk_buff *skb; 1429 u8 val = 0x00; 1430 1431 BT_DBG("%s", hdev->name); 1432 1433 skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT); 1434 if (IS_ERR(skb)) 1435 BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb)); 1436 else 1437 kfree_skb(skb); 1438 1439 return 0; 1440 } 1441 1442 static int btusb_setup_csr(struct hci_dev *hdev) 1443 { 1444 struct hci_rp_read_local_version *rp; 1445 struct sk_buff *skb; 1446 1447 BT_DBG("%s", hdev->name); 1448 1449 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL, 1450 HCI_INIT_TIMEOUT); 1451 if (IS_ERR(skb)) { 1452 int err = PTR_ERR(skb); 1453 BT_ERR("%s: CSR: Local version failed (%d)", hdev->name, err); 1454 return err; 1455 } 1456 1457 if (skb->len != sizeof(struct hci_rp_read_local_version)) { 1458 BT_ERR("%s: CSR: Local version length mismatch", hdev->name); 1459 kfree_skb(skb); 1460 return -EIO; 1461 } 1462 1463 rp = (struct hci_rp_read_local_version *)skb->data; 1464 1465 /* Detect controllers which aren't real CSR ones. */ 1466 if (le16_to_cpu(rp->manufacturer) != 10 || 1467 le16_to_cpu(rp->lmp_subver) == 0x0c5c) { 1468 /* Clear the reset quirk since this is not an actual 1469 * early Bluetooth 1.1 device from CSR. 1470 */ 1471 clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks); 1472 1473 /* These fake CSR controllers have all a broken 1474 * stored link key handling and so just disable it. 1475 */ 1476 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks); 1477 } 1478 1479 kfree_skb(skb); 1480 1481 return 0; 1482 } 1483 1484 static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev, 1485 struct intel_version *ver) 1486 { 1487 const struct firmware *fw; 1488 char fwname[64]; 1489 int ret; 1490 1491 snprintf(fwname, sizeof(fwname), 1492 "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq", 1493 ver->hw_platform, ver->hw_variant, ver->hw_revision, 1494 ver->fw_variant, ver->fw_revision, ver->fw_build_num, 1495 ver->fw_build_ww, ver->fw_build_yy); 1496 1497 ret = request_firmware(&fw, fwname, &hdev->dev); 1498 if (ret < 0) { 1499 if (ret == -EINVAL) { 1500 BT_ERR("%s Intel firmware file request failed (%d)", 1501 hdev->name, ret); 1502 return NULL; 1503 } 1504 1505 BT_ERR("%s failed to open Intel firmware file: %s(%d)", 1506 hdev->name, fwname, ret); 1507 1508 /* If the correct firmware patch file is not found, use the 1509 * default firmware patch file instead 1510 */ 1511 snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq", 1512 ver->hw_platform, ver->hw_variant); 1513 if (request_firmware(&fw, fwname, &hdev->dev) < 0) { 1514 BT_ERR("%s failed to open default Intel fw file: %s", 1515 hdev->name, fwname); 1516 return NULL; 1517 } 1518 } 1519 1520 BT_INFO("%s: Intel Bluetooth firmware file: %s", hdev->name, fwname); 1521 1522 return fw; 1523 } 1524 1525 static int btusb_setup_intel_patching(struct hci_dev *hdev, 1526 const struct firmware *fw, 1527 const u8 **fw_ptr, int *disable_patch) 1528 { 1529 struct sk_buff *skb; 1530 struct hci_command_hdr *cmd; 1531 const u8 *cmd_param; 1532 struct hci_event_hdr *evt = NULL; 1533 const u8 *evt_param = NULL; 1534 int remain = fw->size - (*fw_ptr - fw->data); 1535 1536 /* The first byte indicates the types of the patch command or event. 1537 * 0x01 means HCI command and 0x02 is HCI event. If the first bytes 1538 * in the current firmware buffer doesn't start with 0x01 or 1539 * the size of remain buffer is smaller than HCI command header, 1540 * the firmware file is corrupted and it should stop the patching 1541 * process. 1542 */ 1543 if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) { 1544 BT_ERR("%s Intel fw corrupted: invalid cmd read", hdev->name); 1545 return -EINVAL; 1546 } 1547 (*fw_ptr)++; 1548 remain--; 1549 1550 cmd = (struct hci_command_hdr *)(*fw_ptr); 1551 *fw_ptr += sizeof(*cmd); 1552 remain -= sizeof(*cmd); 1553 1554 /* Ensure that the remain firmware data is long enough than the length 1555 * of command parameter. If not, the firmware file is corrupted. 1556 */ 1557 if (remain < cmd->plen) { 1558 BT_ERR("%s Intel fw corrupted: invalid cmd len", hdev->name); 1559 return -EFAULT; 1560 } 1561 1562 /* If there is a command that loads a patch in the firmware 1563 * file, then enable the patch upon success, otherwise just 1564 * disable the manufacturer mode, for example patch activation 1565 * is not required when the default firmware patch file is used 1566 * because there are no patch data to load. 1567 */ 1568 if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e) 1569 *disable_patch = 0; 1570 1571 cmd_param = *fw_ptr; 1572 *fw_ptr += cmd->plen; 1573 remain -= cmd->plen; 1574 1575 /* This reads the expected events when the above command is sent to the 1576 * device. Some vendor commands expects more than one events, for 1577 * example command status event followed by vendor specific event. 1578 * For this case, it only keeps the last expected event. so the command 1579 * can be sent with __hci_cmd_sync_ev() which returns the sk_buff of 1580 * last expected event. 1581 */ 1582 while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) { 1583 (*fw_ptr)++; 1584 remain--; 1585 1586 evt = (struct hci_event_hdr *)(*fw_ptr); 1587 *fw_ptr += sizeof(*evt); 1588 remain -= sizeof(*evt); 1589 1590 if (remain < evt->plen) { 1591 BT_ERR("%s Intel fw corrupted: invalid evt len", 1592 hdev->name); 1593 return -EFAULT; 1594 } 1595 1596 evt_param = *fw_ptr; 1597 *fw_ptr += evt->plen; 1598 remain -= evt->plen; 1599 } 1600 1601 /* Every HCI commands in the firmware file has its correspond event. 1602 * If event is not found or remain is smaller than zero, the firmware 1603 * file is corrupted. 1604 */ 1605 if (!evt || !evt_param || remain < 0) { 1606 BT_ERR("%s Intel fw corrupted: invalid evt read", hdev->name); 1607 return -EFAULT; 1608 } 1609 1610 skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen, 1611 cmd_param, evt->evt, HCI_INIT_TIMEOUT); 1612 if (IS_ERR(skb)) { 1613 BT_ERR("%s sending Intel patch command (0x%4.4x) failed (%ld)", 1614 hdev->name, cmd->opcode, PTR_ERR(skb)); 1615 return PTR_ERR(skb); 1616 } 1617 1618 /* It ensures that the returned event matches the event data read from 1619 * the firmware file. At fist, it checks the length and then 1620 * the contents of the event. 1621 */ 1622 if (skb->len != evt->plen) { 1623 BT_ERR("%s mismatch event length (opcode 0x%4.4x)", hdev->name, 1624 le16_to_cpu(cmd->opcode)); 1625 kfree_skb(skb); 1626 return -EFAULT; 1627 } 1628 1629 if (memcmp(skb->data, evt_param, evt->plen)) { 1630 BT_ERR("%s mismatch event parameter (opcode 0x%4.4x)", 1631 hdev->name, le16_to_cpu(cmd->opcode)); 1632 kfree_skb(skb); 1633 return -EFAULT; 1634 } 1635 kfree_skb(skb); 1636 1637 return 0; 1638 } 1639 1640 static int btusb_setup_intel(struct hci_dev *hdev) 1641 { 1642 struct sk_buff *skb; 1643 const struct firmware *fw; 1644 const u8 *fw_ptr; 1645 int disable_patch; 1646 struct intel_version *ver; 1647 1648 const u8 mfg_enable[] = { 0x01, 0x00 }; 1649 const u8 mfg_disable[] = { 0x00, 0x00 }; 1650 const u8 mfg_reset_deactivate[] = { 0x00, 0x01 }; 1651 const u8 mfg_reset_activate[] = { 0x00, 0x02 }; 1652 1653 BT_DBG("%s", hdev->name); 1654 1655 /* The controller has a bug with the first HCI command sent to it 1656 * returning number of completed commands as zero. This would stall the 1657 * command processing in the Bluetooth core. 1658 * 1659 * As a workaround, send HCI Reset command first which will reset the 1660 * number of completed commands and allow normal command processing 1661 * from now on. 1662 */ 1663 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT); 1664 if (IS_ERR(skb)) { 1665 BT_ERR("%s sending initial HCI reset command failed (%ld)", 1666 hdev->name, PTR_ERR(skb)); 1667 return PTR_ERR(skb); 1668 } 1669 kfree_skb(skb); 1670 1671 /* Read Intel specific controller version first to allow selection of 1672 * which firmware file to load. 1673 * 1674 * The returned information are hardware variant and revision plus 1675 * firmware variant, revision and build number. 1676 */ 1677 skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT); 1678 if (IS_ERR(skb)) { 1679 BT_ERR("%s reading Intel fw version command failed (%ld)", 1680 hdev->name, PTR_ERR(skb)); 1681 return PTR_ERR(skb); 1682 } 1683 1684 if (skb->len != sizeof(*ver)) { 1685 BT_ERR("%s Intel version event length mismatch", hdev->name); 1686 kfree_skb(skb); 1687 return -EIO; 1688 } 1689 1690 ver = (struct intel_version *)skb->data; 1691 1692 BT_INFO("%s: read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x", 1693 hdev->name, ver->hw_platform, ver->hw_variant, 1694 ver->hw_revision, ver->fw_variant, ver->fw_revision, 1695 ver->fw_build_num, ver->fw_build_ww, ver->fw_build_yy, 1696 ver->fw_patch_num); 1697 1698 /* fw_patch_num indicates the version of patch the device currently 1699 * have. If there is no patch data in the device, it is always 0x00. 1700 * So, if it is other than 0x00, no need to patch the device again. 1701 */ 1702 if (ver->fw_patch_num) { 1703 BT_INFO("%s: Intel device is already patched. patch num: %02x", 1704 hdev->name, ver->fw_patch_num); 1705 kfree_skb(skb); 1706 goto complete; 1707 } 1708 1709 /* Opens the firmware patch file based on the firmware version read 1710 * from the controller. If it fails to open the matching firmware 1711 * patch file, it tries to open the default firmware patch file. 1712 * If no patch file is found, allow the device to operate without 1713 * a patch. 1714 */ 1715 fw = btusb_setup_intel_get_fw(hdev, ver); 1716 if (!fw) { 1717 kfree_skb(skb); 1718 goto complete; 1719 } 1720 fw_ptr = fw->data; 1721 1722 kfree_skb(skb); 1723 1724 /* This Intel specific command enables the manufacturer mode of the 1725 * controller. 1726 * 1727 * Only while this mode is enabled, the driver can download the 1728 * firmware patch data and configuration parameters. 1729 */ 1730 skb = __hci_cmd_sync(hdev, 0xfc11, 2, mfg_enable, HCI_INIT_TIMEOUT); 1731 if (IS_ERR(skb)) { 1732 BT_ERR("%s entering Intel manufacturer mode failed (%ld)", 1733 hdev->name, PTR_ERR(skb)); 1734 release_firmware(fw); 1735 return PTR_ERR(skb); 1736 } 1737 1738 kfree_skb(skb); 1739 1740 disable_patch = 1; 1741 1742 /* The firmware data file consists of list of Intel specific HCI 1743 * commands and its expected events. The first byte indicates the 1744 * type of the message, either HCI command or HCI event. 1745 * 1746 * It reads the command and its expected event from the firmware file, 1747 * and send to the controller. Once __hci_cmd_sync_ev() returns, 1748 * the returned event is compared with the event read from the firmware 1749 * file and it will continue until all the messages are downloaded to 1750 * the controller. 1751 * 1752 * Once the firmware patching is completed successfully, 1753 * the manufacturer mode is disabled with reset and activating the 1754 * downloaded patch. 1755 * 1756 * If the firmware patching fails, the manufacturer mode is 1757 * disabled with reset and deactivating the patch. 1758 * 1759 * If the default patch file is used, no reset is done when disabling 1760 * the manufacturer. 1761 */ 1762 while (fw->size > fw_ptr - fw->data) { 1763 int ret; 1764 1765 ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr, 1766 &disable_patch); 1767 if (ret < 0) 1768 goto exit_mfg_deactivate; 1769 } 1770 1771 release_firmware(fw); 1772 1773 if (disable_patch) 1774 goto exit_mfg_disable; 1775 1776 /* Patching completed successfully and disable the manufacturer mode 1777 * with reset and activate the downloaded firmware patches. 1778 */ 1779 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_activate), 1780 mfg_reset_activate, HCI_INIT_TIMEOUT); 1781 if (IS_ERR(skb)) { 1782 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)", 1783 hdev->name, PTR_ERR(skb)); 1784 return PTR_ERR(skb); 1785 } 1786 kfree_skb(skb); 1787 1788 BT_INFO("%s: Intel Bluetooth firmware patch completed and activated", 1789 hdev->name); 1790 1791 goto complete; 1792 1793 exit_mfg_disable: 1794 /* Disable the manufacturer mode without reset */ 1795 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_disable), mfg_disable, 1796 HCI_INIT_TIMEOUT); 1797 if (IS_ERR(skb)) { 1798 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)", 1799 hdev->name, PTR_ERR(skb)); 1800 return PTR_ERR(skb); 1801 } 1802 kfree_skb(skb); 1803 1804 BT_INFO("%s: Intel Bluetooth firmware patch completed", hdev->name); 1805 1806 goto complete; 1807 1808 exit_mfg_deactivate: 1809 release_firmware(fw); 1810 1811 /* Patching failed. Disable the manufacturer mode with reset and 1812 * deactivate the downloaded firmware patches. 1813 */ 1814 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_deactivate), 1815 mfg_reset_deactivate, HCI_INIT_TIMEOUT); 1816 if (IS_ERR(skb)) { 1817 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)", 1818 hdev->name, PTR_ERR(skb)); 1819 return PTR_ERR(skb); 1820 } 1821 kfree_skb(skb); 1822 1823 BT_INFO("%s: Intel Bluetooth firmware patch completed and deactivated", 1824 hdev->name); 1825 1826 complete: 1827 /* Set the event mask for Intel specific vendor events. This enables 1828 * a few extra events that are useful during general operation. 1829 */ 1830 btintel_set_event_mask_mfg(hdev, false); 1831 1832 btintel_check_bdaddr(hdev); 1833 return 0; 1834 } 1835 1836 static int inject_cmd_complete(struct hci_dev *hdev, __u16 opcode) 1837 { 1838 struct sk_buff *skb; 1839 struct hci_event_hdr *hdr; 1840 struct hci_ev_cmd_complete *evt; 1841 1842 skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_ATOMIC); 1843 if (!skb) 1844 return -ENOMEM; 1845 1846 hdr = (struct hci_event_hdr *)skb_put(skb, sizeof(*hdr)); 1847 hdr->evt = HCI_EV_CMD_COMPLETE; 1848 hdr->plen = sizeof(*evt) + 1; 1849 1850 evt = (struct hci_ev_cmd_complete *)skb_put(skb, sizeof(*evt)); 1851 evt->ncmd = 0x01; 1852 evt->opcode = cpu_to_le16(opcode); 1853 1854 *skb_put(skb, 1) = 0x00; 1855 1856 bt_cb(skb)->pkt_type = HCI_EVENT_PKT; 1857 1858 return hci_recv_frame(hdev, skb); 1859 } 1860 1861 static int btusb_recv_bulk_intel(struct btusb_data *data, void *buffer, 1862 int count) 1863 { 1864 /* When the device is in bootloader mode, then it can send 1865 * events via the bulk endpoint. These events are treated the 1866 * same way as the ones received from the interrupt endpoint. 1867 */ 1868 if (test_bit(BTUSB_BOOTLOADER, &data->flags)) 1869 return btusb_recv_intr(data, buffer, count); 1870 1871 return btusb_recv_bulk(data, buffer, count); 1872 } 1873 1874 static void btusb_intel_bootup(struct btusb_data *data, const void *ptr, 1875 unsigned int len) 1876 { 1877 const struct intel_bootup *evt = ptr; 1878 1879 if (len != sizeof(*evt)) 1880 return; 1881 1882 if (test_and_clear_bit(BTUSB_BOOTING, &data->flags)) { 1883 smp_mb__after_atomic(); 1884 wake_up_bit(&data->flags, BTUSB_BOOTING); 1885 } 1886 } 1887 1888 static void btusb_intel_secure_send_result(struct btusb_data *data, 1889 const void *ptr, unsigned int len) 1890 { 1891 const struct intel_secure_send_result *evt = ptr; 1892 1893 if (len != sizeof(*evt)) 1894 return; 1895 1896 if (evt->result) 1897 set_bit(BTUSB_FIRMWARE_FAILED, &data->flags); 1898 1899 if (test_and_clear_bit(BTUSB_DOWNLOADING, &data->flags) && 1900 test_bit(BTUSB_FIRMWARE_LOADED, &data->flags)) { 1901 smp_mb__after_atomic(); 1902 wake_up_bit(&data->flags, BTUSB_DOWNLOADING); 1903 } 1904 } 1905 1906 static int btusb_recv_event_intel(struct hci_dev *hdev, struct sk_buff *skb) 1907 { 1908 struct btusb_data *data = hci_get_drvdata(hdev); 1909 1910 if (test_bit(BTUSB_BOOTLOADER, &data->flags)) { 1911 struct hci_event_hdr *hdr = (void *)skb->data; 1912 1913 if (skb->len > HCI_EVENT_HDR_SIZE && hdr->evt == 0xff && 1914 hdr->plen > 0) { 1915 const void *ptr = skb->data + HCI_EVENT_HDR_SIZE + 1; 1916 unsigned int len = skb->len - HCI_EVENT_HDR_SIZE - 1; 1917 1918 switch (skb->data[2]) { 1919 case 0x02: 1920 /* When switching to the operational firmware 1921 * the device sends a vendor specific event 1922 * indicating that the bootup completed. 1923 */ 1924 btusb_intel_bootup(data, ptr, len); 1925 break; 1926 case 0x06: 1927 /* When the firmware loading completes the 1928 * device sends out a vendor specific event 1929 * indicating the result of the firmware 1930 * loading. 1931 */ 1932 btusb_intel_secure_send_result(data, ptr, len); 1933 break; 1934 } 1935 } 1936 } 1937 1938 return hci_recv_frame(hdev, skb); 1939 } 1940 1941 static int btusb_send_frame_intel(struct hci_dev *hdev, struct sk_buff *skb) 1942 { 1943 struct btusb_data *data = hci_get_drvdata(hdev); 1944 struct urb *urb; 1945 1946 BT_DBG("%s", hdev->name); 1947 1948 switch (bt_cb(skb)->pkt_type) { 1949 case HCI_COMMAND_PKT: 1950 if (test_bit(BTUSB_BOOTLOADER, &data->flags)) { 1951 struct hci_command_hdr *cmd = (void *)skb->data; 1952 __u16 opcode = le16_to_cpu(cmd->opcode); 1953 1954 /* When in bootloader mode and the command 0xfc09 1955 * is received, it needs to be send down the 1956 * bulk endpoint. So allocate a bulk URB instead. 1957 */ 1958 if (opcode == 0xfc09) 1959 urb = alloc_bulk_urb(hdev, skb); 1960 else 1961 urb = alloc_ctrl_urb(hdev, skb); 1962 1963 /* When the 0xfc01 command is issued to boot into 1964 * the operational firmware, it will actually not 1965 * send a command complete event. To keep the flow 1966 * control working inject that event here. 1967 */ 1968 if (opcode == 0xfc01) 1969 inject_cmd_complete(hdev, opcode); 1970 } else { 1971 urb = alloc_ctrl_urb(hdev, skb); 1972 } 1973 if (IS_ERR(urb)) 1974 return PTR_ERR(urb); 1975 1976 hdev->stat.cmd_tx++; 1977 return submit_or_queue_tx_urb(hdev, urb); 1978 1979 case HCI_ACLDATA_PKT: 1980 urb = alloc_bulk_urb(hdev, skb); 1981 if (IS_ERR(urb)) 1982 return PTR_ERR(urb); 1983 1984 hdev->stat.acl_tx++; 1985 return submit_or_queue_tx_urb(hdev, urb); 1986 1987 case HCI_SCODATA_PKT: 1988 if (hci_conn_num(hdev, SCO_LINK) < 1) 1989 return -ENODEV; 1990 1991 urb = alloc_isoc_urb(hdev, skb); 1992 if (IS_ERR(urb)) 1993 return PTR_ERR(urb); 1994 1995 hdev->stat.sco_tx++; 1996 return submit_tx_urb(hdev, urb); 1997 } 1998 1999 return -EILSEQ; 2000 } 2001 2002 static int btusb_setup_intel_new(struct hci_dev *hdev) 2003 { 2004 static const u8 reset_param[] = { 0x00, 0x01, 0x00, 0x01, 2005 0x00, 0x08, 0x04, 0x00 }; 2006 struct btusb_data *data = hci_get_drvdata(hdev); 2007 struct sk_buff *skb; 2008 struct intel_version *ver; 2009 struct intel_boot_params *params; 2010 const struct firmware *fw; 2011 const u8 *fw_ptr; 2012 u32 frag_len; 2013 char fwname[64]; 2014 ktime_t calltime, delta, rettime; 2015 unsigned long long duration; 2016 int err; 2017 2018 BT_DBG("%s", hdev->name); 2019 2020 calltime = ktime_get(); 2021 2022 /* Read the Intel version information to determine if the device 2023 * is in bootloader mode or if it already has operational firmware 2024 * loaded. 2025 */ 2026 skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT); 2027 if (IS_ERR(skb)) { 2028 BT_ERR("%s: Reading Intel version information failed (%ld)", 2029 hdev->name, PTR_ERR(skb)); 2030 return PTR_ERR(skb); 2031 } 2032 2033 if (skb->len != sizeof(*ver)) { 2034 BT_ERR("%s: Intel version event size mismatch", hdev->name); 2035 kfree_skb(skb); 2036 return -EILSEQ; 2037 } 2038 2039 ver = (struct intel_version *)skb->data; 2040 2041 /* The hardware platform number has a fixed value of 0x37 and 2042 * for now only accept this single value. 2043 */ 2044 if (ver->hw_platform != 0x37) { 2045 BT_ERR("%s: Unsupported Intel hardware platform (%u)", 2046 hdev->name, ver->hw_platform); 2047 kfree_skb(skb); 2048 return -EINVAL; 2049 } 2050 2051 /* At the moment only the hardware variant iBT 3.0 (LnP/SfP) is 2052 * supported by this firmware loading method. This check has been 2053 * put in place to ensure correct forward compatibility options 2054 * when newer hardware variants come along. 2055 */ 2056 if (ver->hw_variant != 0x0b) { 2057 BT_ERR("%s: Unsupported Intel hardware variant (%u)", 2058 hdev->name, ver->hw_variant); 2059 kfree_skb(skb); 2060 return -EINVAL; 2061 } 2062 2063 btintel_version_info(hdev, ver); 2064 2065 /* The firmware variant determines if the device is in bootloader 2066 * mode or is running operational firmware. The value 0x06 identifies 2067 * the bootloader and the value 0x23 identifies the operational 2068 * firmware. 2069 * 2070 * When the operational firmware is already present, then only 2071 * the check for valid Bluetooth device address is needed. This 2072 * determines if the device will be added as configured or 2073 * unconfigured controller. 2074 * 2075 * It is not possible to use the Secure Boot Parameters in this 2076 * case since that command is only available in bootloader mode. 2077 */ 2078 if (ver->fw_variant == 0x23) { 2079 kfree_skb(skb); 2080 clear_bit(BTUSB_BOOTLOADER, &data->flags); 2081 btintel_check_bdaddr(hdev); 2082 return 0; 2083 } 2084 2085 /* If the device is not in bootloader mode, then the only possible 2086 * choice is to return an error and abort the device initialization. 2087 */ 2088 if (ver->fw_variant != 0x06) { 2089 BT_ERR("%s: Unsupported Intel firmware variant (%u)", 2090 hdev->name, ver->fw_variant); 2091 kfree_skb(skb); 2092 return -ENODEV; 2093 } 2094 2095 kfree_skb(skb); 2096 2097 /* Read the secure boot parameters to identify the operating 2098 * details of the bootloader. 2099 */ 2100 skb = __hci_cmd_sync(hdev, 0xfc0d, 0, NULL, HCI_INIT_TIMEOUT); 2101 if (IS_ERR(skb)) { 2102 BT_ERR("%s: Reading Intel boot parameters failed (%ld)", 2103 hdev->name, PTR_ERR(skb)); 2104 return PTR_ERR(skb); 2105 } 2106 2107 if (skb->len != sizeof(*params)) { 2108 BT_ERR("%s: Intel boot parameters size mismatch", hdev->name); 2109 kfree_skb(skb); 2110 return -EILSEQ; 2111 } 2112 2113 params = (struct intel_boot_params *)skb->data; 2114 2115 BT_INFO("%s: Device revision is %u", hdev->name, 2116 le16_to_cpu(params->dev_revid)); 2117 2118 BT_INFO("%s: Secure boot is %s", hdev->name, 2119 params->secure_boot ? "enabled" : "disabled"); 2120 2121 BT_INFO("%s: OTP lock is %s", hdev->name, 2122 params->otp_lock ? "enabled" : "disabled"); 2123 2124 BT_INFO("%s: API lock is %s", hdev->name, 2125 params->api_lock ? "enabled" : "disabled"); 2126 2127 BT_INFO("%s: Debug lock is %s", hdev->name, 2128 params->debug_lock ? "enabled" : "disabled"); 2129 2130 BT_INFO("%s: Minimum firmware build %u week %u %u", hdev->name, 2131 params->min_fw_build_nn, params->min_fw_build_cw, 2132 2000 + params->min_fw_build_yy); 2133 2134 /* It is required that every single firmware fragment is acknowledged 2135 * with a command complete event. If the boot parameters indicate 2136 * that this bootloader does not send them, then abort the setup. 2137 */ 2138 if (params->limited_cce != 0x00) { 2139 BT_ERR("%s: Unsupported Intel firmware loading method (%u)", 2140 hdev->name, params->limited_cce); 2141 kfree_skb(skb); 2142 return -EINVAL; 2143 } 2144 2145 /* If the OTP has no valid Bluetooth device address, then there will 2146 * also be no valid address for the operational firmware. 2147 */ 2148 if (!bacmp(¶ms->otp_bdaddr, BDADDR_ANY)) { 2149 BT_INFO("%s: No device address configured", hdev->name); 2150 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks); 2151 } 2152 2153 /* With this Intel bootloader only the hardware variant and device 2154 * revision information are used to select the right firmware. 2155 * 2156 * Currently this bootloader support is limited to hardware variant 2157 * iBT 3.0 (LnP/SfP) which is identified by the value 11 (0x0b). 2158 */ 2159 snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.sfi", 2160 le16_to_cpu(params->dev_revid)); 2161 2162 err = request_firmware(&fw, fwname, &hdev->dev); 2163 if (err < 0) { 2164 BT_ERR("%s: Failed to load Intel firmware file (%d)", 2165 hdev->name, err); 2166 kfree_skb(skb); 2167 return err; 2168 } 2169 2170 BT_INFO("%s: Found device firmware: %s", hdev->name, fwname); 2171 2172 /* Save the DDC file name for later use to apply once the firmware 2173 * downloading is done. 2174 */ 2175 snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.ddc", 2176 le16_to_cpu(params->dev_revid)); 2177 2178 kfree_skb(skb); 2179 2180 if (fw->size < 644) { 2181 BT_ERR("%s: Invalid size of firmware file (%zu)", 2182 hdev->name, fw->size); 2183 err = -EBADF; 2184 goto done; 2185 } 2186 2187 set_bit(BTUSB_DOWNLOADING, &data->flags); 2188 2189 /* Start the firmware download transaction with the Init fragment 2190 * represented by the 128 bytes of CSS header. 2191 */ 2192 err = btintel_secure_send(hdev, 0x00, 128, fw->data); 2193 if (err < 0) { 2194 BT_ERR("%s: Failed to send firmware header (%d)", 2195 hdev->name, err); 2196 goto done; 2197 } 2198 2199 /* Send the 256 bytes of public key information from the firmware 2200 * as the PKey fragment. 2201 */ 2202 err = btintel_secure_send(hdev, 0x03, 256, fw->data + 128); 2203 if (err < 0) { 2204 BT_ERR("%s: Failed to send firmware public key (%d)", 2205 hdev->name, err); 2206 goto done; 2207 } 2208 2209 /* Send the 256 bytes of signature information from the firmware 2210 * as the Sign fragment. 2211 */ 2212 err = btintel_secure_send(hdev, 0x02, 256, fw->data + 388); 2213 if (err < 0) { 2214 BT_ERR("%s: Failed to send firmware signature (%d)", 2215 hdev->name, err); 2216 goto done; 2217 } 2218 2219 fw_ptr = fw->data + 644; 2220 frag_len = 0; 2221 2222 while (fw_ptr - fw->data < fw->size) { 2223 struct hci_command_hdr *cmd = (void *)(fw_ptr + frag_len); 2224 2225 frag_len += sizeof(*cmd) + cmd->plen; 2226 2227 /* The parameter length of the secure send command requires 2228 * a 4 byte alignment. It happens so that the firmware file 2229 * contains proper Intel_NOP commands to align the fragments 2230 * as needed. 2231 * 2232 * Send set of commands with 4 byte alignment from the 2233 * firmware data buffer as a single Data fragement. 2234 */ 2235 if (!(frag_len % 4)) { 2236 err = btintel_secure_send(hdev, 0x01, frag_len, fw_ptr); 2237 if (err < 0) { 2238 BT_ERR("%s: Failed to send firmware data (%d)", 2239 hdev->name, err); 2240 goto done; 2241 } 2242 2243 fw_ptr += frag_len; 2244 frag_len = 0; 2245 } 2246 } 2247 2248 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags); 2249 2250 BT_INFO("%s: Waiting for firmware download to complete", hdev->name); 2251 2252 /* Before switching the device into operational mode and with that 2253 * booting the loaded firmware, wait for the bootloader notification 2254 * that all fragments have been successfully received. 2255 * 2256 * When the event processing receives the notification, then the 2257 * BTUSB_DOWNLOADING flag will be cleared. 2258 * 2259 * The firmware loading should not take longer than 5 seconds 2260 * and thus just timeout if that happens and fail the setup 2261 * of this device. 2262 */ 2263 err = wait_on_bit_timeout(&data->flags, BTUSB_DOWNLOADING, 2264 TASK_INTERRUPTIBLE, 2265 msecs_to_jiffies(5000)); 2266 if (err == 1) { 2267 BT_ERR("%s: Firmware loading interrupted", hdev->name); 2268 err = -EINTR; 2269 goto done; 2270 } 2271 2272 if (err) { 2273 BT_ERR("%s: Firmware loading timeout", hdev->name); 2274 err = -ETIMEDOUT; 2275 goto done; 2276 } 2277 2278 if (test_bit(BTUSB_FIRMWARE_FAILED, &data->flags)) { 2279 BT_ERR("%s: Firmware loading failed", hdev->name); 2280 err = -ENOEXEC; 2281 goto done; 2282 } 2283 2284 rettime = ktime_get(); 2285 delta = ktime_sub(rettime, calltime); 2286 duration = (unsigned long long) ktime_to_ns(delta) >> 10; 2287 2288 BT_INFO("%s: Firmware loaded in %llu usecs", hdev->name, duration); 2289 2290 done: 2291 release_firmware(fw); 2292 2293 if (err < 0) 2294 return err; 2295 2296 calltime = ktime_get(); 2297 2298 set_bit(BTUSB_BOOTING, &data->flags); 2299 2300 skb = __hci_cmd_sync(hdev, 0xfc01, sizeof(reset_param), reset_param, 2301 HCI_INIT_TIMEOUT); 2302 if (IS_ERR(skb)) 2303 return PTR_ERR(skb); 2304 2305 kfree_skb(skb); 2306 2307 /* The bootloader will not indicate when the device is ready. This 2308 * is done by the operational firmware sending bootup notification. 2309 * 2310 * Booting into operational firmware should not take longer than 2311 * 1 second. However if that happens, then just fail the setup 2312 * since something went wrong. 2313 */ 2314 BT_INFO("%s: Waiting for device to boot", hdev->name); 2315 2316 err = wait_on_bit_timeout(&data->flags, BTUSB_BOOTING, 2317 TASK_INTERRUPTIBLE, 2318 msecs_to_jiffies(1000)); 2319 2320 if (err == 1) { 2321 BT_ERR("%s: Device boot interrupted", hdev->name); 2322 return -EINTR; 2323 } 2324 2325 if (err) { 2326 BT_ERR("%s: Device boot timeout", hdev->name); 2327 return -ETIMEDOUT; 2328 } 2329 2330 rettime = ktime_get(); 2331 delta = ktime_sub(rettime, calltime); 2332 duration = (unsigned long long) ktime_to_ns(delta) >> 10; 2333 2334 BT_INFO("%s: Device booted in %llu usecs", hdev->name, duration); 2335 2336 clear_bit(BTUSB_BOOTLOADER, &data->flags); 2337 2338 /* Once the device is running in operational mode, it needs to apply 2339 * the device configuration (DDC) parameters. 2340 * 2341 * The device can work without DDC parameters, so even if it fails 2342 * to load the file, no need to fail the setup. 2343 */ 2344 btintel_load_ddc_config(hdev, fwname); 2345 2346 /* Set the event mask for Intel specific vendor events. This enables 2347 * a few extra events that are useful during general operation. It 2348 * does not enable any debugging related events. 2349 * 2350 * The device will function correctly without these events enabled 2351 * and thus no need to fail the setup. 2352 */ 2353 btintel_set_event_mask(hdev, false); 2354 2355 return 0; 2356 } 2357 2358 static int btusb_shutdown_intel(struct hci_dev *hdev) 2359 { 2360 struct sk_buff *skb; 2361 long ret; 2362 2363 /* Some platforms have an issue with BT LED when the interface is 2364 * down or BT radio is turned off, which takes 5 seconds to BT LED 2365 * goes off. This command turns off the BT LED immediately. 2366 */ 2367 skb = __hci_cmd_sync(hdev, 0xfc3f, 0, NULL, HCI_INIT_TIMEOUT); 2368 if (IS_ERR(skb)) { 2369 ret = PTR_ERR(skb); 2370 BT_ERR("%s: turning off Intel device LED failed (%ld)", 2371 hdev->name, ret); 2372 return ret; 2373 } 2374 kfree_skb(skb); 2375 2376 return 0; 2377 } 2378 2379 static int btusb_set_bdaddr_marvell(struct hci_dev *hdev, 2380 const bdaddr_t *bdaddr) 2381 { 2382 struct sk_buff *skb; 2383 u8 buf[8]; 2384 long ret; 2385 2386 buf[0] = 0xfe; 2387 buf[1] = sizeof(bdaddr_t); 2388 memcpy(buf + 2, bdaddr, sizeof(bdaddr_t)); 2389 2390 skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT); 2391 if (IS_ERR(skb)) { 2392 ret = PTR_ERR(skb); 2393 BT_ERR("%s: changing Marvell device address failed (%ld)", 2394 hdev->name, ret); 2395 return ret; 2396 } 2397 kfree_skb(skb); 2398 2399 return 0; 2400 } 2401 2402 static int btusb_set_bdaddr_ath3012(struct hci_dev *hdev, 2403 const bdaddr_t *bdaddr) 2404 { 2405 struct sk_buff *skb; 2406 u8 buf[10]; 2407 long ret; 2408 2409 buf[0] = 0x01; 2410 buf[1] = 0x01; 2411 buf[2] = 0x00; 2412 buf[3] = sizeof(bdaddr_t); 2413 memcpy(buf + 4, bdaddr, sizeof(bdaddr_t)); 2414 2415 skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT); 2416 if (IS_ERR(skb)) { 2417 ret = PTR_ERR(skb); 2418 BT_ERR("%s: Change address command failed (%ld)", 2419 hdev->name, ret); 2420 return ret; 2421 } 2422 kfree_skb(skb); 2423 2424 return 0; 2425 } 2426 2427 #define QCA_DFU_PACKET_LEN 4096 2428 2429 #define QCA_GET_TARGET_VERSION 0x09 2430 #define QCA_CHECK_STATUS 0x05 2431 #define QCA_DFU_DOWNLOAD 0x01 2432 2433 #define QCA_SYSCFG_UPDATED 0x40 2434 #define QCA_PATCH_UPDATED 0x80 2435 #define QCA_DFU_TIMEOUT 3000 2436 2437 struct qca_version { 2438 __le32 rom_version; 2439 __le32 patch_version; 2440 __le32 ram_version; 2441 __le32 ref_clock; 2442 __u8 reserved[4]; 2443 } __packed; 2444 2445 struct qca_rampatch_version { 2446 __le16 rom_version; 2447 __le16 patch_version; 2448 } __packed; 2449 2450 struct qca_device_info { 2451 u32 rom_version; 2452 u8 rampatch_hdr; /* length of header in rampatch */ 2453 u8 nvm_hdr; /* length of header in NVM */ 2454 u8 ver_offset; /* offset of version structure in rampatch */ 2455 }; 2456 2457 static const struct qca_device_info qca_devices_table[] = { 2458 { 0x00000100, 20, 4, 10 }, /* Rome 1.0 */ 2459 { 0x00000101, 20, 4, 10 }, /* Rome 1.1 */ 2460 { 0x00000200, 28, 4, 18 }, /* Rome 2.0 */ 2461 { 0x00000201, 28, 4, 18 }, /* Rome 2.1 */ 2462 { 0x00000300, 28, 4, 18 }, /* Rome 3.0 */ 2463 { 0x00000302, 28, 4, 18 }, /* Rome 3.2 */ 2464 }; 2465 2466 static int btusb_qca_send_vendor_req(struct hci_dev *hdev, u8 request, 2467 void *data, u16 size) 2468 { 2469 struct btusb_data *btdata = hci_get_drvdata(hdev); 2470 struct usb_device *udev = btdata->udev; 2471 int pipe, err; 2472 u8 *buf; 2473 2474 buf = kmalloc(size, GFP_KERNEL); 2475 if (!buf) 2476 return -ENOMEM; 2477 2478 /* Found some of USB hosts have IOT issues with ours so that we should 2479 * not wait until HCI layer is ready. 2480 */ 2481 pipe = usb_rcvctrlpipe(udev, 0); 2482 err = usb_control_msg(udev, pipe, request, USB_TYPE_VENDOR | USB_DIR_IN, 2483 0, 0, buf, size, USB_CTRL_SET_TIMEOUT); 2484 if (err < 0) { 2485 BT_ERR("%s: Failed to access otp area (%d)", hdev->name, err); 2486 goto done; 2487 } 2488 2489 memcpy(data, buf, size); 2490 2491 done: 2492 kfree(buf); 2493 2494 return err; 2495 } 2496 2497 static int btusb_setup_qca_download_fw(struct hci_dev *hdev, 2498 const struct firmware *firmware, 2499 size_t hdr_size) 2500 { 2501 struct btusb_data *btdata = hci_get_drvdata(hdev); 2502 struct usb_device *udev = btdata->udev; 2503 size_t count, size, sent = 0; 2504 int pipe, len, err; 2505 u8 *buf; 2506 2507 buf = kmalloc(QCA_DFU_PACKET_LEN, GFP_KERNEL); 2508 if (!buf) 2509 return -ENOMEM; 2510 2511 count = firmware->size; 2512 2513 size = min_t(size_t, count, hdr_size); 2514 memcpy(buf, firmware->data, size); 2515 2516 /* USB patches should go down to controller through USB path 2517 * because binary format fits to go down through USB channel. 2518 * USB control path is for patching headers and USB bulk is for 2519 * patch body. 2520 */ 2521 pipe = usb_sndctrlpipe(udev, 0); 2522 err = usb_control_msg(udev, pipe, QCA_DFU_DOWNLOAD, USB_TYPE_VENDOR, 2523 0, 0, buf, size, USB_CTRL_SET_TIMEOUT); 2524 if (err < 0) { 2525 BT_ERR("%s: Failed to send headers (%d)", hdev->name, err); 2526 goto done; 2527 } 2528 2529 sent += size; 2530 count -= size; 2531 2532 while (count) { 2533 size = min_t(size_t, count, QCA_DFU_PACKET_LEN); 2534 2535 memcpy(buf, firmware->data + sent, size); 2536 2537 pipe = usb_sndbulkpipe(udev, 0x02); 2538 err = usb_bulk_msg(udev, pipe, buf, size, &len, 2539 QCA_DFU_TIMEOUT); 2540 if (err < 0) { 2541 BT_ERR("%s: Failed to send body at %zd of %zd (%d)", 2542 hdev->name, sent, firmware->size, err); 2543 break; 2544 } 2545 2546 if (size != len) { 2547 BT_ERR("%s: Failed to get bulk buffer", hdev->name); 2548 err = -EILSEQ; 2549 break; 2550 } 2551 2552 sent += size; 2553 count -= size; 2554 } 2555 2556 done: 2557 kfree(buf); 2558 return err; 2559 } 2560 2561 static int btusb_setup_qca_load_rampatch(struct hci_dev *hdev, 2562 struct qca_version *ver, 2563 const struct qca_device_info *info) 2564 { 2565 struct qca_rampatch_version *rver; 2566 const struct firmware *fw; 2567 u32 ver_rom, ver_patch; 2568 u16 rver_rom, rver_patch; 2569 char fwname[64]; 2570 int err; 2571 2572 ver_rom = le32_to_cpu(ver->rom_version); 2573 ver_patch = le32_to_cpu(ver->patch_version); 2574 2575 snprintf(fwname, sizeof(fwname), "qca/rampatch_usb_%08x.bin", ver_rom); 2576 2577 err = request_firmware(&fw, fwname, &hdev->dev); 2578 if (err) { 2579 BT_ERR("%s: failed to request rampatch file: %s (%d)", 2580 hdev->name, fwname, err); 2581 return err; 2582 } 2583 2584 BT_INFO("%s: using rampatch file: %s", hdev->name, fwname); 2585 2586 rver = (struct qca_rampatch_version *)(fw->data + info->ver_offset); 2587 rver_rom = le16_to_cpu(rver->rom_version); 2588 rver_patch = le16_to_cpu(rver->patch_version); 2589 2590 BT_INFO("%s: QCA: patch rome 0x%x build 0x%x, firmware rome 0x%x " 2591 "build 0x%x", hdev->name, rver_rom, rver_patch, ver_rom, 2592 ver_patch); 2593 2594 if (rver_rom != ver_rom || rver_patch <= ver_patch) { 2595 BT_ERR("%s: rampatch file version did not match with firmware", 2596 hdev->name); 2597 err = -EINVAL; 2598 goto done; 2599 } 2600 2601 err = btusb_setup_qca_download_fw(hdev, fw, info->rampatch_hdr); 2602 2603 done: 2604 release_firmware(fw); 2605 2606 return err; 2607 } 2608 2609 static int btusb_setup_qca_load_nvm(struct hci_dev *hdev, 2610 struct qca_version *ver, 2611 const struct qca_device_info *info) 2612 { 2613 const struct firmware *fw; 2614 char fwname[64]; 2615 int err; 2616 2617 snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x.bin", 2618 le32_to_cpu(ver->rom_version)); 2619 2620 err = request_firmware(&fw, fwname, &hdev->dev); 2621 if (err) { 2622 BT_ERR("%s: failed to request NVM file: %s (%d)", 2623 hdev->name, fwname, err); 2624 return err; 2625 } 2626 2627 BT_INFO("%s: using NVM file: %s", hdev->name, fwname); 2628 2629 err = btusb_setup_qca_download_fw(hdev, fw, info->nvm_hdr); 2630 2631 release_firmware(fw); 2632 2633 return err; 2634 } 2635 2636 static int btusb_setup_qca(struct hci_dev *hdev) 2637 { 2638 const struct qca_device_info *info = NULL; 2639 struct qca_version ver; 2640 u32 ver_rom; 2641 u8 status; 2642 int i, err; 2643 2644 err = btusb_qca_send_vendor_req(hdev, QCA_GET_TARGET_VERSION, &ver, 2645 sizeof(ver)); 2646 if (err < 0) 2647 return err; 2648 2649 ver_rom = le32_to_cpu(ver.rom_version); 2650 for (i = 0; i < ARRAY_SIZE(qca_devices_table); i++) { 2651 if (ver_rom == qca_devices_table[i].rom_version) 2652 info = &qca_devices_table[i]; 2653 } 2654 if (!info) { 2655 BT_ERR("%s: don't support firmware rome 0x%x", hdev->name, 2656 ver_rom); 2657 return -ENODEV; 2658 } 2659 2660 err = btusb_qca_send_vendor_req(hdev, QCA_CHECK_STATUS, &status, 2661 sizeof(status)); 2662 if (err < 0) 2663 return err; 2664 2665 if (!(status & QCA_PATCH_UPDATED)) { 2666 err = btusb_setup_qca_load_rampatch(hdev, &ver, info); 2667 if (err < 0) 2668 return err; 2669 } 2670 2671 if (!(status & QCA_SYSCFG_UPDATED)) { 2672 err = btusb_setup_qca_load_nvm(hdev, &ver, info); 2673 if (err < 0) 2674 return err; 2675 } 2676 2677 return 0; 2678 } 2679 2680 #ifdef CONFIG_BT_HCIBTUSB_BCM 2681 static inline int __set_diag_interface(struct hci_dev *hdev) 2682 { 2683 struct btusb_data *data = hci_get_drvdata(hdev); 2684 struct usb_interface *intf = data->diag; 2685 int i; 2686 2687 if (!data->diag) 2688 return -ENODEV; 2689 2690 data->diag_tx_ep = NULL; 2691 data->diag_rx_ep = NULL; 2692 2693 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) { 2694 struct usb_endpoint_descriptor *ep_desc; 2695 2696 ep_desc = &intf->cur_altsetting->endpoint[i].desc; 2697 2698 if (!data->diag_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) { 2699 data->diag_tx_ep = ep_desc; 2700 continue; 2701 } 2702 2703 if (!data->diag_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) { 2704 data->diag_rx_ep = ep_desc; 2705 continue; 2706 } 2707 } 2708 2709 if (!data->diag_tx_ep || !data->diag_rx_ep) { 2710 BT_ERR("%s invalid diagnostic descriptors", hdev->name); 2711 return -ENODEV; 2712 } 2713 2714 return 0; 2715 } 2716 2717 static struct urb *alloc_diag_urb(struct hci_dev *hdev, bool enable) 2718 { 2719 struct btusb_data *data = hci_get_drvdata(hdev); 2720 struct sk_buff *skb; 2721 struct urb *urb; 2722 unsigned int pipe; 2723 2724 if (!data->diag_tx_ep) 2725 return ERR_PTR(-ENODEV); 2726 2727 urb = usb_alloc_urb(0, GFP_KERNEL); 2728 if (!urb) 2729 return ERR_PTR(-ENOMEM); 2730 2731 skb = bt_skb_alloc(2, GFP_KERNEL); 2732 if (!skb) { 2733 usb_free_urb(urb); 2734 return ERR_PTR(-ENOMEM); 2735 } 2736 2737 *skb_put(skb, 1) = 0xf0; 2738 *skb_put(skb, 1) = enable; 2739 2740 pipe = usb_sndbulkpipe(data->udev, data->diag_tx_ep->bEndpointAddress); 2741 2742 usb_fill_bulk_urb(urb, data->udev, pipe, 2743 skb->data, skb->len, btusb_tx_complete, skb); 2744 2745 skb->dev = (void *)hdev; 2746 2747 return urb; 2748 } 2749 2750 static int btusb_bcm_set_diag(struct hci_dev *hdev, bool enable) 2751 { 2752 struct btusb_data *data = hci_get_drvdata(hdev); 2753 struct urb *urb; 2754 2755 if (!data->diag) 2756 return -ENODEV; 2757 2758 if (!test_bit(HCI_RUNNING, &hdev->flags)) 2759 return -ENETDOWN; 2760 2761 urb = alloc_diag_urb(hdev, enable); 2762 if (IS_ERR(urb)) 2763 return PTR_ERR(urb); 2764 2765 return submit_or_queue_tx_urb(hdev, urb); 2766 } 2767 #endif 2768 2769 static int btusb_probe(struct usb_interface *intf, 2770 const struct usb_device_id *id) 2771 { 2772 struct usb_endpoint_descriptor *ep_desc; 2773 struct btusb_data *data; 2774 struct hci_dev *hdev; 2775 unsigned ifnum_base; 2776 int i, err; 2777 2778 BT_DBG("intf %p id %p", intf, id); 2779 2780 /* interface numbers are hardcoded in the spec */ 2781 if (intf->cur_altsetting->desc.bInterfaceNumber != 0) { 2782 if (!(id->driver_info & BTUSB_IFNUM_2)) 2783 return -ENODEV; 2784 if (intf->cur_altsetting->desc.bInterfaceNumber != 2) 2785 return -ENODEV; 2786 } 2787 2788 ifnum_base = intf->cur_altsetting->desc.bInterfaceNumber; 2789 2790 if (!id->driver_info) { 2791 const struct usb_device_id *match; 2792 2793 match = usb_match_id(intf, blacklist_table); 2794 if (match) 2795 id = match; 2796 } 2797 2798 if (id->driver_info == BTUSB_IGNORE) 2799 return -ENODEV; 2800 2801 if (id->driver_info & BTUSB_ATH3012) { 2802 struct usb_device *udev = interface_to_usbdev(intf); 2803 2804 /* Old firmware would otherwise let ath3k driver load 2805 * patch and sysconfig files */ 2806 if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001) 2807 return -ENODEV; 2808 } 2809 2810 data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL); 2811 if (!data) 2812 return -ENOMEM; 2813 2814 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) { 2815 ep_desc = &intf->cur_altsetting->endpoint[i].desc; 2816 2817 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) { 2818 data->intr_ep = ep_desc; 2819 continue; 2820 } 2821 2822 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) { 2823 data->bulk_tx_ep = ep_desc; 2824 continue; 2825 } 2826 2827 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) { 2828 data->bulk_rx_ep = ep_desc; 2829 continue; 2830 } 2831 } 2832 2833 if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep) 2834 return -ENODEV; 2835 2836 if (id->driver_info & BTUSB_AMP) { 2837 data->cmdreq_type = USB_TYPE_CLASS | 0x01; 2838 data->cmdreq = 0x2b; 2839 } else { 2840 data->cmdreq_type = USB_TYPE_CLASS; 2841 data->cmdreq = 0x00; 2842 } 2843 2844 data->udev = interface_to_usbdev(intf); 2845 data->intf = intf; 2846 2847 INIT_WORK(&data->work, btusb_work); 2848 INIT_WORK(&data->waker, btusb_waker); 2849 init_usb_anchor(&data->deferred); 2850 init_usb_anchor(&data->tx_anchor); 2851 spin_lock_init(&data->txlock); 2852 2853 init_usb_anchor(&data->intr_anchor); 2854 init_usb_anchor(&data->bulk_anchor); 2855 init_usb_anchor(&data->isoc_anchor); 2856 init_usb_anchor(&data->diag_anchor); 2857 spin_lock_init(&data->rxlock); 2858 2859 if (id->driver_info & BTUSB_INTEL_NEW) { 2860 data->recv_event = btusb_recv_event_intel; 2861 data->recv_bulk = btusb_recv_bulk_intel; 2862 set_bit(BTUSB_BOOTLOADER, &data->flags); 2863 } else { 2864 data->recv_event = hci_recv_frame; 2865 data->recv_bulk = btusb_recv_bulk; 2866 } 2867 2868 hdev = hci_alloc_dev(); 2869 if (!hdev) 2870 return -ENOMEM; 2871 2872 hdev->bus = HCI_USB; 2873 hci_set_drvdata(hdev, data); 2874 2875 if (id->driver_info & BTUSB_AMP) 2876 hdev->dev_type = HCI_AMP; 2877 else 2878 hdev->dev_type = HCI_BREDR; 2879 2880 data->hdev = hdev; 2881 2882 SET_HCIDEV_DEV(hdev, &intf->dev); 2883 2884 hdev->open = btusb_open; 2885 hdev->close = btusb_close; 2886 hdev->flush = btusb_flush; 2887 hdev->send = btusb_send_frame; 2888 hdev->notify = btusb_notify; 2889 2890 if (id->driver_info & BTUSB_BCM2045) 2891 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks); 2892 2893 if (id->driver_info & BTUSB_BCM92035) 2894 hdev->setup = btusb_setup_bcm92035; 2895 2896 #ifdef CONFIG_BT_HCIBTUSB_BCM 2897 if (id->driver_info & BTUSB_BCM_PATCHRAM) { 2898 hdev->manufacturer = 15; 2899 hdev->setup = btbcm_setup_patchram; 2900 hdev->set_diag = btusb_bcm_set_diag; 2901 hdev->set_bdaddr = btbcm_set_bdaddr; 2902 2903 /* Broadcom LM_DIAG Interface numbers are hardcoded */ 2904 data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2); 2905 } 2906 2907 if (id->driver_info & BTUSB_BCM_APPLE) { 2908 hdev->manufacturer = 15; 2909 hdev->setup = btbcm_setup_apple; 2910 hdev->set_diag = btusb_bcm_set_diag; 2911 2912 /* Broadcom LM_DIAG Interface numbers are hardcoded */ 2913 data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2); 2914 } 2915 #endif 2916 2917 if (id->driver_info & BTUSB_INTEL) { 2918 hdev->manufacturer = 2; 2919 hdev->setup = btusb_setup_intel; 2920 hdev->shutdown = btusb_shutdown_intel; 2921 hdev->set_diag = btintel_set_diag_mfg; 2922 hdev->set_bdaddr = btintel_set_bdaddr; 2923 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks); 2924 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks); 2925 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks); 2926 } 2927 2928 if (id->driver_info & BTUSB_INTEL_NEW) { 2929 hdev->manufacturer = 2; 2930 hdev->send = btusb_send_frame_intel; 2931 hdev->setup = btusb_setup_intel_new; 2932 hdev->hw_error = btintel_hw_error; 2933 hdev->set_diag = btintel_set_diag; 2934 hdev->set_bdaddr = btintel_set_bdaddr; 2935 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks); 2936 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks); 2937 } 2938 2939 if (id->driver_info & BTUSB_MARVELL) 2940 hdev->set_bdaddr = btusb_set_bdaddr_marvell; 2941 2942 if (id->driver_info & BTUSB_SWAVE) { 2943 set_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks); 2944 set_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks); 2945 } 2946 2947 if (id->driver_info & BTUSB_INTEL_BOOT) { 2948 hdev->manufacturer = 2; 2949 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks); 2950 } 2951 2952 if (id->driver_info & BTUSB_ATH3012) { 2953 hdev->set_bdaddr = btusb_set_bdaddr_ath3012; 2954 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks); 2955 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks); 2956 } 2957 2958 if (id->driver_info & BTUSB_QCA_ROME) { 2959 data->setup_on_usb = btusb_setup_qca; 2960 hdev->set_bdaddr = btusb_set_bdaddr_ath3012; 2961 } 2962 2963 #ifdef CONFIG_BT_HCIBTUSB_RTL 2964 if (id->driver_info & BTUSB_REALTEK) { 2965 hdev->setup = btrtl_setup_realtek; 2966 2967 /* Realtek devices lose their updated firmware over suspend, 2968 * but the USB hub doesn't notice any status change. 2969 * Explicitly request a device reset on resume. 2970 */ 2971 set_bit(BTUSB_RESET_RESUME, &data->flags); 2972 } 2973 #endif 2974 2975 if (id->driver_info & BTUSB_AMP) { 2976 /* AMP controllers do not support SCO packets */ 2977 data->isoc = NULL; 2978 } else { 2979 /* Interface orders are hardcoded in the specification */ 2980 data->isoc = usb_ifnum_to_if(data->udev, ifnum_base + 1); 2981 } 2982 2983 if (!reset) 2984 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks); 2985 2986 if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) { 2987 if (!disable_scofix) 2988 set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks); 2989 } 2990 2991 if (id->driver_info & BTUSB_BROKEN_ISOC) 2992 data->isoc = NULL; 2993 2994 if (id->driver_info & BTUSB_DIGIANSWER) { 2995 data->cmdreq_type = USB_TYPE_VENDOR; 2996 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks); 2997 } 2998 2999 if (id->driver_info & BTUSB_CSR) { 3000 struct usb_device *udev = data->udev; 3001 u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice); 3002 3003 /* Old firmware would otherwise execute USB reset */ 3004 if (bcdDevice < 0x117) 3005 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks); 3006 3007 /* Fake CSR devices with broken commands */ 3008 if (bcdDevice <= 0x100 || bcdDevice == 0x134) 3009 hdev->setup = btusb_setup_csr; 3010 3011 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks); 3012 } 3013 3014 if (id->driver_info & BTUSB_SNIFFER) { 3015 struct usb_device *udev = data->udev; 3016 3017 /* New sniffer firmware has crippled HCI interface */ 3018 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997) 3019 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks); 3020 } 3021 3022 if (id->driver_info & BTUSB_INTEL_BOOT) { 3023 /* A bug in the bootloader causes that interrupt interface is 3024 * only enabled after receiving SetInterface(0, AltSetting=0). 3025 */ 3026 err = usb_set_interface(data->udev, 0, 0); 3027 if (err < 0) { 3028 BT_ERR("failed to set interface 0, alt 0 %d", err); 3029 hci_free_dev(hdev); 3030 return err; 3031 } 3032 } 3033 3034 if (data->isoc) { 3035 err = usb_driver_claim_interface(&btusb_driver, 3036 data->isoc, data); 3037 if (err < 0) { 3038 hci_free_dev(hdev); 3039 return err; 3040 } 3041 } 3042 3043 #ifdef CONFIG_BT_HCIBTUSB_BCM 3044 if (data->diag) { 3045 if (!usb_driver_claim_interface(&btusb_driver, 3046 data->diag, data)) 3047 __set_diag_interface(hdev); 3048 else 3049 data->diag = NULL; 3050 } 3051 #endif 3052 3053 err = hci_register_dev(hdev); 3054 if (err < 0) { 3055 hci_free_dev(hdev); 3056 return err; 3057 } 3058 3059 usb_set_intfdata(intf, data); 3060 3061 return 0; 3062 } 3063 3064 static void btusb_disconnect(struct usb_interface *intf) 3065 { 3066 struct btusb_data *data = usb_get_intfdata(intf); 3067 struct hci_dev *hdev; 3068 3069 BT_DBG("intf %p", intf); 3070 3071 if (!data) 3072 return; 3073 3074 hdev = data->hdev; 3075 usb_set_intfdata(data->intf, NULL); 3076 3077 if (data->isoc) 3078 usb_set_intfdata(data->isoc, NULL); 3079 3080 if (data->diag) 3081 usb_set_intfdata(data->diag, NULL); 3082 3083 hci_unregister_dev(hdev); 3084 3085 if (intf == data->intf) { 3086 if (data->isoc) 3087 usb_driver_release_interface(&btusb_driver, data->isoc); 3088 if (data->diag) 3089 usb_driver_release_interface(&btusb_driver, data->diag); 3090 } else if (intf == data->isoc) { 3091 if (data->diag) 3092 usb_driver_release_interface(&btusb_driver, data->diag); 3093 usb_driver_release_interface(&btusb_driver, data->intf); 3094 } else if (intf == data->diag) { 3095 usb_driver_release_interface(&btusb_driver, data->intf); 3096 if (data->isoc) 3097 usb_driver_release_interface(&btusb_driver, data->isoc); 3098 } 3099 3100 hci_free_dev(hdev); 3101 } 3102 3103 #ifdef CONFIG_PM 3104 static int btusb_suspend(struct usb_interface *intf, pm_message_t message) 3105 { 3106 struct btusb_data *data = usb_get_intfdata(intf); 3107 3108 BT_DBG("intf %p", intf); 3109 3110 if (data->suspend_count++) 3111 return 0; 3112 3113 spin_lock_irq(&data->txlock); 3114 if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) { 3115 set_bit(BTUSB_SUSPENDING, &data->flags); 3116 spin_unlock_irq(&data->txlock); 3117 } else { 3118 spin_unlock_irq(&data->txlock); 3119 data->suspend_count--; 3120 return -EBUSY; 3121 } 3122 3123 cancel_work_sync(&data->work); 3124 3125 btusb_stop_traffic(data); 3126 usb_kill_anchored_urbs(&data->tx_anchor); 3127 3128 /* Optionally request a device reset on resume, but only when 3129 * wakeups are disabled. If wakeups are enabled we assume the 3130 * device will stay powered up throughout suspend. 3131 */ 3132 if (test_bit(BTUSB_RESET_RESUME, &data->flags) && 3133 !device_may_wakeup(&data->udev->dev)) 3134 data->udev->reset_resume = 1; 3135 3136 return 0; 3137 } 3138 3139 static void play_deferred(struct btusb_data *data) 3140 { 3141 struct urb *urb; 3142 int err; 3143 3144 while ((urb = usb_get_from_anchor(&data->deferred))) { 3145 err = usb_submit_urb(urb, GFP_ATOMIC); 3146 if (err < 0) 3147 break; 3148 3149 data->tx_in_flight++; 3150 } 3151 usb_scuttle_anchored_urbs(&data->deferred); 3152 } 3153 3154 static int btusb_resume(struct usb_interface *intf) 3155 { 3156 struct btusb_data *data = usb_get_intfdata(intf); 3157 struct hci_dev *hdev = data->hdev; 3158 int err = 0; 3159 3160 BT_DBG("intf %p", intf); 3161 3162 if (--data->suspend_count) 3163 return 0; 3164 3165 if (!test_bit(HCI_RUNNING, &hdev->flags)) 3166 goto done; 3167 3168 if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) { 3169 err = btusb_submit_intr_urb(hdev, GFP_NOIO); 3170 if (err < 0) { 3171 clear_bit(BTUSB_INTR_RUNNING, &data->flags); 3172 goto failed; 3173 } 3174 } 3175 3176 if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) { 3177 err = btusb_submit_bulk_urb(hdev, GFP_NOIO); 3178 if (err < 0) { 3179 clear_bit(BTUSB_BULK_RUNNING, &data->flags); 3180 goto failed; 3181 } 3182 3183 btusb_submit_bulk_urb(hdev, GFP_NOIO); 3184 } 3185 3186 if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) { 3187 if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0) 3188 clear_bit(BTUSB_ISOC_RUNNING, &data->flags); 3189 else 3190 btusb_submit_isoc_urb(hdev, GFP_NOIO); 3191 } 3192 3193 spin_lock_irq(&data->txlock); 3194 play_deferred(data); 3195 clear_bit(BTUSB_SUSPENDING, &data->flags); 3196 spin_unlock_irq(&data->txlock); 3197 schedule_work(&data->work); 3198 3199 return 0; 3200 3201 failed: 3202 usb_scuttle_anchored_urbs(&data->deferred); 3203 done: 3204 spin_lock_irq(&data->txlock); 3205 clear_bit(BTUSB_SUSPENDING, &data->flags); 3206 spin_unlock_irq(&data->txlock); 3207 3208 return err; 3209 } 3210 #endif 3211 3212 static struct usb_driver btusb_driver = { 3213 .name = "btusb", 3214 .probe = btusb_probe, 3215 .disconnect = btusb_disconnect, 3216 #ifdef CONFIG_PM 3217 .suspend = btusb_suspend, 3218 .resume = btusb_resume, 3219 #endif 3220 .id_table = btusb_table, 3221 .supports_autosuspend = 1, 3222 .disable_hub_initiated_lpm = 1, 3223 }; 3224 3225 module_usb_driver(btusb_driver); 3226 3227 module_param(disable_scofix, bool, 0644); 3228 MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size"); 3229 3230 module_param(force_scofix, bool, 0644); 3231 MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size"); 3232 3233 module_param(reset, bool, 0644); 3234 MODULE_PARM_DESC(reset, "Send HCI reset command on initialization"); 3235 3236 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>"); 3237 MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION); 3238 MODULE_VERSION(VERSION); 3239 MODULE_LICENSE("GPL"); 3240