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