Linux Audio

Check our new training course

Loading...
v5.9
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3 *
   4 *  Generic Bluetooth USB driver
   5 *
   6 *  Copyright (C) 2005-2008  Marcel Holtmann <marcel@holtmann.org>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
   7 */
   8
   9#include <linux/dmi.h>
  10#include <linux/module.h>
  11#include <linux/usb.h>
  12#include <linux/usb/quirks.h>
  13#include <linux/firmware.h>
  14#include <linux/iopoll.h>
  15#include <linux/of_device.h>
  16#include <linux/of_irq.h>
  17#include <linux/suspend.h>
  18#include <linux/gpio/consumer.h>
  19#include <asm/unaligned.h>
  20
  21#include <net/bluetooth/bluetooth.h>
  22#include <net/bluetooth/hci_core.h>
  23
  24#include "btintel.h"
  25#include "btbcm.h"
  26#include "btrtl.h"
  27
  28#define VERSION "0.8"
  29
  30static bool disable_scofix;
  31static bool force_scofix;
  32static bool enable_autosuspend = IS_ENABLED(CONFIG_BT_HCIBTUSB_AUTOSUSPEND);
  33
  34static bool reset = true;
  35
  36static struct usb_driver btusb_driver;
  37
  38#define BTUSB_IGNORE		0x01
  39#define BTUSB_DIGIANSWER	0x02
  40#define BTUSB_CSR		0x04
  41#define BTUSB_SNIFFER		0x08
  42#define BTUSB_BCM92035		0x10
  43#define BTUSB_BROKEN_ISOC	0x20
  44#define BTUSB_WRONG_SCO_MTU	0x40
  45#define BTUSB_ATH3012		0x80
  46#define BTUSB_INTEL		0x100
  47#define BTUSB_INTEL_BOOT	0x200
  48#define BTUSB_BCM_PATCHRAM	0x400
  49#define BTUSB_MARVELL		0x800
  50#define BTUSB_SWAVE		0x1000
  51#define BTUSB_INTEL_NEW		0x2000
  52#define BTUSB_AMP		0x4000
  53#define BTUSB_QCA_ROME		0x8000
  54#define BTUSB_BCM_APPLE		0x10000
  55#define BTUSB_REALTEK		0x20000
  56#define BTUSB_BCM2045		0x40000
  57#define BTUSB_IFNUM_2		0x80000
  58#define BTUSB_CW6622		0x100000
  59#define BTUSB_MEDIATEK		0x200000
  60#define BTUSB_WIDEBAND_SPEECH	0x400000
  61#define BTUSB_VALID_LE_STATES   0x800000
  62
  63static const struct usb_device_id btusb_table[] = {
  64	/* Generic Bluetooth USB device */
  65	{ USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
  66
  67	/* Generic Bluetooth AMP device */
  68	{ USB_DEVICE_INFO(0xe0, 0x01, 0x04), .driver_info = BTUSB_AMP },
  69
  70	/* Generic Bluetooth USB interface */
  71	{ USB_INTERFACE_INFO(0xe0, 0x01, 0x01) },
  72
  73	/* Apple-specific (Broadcom) devices */
  74	{ USB_VENDOR_AND_INTERFACE_INFO(0x05ac, 0xff, 0x01, 0x01),
  75	  .driver_info = BTUSB_BCM_APPLE | BTUSB_IFNUM_2 },
  76
  77	/* MediaTek MT76x0E */
  78	{ USB_DEVICE(0x0e8d, 0x763f) },
  79
  80	/* Broadcom SoftSailing reporting vendor specific */
  81	{ USB_DEVICE(0x0a5c, 0x21e1) },
  82
  83	/* Apple MacBookPro 7,1 */
  84	{ USB_DEVICE(0x05ac, 0x8213) },
  85
  86	/* Apple iMac11,1 */
  87	{ USB_DEVICE(0x05ac, 0x8215) },
  88
  89	/* Apple MacBookPro6,2 */
  90	{ USB_DEVICE(0x05ac, 0x8218) },
  91
  92	/* Apple MacBookAir3,1, MacBookAir3,2 */
  93	{ USB_DEVICE(0x05ac, 0x821b) },
  94
  95	/* Apple MacBookAir4,1 */
  96	{ USB_DEVICE(0x05ac, 0x821f) },
  97
  98	/* Apple MacBookPro8,2 */
  99	{ USB_DEVICE(0x05ac, 0x821a) },
 100
 101	/* Apple MacMini5,1 */
 102	{ USB_DEVICE(0x05ac, 0x8281) },
 103
 104	/* AVM BlueFRITZ! USB v2.0 */
 105	{ USB_DEVICE(0x057c, 0x3800), .driver_info = BTUSB_SWAVE },
 106
 107	/* Bluetooth Ultraport Module from IBM */
 108	{ USB_DEVICE(0x04bf, 0x030a) },
 109
 110	/* ALPS Modules with non-standard id */
 111	{ USB_DEVICE(0x044e, 0x3001) },
 112	{ USB_DEVICE(0x044e, 0x3002) },
 113
 114	/* Ericsson with non-standard id */
 115	{ USB_DEVICE(0x0bdb, 0x1002) },
 116
 117	/* Canyon CN-BTU1 with HID interfaces */
 118	{ USB_DEVICE(0x0c10, 0x0000) },
 119
 120	/* Broadcom BCM20702A0 */
 121	{ USB_DEVICE(0x413c, 0x8197) },
 122
 123	/* Broadcom BCM20702B0 (Dynex/Insignia) */
 124	{ USB_DEVICE(0x19ff, 0x0239), .driver_info = BTUSB_BCM_PATCHRAM },
 125
 126	/* Broadcom BCM43142A0 (Foxconn/Lenovo) */
 127	{ USB_VENDOR_AND_INTERFACE_INFO(0x105b, 0xff, 0x01, 0x01),
 128	  .driver_info = BTUSB_BCM_PATCHRAM },
 129
 130	/* Broadcom BCM920703 (HTC Vive) */
 131	{ USB_VENDOR_AND_INTERFACE_INFO(0x0bb4, 0xff, 0x01, 0x01),
 132	  .driver_info = BTUSB_BCM_PATCHRAM },
 133
 134	/* Foxconn - Hon Hai */
 135	{ USB_VENDOR_AND_INTERFACE_INFO(0x0489, 0xff, 0x01, 0x01),
 136	  .driver_info = BTUSB_BCM_PATCHRAM },
 137
 138	/* Lite-On Technology - Broadcom based */
 139	{ USB_VENDOR_AND_INTERFACE_INFO(0x04ca, 0xff, 0x01, 0x01),
 140	  .driver_info = BTUSB_BCM_PATCHRAM },
 141
 142	/* Broadcom devices with vendor specific id */
 143	{ USB_VENDOR_AND_INTERFACE_INFO(0x0a5c, 0xff, 0x01, 0x01),
 144	  .driver_info = BTUSB_BCM_PATCHRAM },
 145
 146	/* ASUSTek Computer - Broadcom based */
 147	{ USB_VENDOR_AND_INTERFACE_INFO(0x0b05, 0xff, 0x01, 0x01),
 148	  .driver_info = BTUSB_BCM_PATCHRAM },
 149
 150	/* Belkin F8065bf - Broadcom based */
 151	{ USB_VENDOR_AND_INTERFACE_INFO(0x050d, 0xff, 0x01, 0x01),
 152	  .driver_info = BTUSB_BCM_PATCHRAM },
 153
 154	/* IMC Networks - Broadcom based */
 155	{ USB_VENDOR_AND_INTERFACE_INFO(0x13d3, 0xff, 0x01, 0x01),
 156	  .driver_info = BTUSB_BCM_PATCHRAM },
 157
 158	/* Dell Computer - Broadcom based  */
 159	{ USB_VENDOR_AND_INTERFACE_INFO(0x413c, 0xff, 0x01, 0x01),
 160	  .driver_info = BTUSB_BCM_PATCHRAM },
 161
 162	/* Toshiba Corp - Broadcom based */
 163	{ USB_VENDOR_AND_INTERFACE_INFO(0x0930, 0xff, 0x01, 0x01),
 164	  .driver_info = BTUSB_BCM_PATCHRAM },
 165
 166	/* Intel Bluetooth USB Bootloader (RAM module) */
 167	{ USB_DEVICE(0x8087, 0x0a5a),
 168	  .driver_info = BTUSB_INTEL_BOOT | BTUSB_BROKEN_ISOC },
 169
 170	{ }	/* Terminating entry */
 171};
 172
 173MODULE_DEVICE_TABLE(usb, btusb_table);
 174
 175static const struct usb_device_id blacklist_table[] = {
 176	/* CSR BlueCore devices */
 177	{ USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
 178
 179	/* Broadcom BCM2033 without firmware */
 180	{ USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
 181
 182	/* Broadcom BCM2045 devices */
 183	{ USB_DEVICE(0x0a5c, 0x2045), .driver_info = BTUSB_BCM2045 },
 184
 185	/* Atheros 3011 with sflash firmware */
 186	{ USB_DEVICE(0x0489, 0xe027), .driver_info = BTUSB_IGNORE },
 187	{ USB_DEVICE(0x0489, 0xe03d), .driver_info = BTUSB_IGNORE },
 188	{ USB_DEVICE(0x04f2, 0xaff1), .driver_info = BTUSB_IGNORE },
 189	{ USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
 190	{ USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
 191	{ USB_DEVICE(0x0cf3, 0xe019), .driver_info = BTUSB_IGNORE },
 192	{ USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
 193
 194	/* Atheros AR9285 Malbec with sflash firmware */
 195	{ USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
 196
 197	/* Atheros 3012 with sflash firmware */
 198	{ USB_DEVICE(0x0489, 0xe04d), .driver_info = BTUSB_ATH3012 },
 199	{ USB_DEVICE(0x0489, 0xe04e), .driver_info = BTUSB_ATH3012 },
 200	{ USB_DEVICE(0x0489, 0xe056), .driver_info = BTUSB_ATH3012 },
 201	{ USB_DEVICE(0x0489, 0xe057), .driver_info = BTUSB_ATH3012 },
 202	{ USB_DEVICE(0x0489, 0xe05f), .driver_info = BTUSB_ATH3012 },
 203	{ USB_DEVICE(0x0489, 0xe076), .driver_info = BTUSB_ATH3012 },
 204	{ USB_DEVICE(0x0489, 0xe078), .driver_info = BTUSB_ATH3012 },
 205	{ USB_DEVICE(0x0489, 0xe095), .driver_info = BTUSB_ATH3012 },
 206	{ USB_DEVICE(0x04c5, 0x1330), .driver_info = BTUSB_ATH3012 },
 207	{ USB_DEVICE(0x04ca, 0x3004), .driver_info = BTUSB_ATH3012 },
 208	{ USB_DEVICE(0x04ca, 0x3005), .driver_info = BTUSB_ATH3012 },
 209	{ USB_DEVICE(0x04ca, 0x3006), .driver_info = BTUSB_ATH3012 },
 210	{ USB_DEVICE(0x04ca, 0x3007), .driver_info = BTUSB_ATH3012 },
 211	{ USB_DEVICE(0x04ca, 0x3008), .driver_info = BTUSB_ATH3012 },
 212	{ USB_DEVICE(0x04ca, 0x300b), .driver_info = BTUSB_ATH3012 },
 213	{ USB_DEVICE(0x04ca, 0x300d), .driver_info = BTUSB_ATH3012 },
 214	{ USB_DEVICE(0x04ca, 0x300f), .driver_info = BTUSB_ATH3012 },
 215	{ USB_DEVICE(0x04ca, 0x3010), .driver_info = BTUSB_ATH3012 },
 216	{ USB_DEVICE(0x04ca, 0x3014), .driver_info = BTUSB_ATH3012 },
 217	{ USB_DEVICE(0x04ca, 0x3018), .driver_info = BTUSB_ATH3012 },
 218	{ USB_DEVICE(0x0930, 0x0219), .driver_info = BTUSB_ATH3012 },
 219	{ USB_DEVICE(0x0930, 0x021c), .driver_info = BTUSB_ATH3012 },
 220	{ USB_DEVICE(0x0930, 0x0220), .driver_info = BTUSB_ATH3012 },
 221	{ USB_DEVICE(0x0930, 0x0227), .driver_info = BTUSB_ATH3012 },
 222	{ USB_DEVICE(0x0b05, 0x17d0), .driver_info = BTUSB_ATH3012 },
 223	{ USB_DEVICE(0x0cf3, 0x0036), .driver_info = BTUSB_ATH3012 },
 224	{ USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
 225	{ USB_DEVICE(0x0cf3, 0x3008), .driver_info = BTUSB_ATH3012 },
 226	{ USB_DEVICE(0x0cf3, 0x311d), .driver_info = BTUSB_ATH3012 },
 227	{ USB_DEVICE(0x0cf3, 0x311e), .driver_info = BTUSB_ATH3012 },
 228	{ USB_DEVICE(0x0cf3, 0x311f), .driver_info = BTUSB_ATH3012 },
 229	{ USB_DEVICE(0x0cf3, 0x3121), .driver_info = BTUSB_ATH3012 },
 230	{ USB_DEVICE(0x0cf3, 0x817a), .driver_info = BTUSB_ATH3012 },
 231	{ USB_DEVICE(0x0cf3, 0x817b), .driver_info = BTUSB_ATH3012 },
 232	{ USB_DEVICE(0x0cf3, 0xe003), .driver_info = BTUSB_ATH3012 },
 233	{ USB_DEVICE(0x0cf3, 0xe004), .driver_info = BTUSB_ATH3012 },
 234	{ USB_DEVICE(0x0cf3, 0xe005), .driver_info = BTUSB_ATH3012 },
 235	{ USB_DEVICE(0x0cf3, 0xe006), .driver_info = BTUSB_ATH3012 },
 236	{ USB_DEVICE(0x13d3, 0x3362), .driver_info = BTUSB_ATH3012 },
 237	{ USB_DEVICE(0x13d3, 0x3375), .driver_info = BTUSB_ATH3012 },
 238	{ USB_DEVICE(0x13d3, 0x3393), .driver_info = BTUSB_ATH3012 },
 239	{ USB_DEVICE(0x13d3, 0x3395), .driver_info = BTUSB_ATH3012 },
 240	{ USB_DEVICE(0x13d3, 0x3402), .driver_info = BTUSB_ATH3012 },
 241	{ USB_DEVICE(0x13d3, 0x3408), .driver_info = BTUSB_ATH3012 },
 242	{ USB_DEVICE(0x13d3, 0x3423), .driver_info = BTUSB_ATH3012 },
 243	{ USB_DEVICE(0x13d3, 0x3432), .driver_info = BTUSB_ATH3012 },
 244	{ USB_DEVICE(0x13d3, 0x3472), .driver_info = BTUSB_ATH3012 },
 245	{ USB_DEVICE(0x13d3, 0x3474), .driver_info = BTUSB_ATH3012 },
 246	{ USB_DEVICE(0x13d3, 0x3487), .driver_info = BTUSB_ATH3012 },
 247	{ USB_DEVICE(0x13d3, 0x3490), .driver_info = BTUSB_ATH3012 },
 248
 249	/* Atheros AR5BBU12 with sflash firmware */
 250	{ USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
 251
 252	/* Atheros AR5BBU12 with sflash firmware */
 253	{ USB_DEVICE(0x0489, 0xe036), .driver_info = BTUSB_ATH3012 },
 254	{ USB_DEVICE(0x0489, 0xe03c), .driver_info = BTUSB_ATH3012 },
 255
 256	/* QCA ROME chipset */
 257	{ USB_DEVICE(0x0cf3, 0x535b), .driver_info = BTUSB_QCA_ROME },
 258	{ USB_DEVICE(0x0cf3, 0xe007), .driver_info = BTUSB_QCA_ROME },
 259	{ USB_DEVICE(0x0cf3, 0xe009), .driver_info = BTUSB_QCA_ROME },
 260	{ USB_DEVICE(0x0cf3, 0xe010), .driver_info = BTUSB_QCA_ROME },
 261	{ USB_DEVICE(0x0cf3, 0xe300), .driver_info = BTUSB_QCA_ROME },
 262	{ USB_DEVICE(0x0cf3, 0xe301), .driver_info = BTUSB_QCA_ROME },
 263	{ USB_DEVICE(0x0cf3, 0xe360), .driver_info = BTUSB_QCA_ROME },
 264	{ USB_DEVICE(0x0489, 0xe092), .driver_info = BTUSB_QCA_ROME },
 265	{ USB_DEVICE(0x0489, 0xe09f), .driver_info = BTUSB_QCA_ROME },
 266	{ USB_DEVICE(0x0489, 0xe0a2), .driver_info = BTUSB_QCA_ROME },
 267	{ USB_DEVICE(0x04ca, 0x3011), .driver_info = BTUSB_QCA_ROME },
 268	{ USB_DEVICE(0x04ca, 0x3015), .driver_info = BTUSB_QCA_ROME },
 269	{ USB_DEVICE(0x04ca, 0x3016), .driver_info = BTUSB_QCA_ROME },
 270	{ USB_DEVICE(0x04ca, 0x301a), .driver_info = BTUSB_QCA_ROME },
 271	{ USB_DEVICE(0x04ca, 0x3021), .driver_info = BTUSB_QCA_ROME },
 272	{ USB_DEVICE(0x13d3, 0x3491), .driver_info = BTUSB_QCA_ROME },
 273	{ USB_DEVICE(0x13d3, 0x3496), .driver_info = BTUSB_QCA_ROME },
 274	{ USB_DEVICE(0x13d3, 0x3501), .driver_info = BTUSB_QCA_ROME },
 275
 276	/* Broadcom BCM2035 */
 277	{ USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
 278	{ USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
 279	{ USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
 280
 281	/* Broadcom BCM2045 */
 282	{ USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
 283	{ USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
 284
 285	/* IBM/Lenovo ThinkPad with Broadcom chip */
 286	{ USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
 287	{ USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
 288
 289	/* HP laptop with Broadcom chip */
 290	{ USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
 291
 292	/* Dell laptop with Broadcom chip */
 293	{ USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
 294
 295	/* Dell Wireless 370 and 410 devices */
 296	{ USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
 297	{ USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
 298
 299	/* Belkin F8T012 and F8T013 devices */
 300	{ USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
 301	{ USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
 302
 303	/* Asus WL-BTD202 device */
 304	{ USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
 305
 306	/* Kensington Bluetooth USB adapter */
 307	{ USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
 308
 309	/* RTX Telecom based adapters with buggy SCO support */
 310	{ USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
 311	{ USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
 312
 313	/* CONWISE Technology based adapters with buggy SCO support */
 314	{ USB_DEVICE(0x0e5e, 0x6622),
 315	  .driver_info = BTUSB_BROKEN_ISOC | BTUSB_CW6622},
 316
 317	/* Roper Class 1 Bluetooth Dongle (Silicon Wave based) */
 318	{ USB_DEVICE(0x1310, 0x0001), .driver_info = BTUSB_SWAVE },
 319
 320	/* Digianswer devices */
 321	{ USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
 322	{ USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
 323
 324	/* CSR BlueCore Bluetooth Sniffer */
 325	{ USB_DEVICE(0x0a12, 0x0002),
 326	  .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
 327
 328	/* Frontline ComProbe Bluetooth Sniffer */
 329	{ USB_DEVICE(0x16d3, 0x0002),
 330	  .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
 331
 332	/* Marvell Bluetooth devices */
 333	{ USB_DEVICE(0x1286, 0x2044), .driver_info = BTUSB_MARVELL },
 334	{ USB_DEVICE(0x1286, 0x2046), .driver_info = BTUSB_MARVELL },
 335	{ USB_DEVICE(0x1286, 0x204e), .driver_info = BTUSB_MARVELL },
 336
 337	/* Intel Bluetooth devices */
 338	{ USB_DEVICE(0x8087, 0x0025), .driver_info = BTUSB_INTEL_NEW |
 339						     BTUSB_WIDEBAND_SPEECH |
 340						     BTUSB_VALID_LE_STATES },
 341	{ USB_DEVICE(0x8087, 0x0026), .driver_info = BTUSB_INTEL_NEW |
 342						     BTUSB_WIDEBAND_SPEECH },
 343	{ USB_DEVICE(0x8087, 0x0029), .driver_info = BTUSB_INTEL_NEW |
 344						     BTUSB_WIDEBAND_SPEECH },
 345	{ USB_DEVICE(0x8087, 0x0032), .driver_info = BTUSB_INTEL_NEW |
 346						     BTUSB_WIDEBAND_SPEECH},
 347	{ USB_DEVICE(0x8087, 0x07da), .driver_info = BTUSB_CSR },
 348	{ USB_DEVICE(0x8087, 0x07dc), .driver_info = BTUSB_INTEL },
 349	{ USB_DEVICE(0x8087, 0x0a2a), .driver_info = BTUSB_INTEL },
 350	{ USB_DEVICE(0x8087, 0x0a2b), .driver_info = BTUSB_INTEL_NEW |
 351						     BTUSB_WIDEBAND_SPEECH },
 352	{ USB_DEVICE(0x8087, 0x0aa7), .driver_info = BTUSB_INTEL |
 353						     BTUSB_WIDEBAND_SPEECH },
 354	{ USB_DEVICE(0x8087, 0x0aaa), .driver_info = BTUSB_INTEL_NEW |
 355						     BTUSB_WIDEBAND_SPEECH |
 356						     BTUSB_VALID_LE_STATES },
 357
 358	/* Other Intel Bluetooth devices */
 359	{ USB_VENDOR_AND_INTERFACE_INFO(0x8087, 0xe0, 0x01, 0x01),
 360	  .driver_info = BTUSB_IGNORE },
 361
 362	/* Realtek 8822CE Bluetooth devices */
 363	{ USB_DEVICE(0x0bda, 0xb00c), .driver_info = BTUSB_REALTEK |
 364						     BTUSB_WIDEBAND_SPEECH },
 365
 366	/* Realtek Bluetooth devices */
 367	{ USB_VENDOR_AND_INTERFACE_INFO(0x0bda, 0xe0, 0x01, 0x01),
 368	  .driver_info = BTUSB_REALTEK },
 369
 370	/* MediaTek Bluetooth devices */
 371	{ USB_VENDOR_AND_INTERFACE_INFO(0x0e8d, 0xe0, 0x01, 0x01),
 372	  .driver_info = BTUSB_MEDIATEK },
 373
 374	/* Additional Realtek 8723AE Bluetooth devices */
 375	{ USB_DEVICE(0x0930, 0x021d), .driver_info = BTUSB_REALTEK },
 376	{ USB_DEVICE(0x13d3, 0x3394), .driver_info = BTUSB_REALTEK },
 377
 378	/* Additional Realtek 8723BE Bluetooth devices */
 379	{ USB_DEVICE(0x0489, 0xe085), .driver_info = BTUSB_REALTEK },
 380	{ USB_DEVICE(0x0489, 0xe08b), .driver_info = BTUSB_REALTEK },
 381	{ USB_DEVICE(0x13d3, 0x3410), .driver_info = BTUSB_REALTEK },
 382	{ USB_DEVICE(0x13d3, 0x3416), .driver_info = BTUSB_REALTEK },
 383	{ USB_DEVICE(0x13d3, 0x3459), .driver_info = BTUSB_REALTEK },
 384	{ USB_DEVICE(0x13d3, 0x3494), .driver_info = BTUSB_REALTEK },
 385
 386	/* Additional Realtek 8723BU Bluetooth devices */
 387	{ USB_DEVICE(0x7392, 0xa611), .driver_info = BTUSB_REALTEK },
 388
 389	/* Additional Realtek 8723DE Bluetooth devices */
 390	{ USB_DEVICE(0x0bda, 0xb009), .driver_info = BTUSB_REALTEK },
 391	{ USB_DEVICE(0x2ff8, 0xb011), .driver_info = BTUSB_REALTEK },
 392
 393	/* Additional Realtek 8821AE Bluetooth devices */
 394	{ USB_DEVICE(0x0b05, 0x17dc), .driver_info = BTUSB_REALTEK },
 395	{ USB_DEVICE(0x13d3, 0x3414), .driver_info = BTUSB_REALTEK },
 396	{ USB_DEVICE(0x13d3, 0x3458), .driver_info = BTUSB_REALTEK },
 397	{ USB_DEVICE(0x13d3, 0x3461), .driver_info = BTUSB_REALTEK },
 398	{ USB_DEVICE(0x13d3, 0x3462), .driver_info = BTUSB_REALTEK },
 399
 400	/* Additional Realtek 8822BE Bluetooth devices */
 401	{ USB_DEVICE(0x13d3, 0x3526), .driver_info = BTUSB_REALTEK },
 402	{ USB_DEVICE(0x0b05, 0x185c), .driver_info = BTUSB_REALTEK },
 403
 404	/* Additional Realtek 8822CE Bluetooth devices */
 405	{ USB_DEVICE(0x04ca, 0x4005), .driver_info = BTUSB_REALTEK },
 406	{ USB_DEVICE(0x13d3, 0x3548), .driver_info = BTUSB_REALTEK },
 407
 408	/* Silicon Wave based devices */
 409	{ USB_DEVICE(0x0c10, 0x0000), .driver_info = BTUSB_SWAVE },
 410
 411	{ }	/* Terminating entry */
 412};
 413
 414/* The Bluetooth USB module build into some devices needs to be reset on resume,
 415 * this is a problem with the platform (likely shutting off all power) not with
 416 * the module itself. So we use a DMI list to match known broken platforms.
 417 */
 418static const struct dmi_system_id btusb_needs_reset_resume_table[] = {
 419	{
 420		/* Dell OptiPlex 3060 (QCA ROME device 0cf3:e007) */
 421		.matches = {
 422			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
 423			DMI_MATCH(DMI_PRODUCT_NAME, "OptiPlex 3060"),
 424		},
 425	},
 426	{
 427		/* Dell XPS 9360 (QCA ROME device 0cf3:e300) */
 428		.matches = {
 429			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
 430			DMI_MATCH(DMI_PRODUCT_NAME, "XPS 13 9360"),
 431		},
 432	},
 433	{
 434		/* Dell Inspiron 5565 (QCA ROME device 0cf3:e009) */
 435		.matches = {
 436			DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
 437			DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 5565"),
 438		},
 439	},
 440	{}
 441};
 442
 443#define BTUSB_MAX_ISOC_FRAMES	10
 444
 445#define BTUSB_INTR_RUNNING	0
 446#define BTUSB_BULK_RUNNING	1
 447#define BTUSB_ISOC_RUNNING	2
 448#define BTUSB_SUSPENDING	3
 449#define BTUSB_DID_ISO_RESUME	4
 450#define BTUSB_BOOTLOADER	5
 451#define BTUSB_DOWNLOADING	6
 452#define BTUSB_FIRMWARE_LOADED	7
 453#define BTUSB_FIRMWARE_FAILED	8
 454#define BTUSB_BOOTING		9
 455#define BTUSB_DIAG_RUNNING	10
 456#define BTUSB_OOB_WAKE_ENABLED	11
 457#define BTUSB_HW_RESET_ACTIVE	12
 458#define BTUSB_TX_WAIT_VND_EVT	13
 459#define BTUSB_WAKEUP_DISABLE	14
 460#define BTUSB_USE_ALT1_FOR_WBS	15
 461
 462struct btusb_data {
 463	struct hci_dev       *hdev;
 464	struct usb_device    *udev;
 465	struct usb_interface *intf;
 466	struct usb_interface *isoc;
 467	struct usb_interface *diag;
 468	unsigned isoc_ifnum;
 469
 470	unsigned long flags;
 471
 472	struct work_struct work;
 473	struct work_struct waker;
 474
 475	struct usb_anchor deferred;
 476	struct usb_anchor tx_anchor;
 477	int tx_in_flight;
 478	spinlock_t txlock;
 479
 480	struct usb_anchor intr_anchor;
 481	struct usb_anchor bulk_anchor;
 482	struct usb_anchor isoc_anchor;
 483	struct usb_anchor diag_anchor;
 484	struct usb_anchor ctrl_anchor;
 485	spinlock_t rxlock;
 486
 487	struct sk_buff *evt_skb;
 488	struct sk_buff *acl_skb;
 489	struct sk_buff *sco_skb;
 490
 491	struct usb_endpoint_descriptor *intr_ep;
 492	struct usb_endpoint_descriptor *bulk_tx_ep;
 493	struct usb_endpoint_descriptor *bulk_rx_ep;
 494	struct usb_endpoint_descriptor *isoc_tx_ep;
 495	struct usb_endpoint_descriptor *isoc_rx_ep;
 496	struct usb_endpoint_descriptor *diag_tx_ep;
 497	struct usb_endpoint_descriptor *diag_rx_ep;
 498
 499	struct gpio_desc *reset_gpio;
 500
 501	__u8 cmdreq_type;
 502	__u8 cmdreq;
 503
 504	unsigned int sco_num;
 505	unsigned int air_mode;
 506	bool usb_alt6_packet_flow;
 507	int isoc_altsetting;
 508	int suspend_count;
 509
 510	int (*recv_event)(struct hci_dev *hdev, struct sk_buff *skb);
 511	int (*recv_bulk)(struct btusb_data *data, void *buffer, int count);
 512
 513	int (*setup_on_usb)(struct hci_dev *hdev);
 514
 515	int oob_wake_irq;   /* irq for out-of-band wake-on-bt */
 516	unsigned cmd_timeout_cnt;
 517};
 518
 519static void btusb_intel_cmd_timeout(struct hci_dev *hdev)
 520{
 521	struct btusb_data *data = hci_get_drvdata(hdev);
 522	struct gpio_desc *reset_gpio = data->reset_gpio;
 523
 524	if (++data->cmd_timeout_cnt < 5)
 525		return;
 526
 527	if (!reset_gpio) {
 528		bt_dev_err(hdev, "No way to reset. Ignoring and continuing");
 529		return;
 530	}
 531
 532	/*
 533	 * Toggle the hard reset line if the platform provides one. The reset
 534	 * is going to yank the device off the USB and then replug. So doing
 535	 * once is enough. The cleanup is handled correctly on the way out
 536	 * (standard USB disconnect), and the new device is detected cleanly
 537	 * and bound to the driver again like it should be.
 538	 */
 539	if (test_and_set_bit(BTUSB_HW_RESET_ACTIVE, &data->flags)) {
 540		bt_dev_err(hdev, "last reset failed? Not resetting again");
 541		return;
 542	}
 543
 544	bt_dev_err(hdev, "Initiating HW reset via gpio");
 545	gpiod_set_value_cansleep(reset_gpio, 1);
 546	msleep(100);
 547	gpiod_set_value_cansleep(reset_gpio, 0);
 548}
 549
 550static void btusb_rtl_cmd_timeout(struct hci_dev *hdev)
 551{
 552	struct btusb_data *data = hci_get_drvdata(hdev);
 553	struct gpio_desc *reset_gpio = data->reset_gpio;
 554
 555	if (++data->cmd_timeout_cnt < 5)
 556		return;
 557
 558	if (!reset_gpio) {
 559		bt_dev_err(hdev, "No gpio to reset Realtek device, ignoring");
 560		return;
 561	}
 562
 563	/* Toggle the hard reset line. The Realtek device is going to
 564	 * yank itself off the USB and then replug. The cleanup is handled
 565	 * correctly on the way out (standard USB disconnect), and the new
 566	 * device is detected cleanly and bound to the driver again like
 567	 * it should be.
 568	 */
 569	if (test_and_set_bit(BTUSB_HW_RESET_ACTIVE, &data->flags)) {
 570		bt_dev_err(hdev, "last reset failed? Not resetting again");
 571		return;
 572	}
 573
 574	bt_dev_err(hdev, "Reset Realtek device via gpio");
 575	gpiod_set_value_cansleep(reset_gpio, 1);
 576	msleep(200);
 577	gpiod_set_value_cansleep(reset_gpio, 0);
 578}
 579
 580static void btusb_qca_cmd_timeout(struct hci_dev *hdev)
 581{
 582	struct btusb_data *data = hci_get_drvdata(hdev);
 583	int err;
 584
 585	if (++data->cmd_timeout_cnt < 5)
 586		return;
 587
 588	bt_dev_err(hdev, "Multiple cmd timeouts seen. Resetting usb device.");
 589	/* This is not an unbalanced PM reference since the device will reset */
 590	err = usb_autopm_get_interface(data->intf);
 591	if (!err)
 592		usb_queue_reset_device(data->intf);
 593	else
 594		bt_dev_err(hdev, "Failed usb_autopm_get_interface with %d", err);
 595}
 596
 597static inline void btusb_free_frags(struct btusb_data *data)
 598{
 599	unsigned long flags;
 600
 601	spin_lock_irqsave(&data->rxlock, flags);
 602
 603	kfree_skb(data->evt_skb);
 604	data->evt_skb = NULL;
 605
 606	kfree_skb(data->acl_skb);
 607	data->acl_skb = NULL;
 608
 609	kfree_skb(data->sco_skb);
 610	data->sco_skb = NULL;
 611
 612	spin_unlock_irqrestore(&data->rxlock, flags);
 613}
 614
 615static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count)
 616{
 617	struct sk_buff *skb;
 618	unsigned long flags;
 619	int err = 0;
 620
 621	spin_lock_irqsave(&data->rxlock, flags);
 622	skb = data->evt_skb;
 623
 624	while (count) {
 625		int len;
 626
 627		if (!skb) {
 628			skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC);
 629			if (!skb) {
 630				err = -ENOMEM;
 631				break;
 632			}
 633
 634			hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
 635			hci_skb_expect(skb) = HCI_EVENT_HDR_SIZE;
 636		}
 637
 638		len = min_t(uint, hci_skb_expect(skb), count);
 639		skb_put_data(skb, buffer, len);
 640
 641		count -= len;
 642		buffer += len;
 643		hci_skb_expect(skb) -= len;
 644
 645		if (skb->len == HCI_EVENT_HDR_SIZE) {
 646			/* Complete event header */
 647			hci_skb_expect(skb) = hci_event_hdr(skb)->plen;
 648
 649			if (skb_tailroom(skb) < hci_skb_expect(skb)) {
 650				kfree_skb(skb);
 651				skb = NULL;
 652
 653				err = -EILSEQ;
 654				break;
 655			}
 656		}
 657
 658		if (!hci_skb_expect(skb)) {
 659			/* Complete frame */
 660			data->recv_event(data->hdev, skb);
 661			skb = NULL;
 662		}
 663	}
 664
 665	data->evt_skb = skb;
 666	spin_unlock_irqrestore(&data->rxlock, flags);
 667
 668	return err;
 669}
 670
 671static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count)
 672{
 673	struct sk_buff *skb;
 674	unsigned long flags;
 675	int err = 0;
 676
 677	spin_lock_irqsave(&data->rxlock, flags);
 678	skb = data->acl_skb;
 679
 680	while (count) {
 681		int len;
 682
 683		if (!skb) {
 684			skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
 685			if (!skb) {
 686				err = -ENOMEM;
 687				break;
 688			}
 689
 690			hci_skb_pkt_type(skb) = HCI_ACLDATA_PKT;
 691			hci_skb_expect(skb) = HCI_ACL_HDR_SIZE;
 692		}
 693
 694		len = min_t(uint, hci_skb_expect(skb), count);
 695		skb_put_data(skb, buffer, len);
 696
 697		count -= len;
 698		buffer += len;
 699		hci_skb_expect(skb) -= len;
 700
 701		if (skb->len == HCI_ACL_HDR_SIZE) {
 702			__le16 dlen = hci_acl_hdr(skb)->dlen;
 703
 704			/* Complete ACL header */
 705			hci_skb_expect(skb) = __le16_to_cpu(dlen);
 706
 707			if (skb_tailroom(skb) < hci_skb_expect(skb)) {
 708				kfree_skb(skb);
 709				skb = NULL;
 710
 711				err = -EILSEQ;
 712				break;
 713			}
 714		}
 715
 716		if (!hci_skb_expect(skb)) {
 717			/* Complete frame */
 718			hci_recv_frame(data->hdev, skb);
 719			skb = NULL;
 720		}
 721	}
 722
 723	data->acl_skb = skb;
 724	spin_unlock_irqrestore(&data->rxlock, flags);
 725
 726	return err;
 727}
 728
 729static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count)
 730{
 731	struct sk_buff *skb;
 732	unsigned long flags;
 733	int err = 0;
 734
 735	spin_lock_irqsave(&data->rxlock, flags);
 736	skb = data->sco_skb;
 737
 738	while (count) {
 739		int len;
 740
 741		if (!skb) {
 742			skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC);
 743			if (!skb) {
 744				err = -ENOMEM;
 745				break;
 746			}
 747
 748			hci_skb_pkt_type(skb) = HCI_SCODATA_PKT;
 749			hci_skb_expect(skb) = HCI_SCO_HDR_SIZE;
 750		}
 751
 752		len = min_t(uint, hci_skb_expect(skb), count);
 753		skb_put_data(skb, buffer, len);
 754
 755		count -= len;
 756		buffer += len;
 757		hci_skb_expect(skb) -= len;
 758
 759		if (skb->len == HCI_SCO_HDR_SIZE) {
 760			/* Complete SCO header */
 761			hci_skb_expect(skb) = hci_sco_hdr(skb)->dlen;
 762
 763			if (skb_tailroom(skb) < hci_skb_expect(skb)) {
 764				kfree_skb(skb);
 765				skb = NULL;
 766
 767				err = -EILSEQ;
 768				break;
 769			}
 770		}
 771
 772		if (!hci_skb_expect(skb)) {
 773			/* Complete frame */
 774			hci_recv_frame(data->hdev, skb);
 775			skb = NULL;
 776		}
 777	}
 778
 779	data->sco_skb = skb;
 780	spin_unlock_irqrestore(&data->rxlock, flags);
 781
 782	return err;
 783}
 784
 785static void btusb_intr_complete(struct urb *urb)
 786{
 787	struct hci_dev *hdev = urb->context;
 788	struct btusb_data *data = hci_get_drvdata(hdev);
 789	int err;
 790
 791	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 792	       urb->actual_length);
 793
 794	if (!test_bit(HCI_RUNNING, &hdev->flags))
 795		return;
 796
 797	if (urb->status == 0) {
 798		hdev->stat.byte_rx += urb->actual_length;
 799
 800		if (btusb_recv_intr(data, urb->transfer_buffer,
 801				    urb->actual_length) < 0) {
 802			bt_dev_err(hdev, "corrupted event packet");
 803			hdev->stat.err_rx++;
 804		}
 805	} else if (urb->status == -ENOENT) {
 806		/* Avoid suspend failed when usb_kill_urb */
 807		return;
 808	}
 809
 810	if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
 811		return;
 812
 813	usb_mark_last_busy(data->udev);
 814	usb_anchor_urb(urb, &data->intr_anchor);
 815
 816	err = usb_submit_urb(urb, GFP_ATOMIC);
 817	if (err < 0) {
 818		/* -EPERM: urb is being killed;
 819		 * -ENODEV: device got disconnected
 820		 */
 821		if (err != -EPERM && err != -ENODEV)
 822			bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
 823				   urb, -err);
 824		usb_unanchor_urb(urb);
 825	}
 826}
 827
 828static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
 829{
 830	struct btusb_data *data = hci_get_drvdata(hdev);
 831	struct urb *urb;
 832	unsigned char *buf;
 833	unsigned int pipe;
 834	int err, size;
 835
 836	BT_DBG("%s", hdev->name);
 837
 838	if (!data->intr_ep)
 839		return -ENODEV;
 840
 841	urb = usb_alloc_urb(0, mem_flags);
 842	if (!urb)
 843		return -ENOMEM;
 844
 845	size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
 846
 847	buf = kmalloc(size, mem_flags);
 848	if (!buf) {
 849		usb_free_urb(urb);
 850		return -ENOMEM;
 851	}
 852
 853	pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
 854
 855	usb_fill_int_urb(urb, data->udev, pipe, buf, size,
 856			 btusb_intr_complete, hdev, data->intr_ep->bInterval);
 857
 858	urb->transfer_flags |= URB_FREE_BUFFER;
 859
 860	usb_anchor_urb(urb, &data->intr_anchor);
 861
 862	err = usb_submit_urb(urb, mem_flags);
 863	if (err < 0) {
 864		if (err != -EPERM && err != -ENODEV)
 865			bt_dev_err(hdev, "urb %p submission failed (%d)",
 866				   urb, -err);
 867		usb_unanchor_urb(urb);
 868	}
 869
 870	usb_free_urb(urb);
 871
 872	return err;
 873}
 874
 875static void btusb_bulk_complete(struct urb *urb)
 876{
 877	struct hci_dev *hdev = urb->context;
 878	struct btusb_data *data = hci_get_drvdata(hdev);
 879	int err;
 880
 881	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 882	       urb->actual_length);
 883
 884	if (!test_bit(HCI_RUNNING, &hdev->flags))
 885		return;
 886
 887	if (urb->status == 0) {
 888		hdev->stat.byte_rx += urb->actual_length;
 889
 890		if (data->recv_bulk(data, urb->transfer_buffer,
 891				    urb->actual_length) < 0) {
 892			bt_dev_err(hdev, "corrupted ACL packet");
 893			hdev->stat.err_rx++;
 894		}
 895	} else if (urb->status == -ENOENT) {
 896		/* Avoid suspend failed when usb_kill_urb */
 897		return;
 898	}
 899
 900	if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
 901		return;
 902
 903	usb_anchor_urb(urb, &data->bulk_anchor);
 904	usb_mark_last_busy(data->udev);
 905
 906	err = usb_submit_urb(urb, GFP_ATOMIC);
 907	if (err < 0) {
 908		/* -EPERM: urb is being killed;
 909		 * -ENODEV: device got disconnected
 910		 */
 911		if (err != -EPERM && err != -ENODEV)
 912			bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
 913				   urb, -err);
 914		usb_unanchor_urb(urb);
 915	}
 916}
 917
 918static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
 919{
 920	struct btusb_data *data = hci_get_drvdata(hdev);
 921	struct urb *urb;
 922	unsigned char *buf;
 923	unsigned int pipe;
 924	int err, size = HCI_MAX_FRAME_SIZE;
 925
 926	BT_DBG("%s", hdev->name);
 927
 928	if (!data->bulk_rx_ep)
 929		return -ENODEV;
 930
 931	urb = usb_alloc_urb(0, mem_flags);
 932	if (!urb)
 933		return -ENOMEM;
 934
 935	buf = kmalloc(size, mem_flags);
 936	if (!buf) {
 937		usb_free_urb(urb);
 938		return -ENOMEM;
 939	}
 940
 941	pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
 942
 943	usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
 944			  btusb_bulk_complete, hdev);
 945
 946	urb->transfer_flags |= URB_FREE_BUFFER;
 947
 948	usb_mark_last_busy(data->udev);
 949	usb_anchor_urb(urb, &data->bulk_anchor);
 950
 951	err = usb_submit_urb(urb, mem_flags);
 952	if (err < 0) {
 953		if (err != -EPERM && err != -ENODEV)
 954			bt_dev_err(hdev, "urb %p submission failed (%d)",
 955				   urb, -err);
 956		usb_unanchor_urb(urb);
 957	}
 958
 959	usb_free_urb(urb);
 960
 961	return err;
 962}
 963
 964static void btusb_isoc_complete(struct urb *urb)
 965{
 966	struct hci_dev *hdev = urb->context;
 967	struct btusb_data *data = hci_get_drvdata(hdev);
 968	int i, err;
 969
 970	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 971	       urb->actual_length);
 972
 973	if (!test_bit(HCI_RUNNING, &hdev->flags))
 974		return;
 975
 976	if (urb->status == 0) {
 977		for (i = 0; i < urb->number_of_packets; i++) {
 978			unsigned int offset = urb->iso_frame_desc[i].offset;
 979			unsigned int length = urb->iso_frame_desc[i].actual_length;
 980
 981			if (urb->iso_frame_desc[i].status)
 982				continue;
 983
 984			hdev->stat.byte_rx += length;
 985
 986			if (btusb_recv_isoc(data, urb->transfer_buffer + offset,
 987					    length) < 0) {
 988				bt_dev_err(hdev, "corrupted SCO packet");
 989				hdev->stat.err_rx++;
 990			}
 991		}
 992	} else if (urb->status == -ENOENT) {
 993		/* Avoid suspend failed when usb_kill_urb */
 994		return;
 995	}
 996
 997	if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
 998		return;
 999
1000	usb_anchor_urb(urb, &data->isoc_anchor);
1001
1002	err = usb_submit_urb(urb, GFP_ATOMIC);
1003	if (err < 0) {
1004		/* -EPERM: urb is being killed;
1005		 * -ENODEV: device got disconnected
1006		 */
1007		if (err != -EPERM && err != -ENODEV)
1008			bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
1009				   urb, -err);
1010		usb_unanchor_urb(urb);
1011	}
1012}
1013
1014static inline void __fill_isoc_descriptor_msbc(struct urb *urb, int len,
1015					       int mtu, struct btusb_data *data)
1016{
1017	int i, offset = 0;
1018	unsigned int interval;
1019
1020	BT_DBG("len %d mtu %d", len, mtu);
1021
1022	/* For mSBC ALT 6 setting the host will send the packet at continuous
1023	 * flow. As per core spec 5, vol 4, part B, table 2.1. For ALT setting
1024	 * 6 the HCI PACKET INTERVAL should be 7.5ms for every usb packets.
1025	 * To maintain the rate we send 63bytes of usb packets alternatively for
1026	 * 7ms and 8ms to maintain the rate as 7.5ms.
1027	 */
1028	if (data->usb_alt6_packet_flow) {
1029		interval = 7;
1030		data->usb_alt6_packet_flow = false;
1031	} else {
1032		interval = 6;
1033		data->usb_alt6_packet_flow = true;
1034	}
1035
1036	for (i = 0; i < interval; i++) {
1037		urb->iso_frame_desc[i].offset = offset;
1038		urb->iso_frame_desc[i].length = offset;
1039	}
1040
1041	if (len && i < BTUSB_MAX_ISOC_FRAMES) {
1042		urb->iso_frame_desc[i].offset = offset;
1043		urb->iso_frame_desc[i].length = len;
1044		i++;
1045	}
1046
1047	urb->number_of_packets = i;
1048}
1049
1050static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
1051{
1052	int i, offset = 0;
1053
1054	BT_DBG("len %d mtu %d", len, mtu);
1055
1056	for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
1057					i++, offset += mtu, len -= mtu) {
1058		urb->iso_frame_desc[i].offset = offset;
1059		urb->iso_frame_desc[i].length = mtu;
1060	}
1061
1062	if (len && i < BTUSB_MAX_ISOC_FRAMES) {
1063		urb->iso_frame_desc[i].offset = offset;
1064		urb->iso_frame_desc[i].length = len;
1065		i++;
1066	}
1067
1068	urb->number_of_packets = i;
1069}
1070
1071static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
1072{
1073	struct btusb_data *data = hci_get_drvdata(hdev);
1074	struct urb *urb;
1075	unsigned char *buf;
1076	unsigned int pipe;
1077	int err, size;
1078
1079	BT_DBG("%s", hdev->name);
1080
1081	if (!data->isoc_rx_ep)
1082		return -ENODEV;
1083
1084	urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
1085	if (!urb)
1086		return -ENOMEM;
1087
1088	size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
1089						BTUSB_MAX_ISOC_FRAMES;
1090
1091	buf = kmalloc(size, mem_flags);
1092	if (!buf) {
1093		usb_free_urb(urb);
1094		return -ENOMEM;
1095	}
1096
1097	pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
1098
1099	usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_isoc_complete,
1100			 hdev, data->isoc_rx_ep->bInterval);
1101
1102	urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
1103
1104	__fill_isoc_descriptor(urb, size,
1105			       le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
1106
1107	usb_anchor_urb(urb, &data->isoc_anchor);
1108
1109	err = usb_submit_urb(urb, mem_flags);
1110	if (err < 0) {
1111		if (err != -EPERM && err != -ENODEV)
1112			bt_dev_err(hdev, "urb %p submission failed (%d)",
1113				   urb, -err);
1114		usb_unanchor_urb(urb);
1115	}
1116
1117	usb_free_urb(urb);
1118
1119	return err;
1120}
1121
1122static void btusb_diag_complete(struct urb *urb)
1123{
1124	struct hci_dev *hdev = urb->context;
1125	struct btusb_data *data = hci_get_drvdata(hdev);
1126	int err;
1127
1128	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1129	       urb->actual_length);
1130
1131	if (urb->status == 0) {
1132		struct sk_buff *skb;
1133
1134		skb = bt_skb_alloc(urb->actual_length, GFP_ATOMIC);
1135		if (skb) {
1136			skb_put_data(skb, urb->transfer_buffer,
1137				     urb->actual_length);
1138			hci_recv_diag(hdev, skb);
1139		}
1140	} else if (urb->status == -ENOENT) {
1141		/* Avoid suspend failed when usb_kill_urb */
1142		return;
1143	}
1144
1145	if (!test_bit(BTUSB_DIAG_RUNNING, &data->flags))
1146		return;
1147
1148	usb_anchor_urb(urb, &data->diag_anchor);
1149	usb_mark_last_busy(data->udev);
1150
1151	err = usb_submit_urb(urb, GFP_ATOMIC);
1152	if (err < 0) {
1153		/* -EPERM: urb is being killed;
1154		 * -ENODEV: device got disconnected
1155		 */
1156		if (err != -EPERM && err != -ENODEV)
1157			bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
1158				   urb, -err);
1159		usb_unanchor_urb(urb);
1160	}
1161}
1162
1163static int btusb_submit_diag_urb(struct hci_dev *hdev, gfp_t mem_flags)
1164{
1165	struct btusb_data *data = hci_get_drvdata(hdev);
1166	struct urb *urb;
1167	unsigned char *buf;
1168	unsigned int pipe;
1169	int err, size = HCI_MAX_FRAME_SIZE;
1170
1171	BT_DBG("%s", hdev->name);
1172
1173	if (!data->diag_rx_ep)
1174		return -ENODEV;
1175
1176	urb = usb_alloc_urb(0, mem_flags);
1177	if (!urb)
1178		return -ENOMEM;
1179
1180	buf = kmalloc(size, mem_flags);
1181	if (!buf) {
1182		usb_free_urb(urb);
1183		return -ENOMEM;
1184	}
1185
1186	pipe = usb_rcvbulkpipe(data->udev, data->diag_rx_ep->bEndpointAddress);
1187
1188	usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
1189			  btusb_diag_complete, hdev);
1190
1191	urb->transfer_flags |= URB_FREE_BUFFER;
1192
1193	usb_mark_last_busy(data->udev);
1194	usb_anchor_urb(urb, &data->diag_anchor);
1195
1196	err = usb_submit_urb(urb, mem_flags);
1197	if (err < 0) {
1198		if (err != -EPERM && err != -ENODEV)
1199			bt_dev_err(hdev, "urb %p submission failed (%d)",
1200				   urb, -err);
1201		usb_unanchor_urb(urb);
1202	}
1203
1204	usb_free_urb(urb);
1205
1206	return err;
1207}
1208
1209static void btusb_tx_complete(struct urb *urb)
1210{
1211	struct sk_buff *skb = urb->context;
1212	struct hci_dev *hdev = (struct hci_dev *)skb->dev;
1213	struct btusb_data *data = hci_get_drvdata(hdev);
1214	unsigned long flags;
1215
1216	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1217	       urb->actual_length);
1218
1219	if (!test_bit(HCI_RUNNING, &hdev->flags))
1220		goto done;
1221
1222	if (!urb->status)
1223		hdev->stat.byte_tx += urb->transfer_buffer_length;
1224	else
1225		hdev->stat.err_tx++;
1226
1227done:
1228	spin_lock_irqsave(&data->txlock, flags);
1229	data->tx_in_flight--;
1230	spin_unlock_irqrestore(&data->txlock, flags);
1231
1232	kfree(urb->setup_packet);
1233
1234	kfree_skb(skb);
1235}
1236
1237static void btusb_isoc_tx_complete(struct urb *urb)
1238{
1239	struct sk_buff *skb = urb->context;
1240	struct hci_dev *hdev = (struct hci_dev *)skb->dev;
1241
1242	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1243	       urb->actual_length);
1244
1245	if (!test_bit(HCI_RUNNING, &hdev->flags))
1246		goto done;
1247
1248	if (!urb->status)
1249		hdev->stat.byte_tx += urb->transfer_buffer_length;
1250	else
1251		hdev->stat.err_tx++;
1252
1253done:
1254	kfree(urb->setup_packet);
1255
1256	kfree_skb(skb);
1257}
1258
1259static int btusb_open(struct hci_dev *hdev)
1260{
1261	struct btusb_data *data = hci_get_drvdata(hdev);
1262	int err;
1263
1264	BT_DBG("%s", hdev->name);
1265
1266	err = usb_autopm_get_interface(data->intf);
1267	if (err < 0)
1268		return err;
1269
1270	/* Patching USB firmware files prior to starting any URBs of HCI path
1271	 * It is more safe to use USB bulk channel for downloading USB patch
1272	 */
1273	if (data->setup_on_usb) {
1274		err = data->setup_on_usb(hdev);
1275		if (err < 0)
1276			goto setup_fail;
1277	}
1278
1279	data->intf->needs_remote_wakeup = 1;
 
 
1280
1281	/* Disable device remote wakeup when host is suspended
1282	 * For Realtek chips, global suspend without
1283	 * SET_FEATURE (DEVICE_REMOTE_WAKEUP) can save more power in device.
1284	 */
1285	if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags))
1286		device_wakeup_disable(&data->udev->dev);
1287
1288	if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
1289		goto done;
1290
1291	err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
1292	if (err < 0)
1293		goto failed;
1294
1295	err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1296	if (err < 0) {
1297		usb_kill_anchored_urbs(&data->intr_anchor);
1298		goto failed;
1299	}
1300
1301	set_bit(BTUSB_BULK_RUNNING, &data->flags);
1302	btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1303
1304	if (data->diag) {
1305		if (!btusb_submit_diag_urb(hdev, GFP_KERNEL))
1306			set_bit(BTUSB_DIAG_RUNNING, &data->flags);
1307	}
1308
1309done:
1310	usb_autopm_put_interface(data->intf);
1311	return 0;
1312
1313failed:
1314	clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1315setup_fail:
1316	usb_autopm_put_interface(data->intf);
1317	return err;
1318}
1319
1320static void btusb_stop_traffic(struct btusb_data *data)
1321{
1322	usb_kill_anchored_urbs(&data->intr_anchor);
1323	usb_kill_anchored_urbs(&data->bulk_anchor);
1324	usb_kill_anchored_urbs(&data->isoc_anchor);
1325	usb_kill_anchored_urbs(&data->diag_anchor);
1326	usb_kill_anchored_urbs(&data->ctrl_anchor);
1327}
1328
1329static int btusb_close(struct hci_dev *hdev)
1330{
1331	struct btusb_data *data = hci_get_drvdata(hdev);
1332	int err;
1333
1334	BT_DBG("%s", hdev->name);
1335
1336	cancel_work_sync(&data->work);
1337	cancel_work_sync(&data->waker);
1338
1339	clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1340	clear_bit(BTUSB_BULK_RUNNING, &data->flags);
1341	clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1342	clear_bit(BTUSB_DIAG_RUNNING, &data->flags);
1343
1344	btusb_stop_traffic(data);
1345	btusb_free_frags(data);
1346
1347	err = usb_autopm_get_interface(data->intf);
1348	if (err < 0)
1349		goto failed;
1350
1351	data->intf->needs_remote_wakeup = 0;
1352
1353	/* Enable remote wake up for auto-suspend */
1354	if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags))
1355		data->intf->needs_remote_wakeup = 1;
1356
1357	usb_autopm_put_interface(data->intf);
1358
1359failed:
1360	usb_scuttle_anchored_urbs(&data->deferred);
1361	return 0;
1362}
1363
1364static int btusb_flush(struct hci_dev *hdev)
1365{
1366	struct btusb_data *data = hci_get_drvdata(hdev);
1367
1368	BT_DBG("%s", hdev->name);
1369
1370	usb_kill_anchored_urbs(&data->tx_anchor);
1371	btusb_free_frags(data);
1372
1373	return 0;
1374}
1375
1376static struct urb *alloc_ctrl_urb(struct hci_dev *hdev, struct sk_buff *skb)
1377{
1378	struct btusb_data *data = hci_get_drvdata(hdev);
1379	struct usb_ctrlrequest *dr;
1380	struct urb *urb;
1381	unsigned int pipe;
1382
1383	urb = usb_alloc_urb(0, GFP_KERNEL);
1384	if (!urb)
1385		return ERR_PTR(-ENOMEM);
1386
1387	dr = kmalloc(sizeof(*dr), GFP_KERNEL);
1388	if (!dr) {
1389		usb_free_urb(urb);
1390		return ERR_PTR(-ENOMEM);
1391	}
1392
1393	dr->bRequestType = data->cmdreq_type;
1394	dr->bRequest     = data->cmdreq;
1395	dr->wIndex       = 0;
1396	dr->wValue       = 0;
1397	dr->wLength      = __cpu_to_le16(skb->len);
1398
1399	pipe = usb_sndctrlpipe(data->udev, 0x00);
1400
1401	usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
1402			     skb->data, skb->len, btusb_tx_complete, skb);
1403
1404	skb->dev = (void *)hdev;
1405
1406	return urb;
1407}
1408
1409static struct urb *alloc_bulk_urb(struct hci_dev *hdev, struct sk_buff *skb)
1410{
1411	struct btusb_data *data = hci_get_drvdata(hdev);
1412	struct urb *urb;
1413	unsigned int pipe;
1414
1415	if (!data->bulk_tx_ep)
1416		return ERR_PTR(-ENODEV);
1417
1418	urb = usb_alloc_urb(0, GFP_KERNEL);
1419	if (!urb)
1420		return ERR_PTR(-ENOMEM);
1421
1422	pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress);
1423
1424	usb_fill_bulk_urb(urb, data->udev, pipe,
1425			  skb->data, skb->len, btusb_tx_complete, skb);
1426
1427	skb->dev = (void *)hdev;
1428
1429	return urb;
1430}
1431
1432static struct urb *alloc_isoc_urb(struct hci_dev *hdev, struct sk_buff *skb)
1433{
1434	struct btusb_data *data = hci_get_drvdata(hdev);
1435	struct urb *urb;
1436	unsigned int pipe;
1437
1438	if (!data->isoc_tx_ep)
1439		return ERR_PTR(-ENODEV);
1440
1441	urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_KERNEL);
1442	if (!urb)
1443		return ERR_PTR(-ENOMEM);
1444
1445	pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress);
1446
1447	usb_fill_int_urb(urb, data->udev, pipe,
1448			 skb->data, skb->len, btusb_isoc_tx_complete,
1449			 skb, data->isoc_tx_ep->bInterval);
1450
1451	urb->transfer_flags  = URB_ISO_ASAP;
1452
1453	if (data->isoc_altsetting == 6)
1454		__fill_isoc_descriptor_msbc(urb, skb->len,
1455					    le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize),
1456					    data);
1457	else
1458		__fill_isoc_descriptor(urb, skb->len,
1459				       le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
1460	skb->dev = (void *)hdev;
1461
1462	return urb;
1463}
1464
1465static int submit_tx_urb(struct hci_dev *hdev, struct urb *urb)
1466{
1467	struct btusb_data *data = hci_get_drvdata(hdev);
1468	int err;
1469
1470	usb_anchor_urb(urb, &data->tx_anchor);
1471
1472	err = usb_submit_urb(urb, GFP_KERNEL);
1473	if (err < 0) {
1474		if (err != -EPERM && err != -ENODEV)
1475			bt_dev_err(hdev, "urb %p submission failed (%d)",
1476				   urb, -err);
1477		kfree(urb->setup_packet);
1478		usb_unanchor_urb(urb);
1479	} else {
1480		usb_mark_last_busy(data->udev);
1481	}
1482
1483	usb_free_urb(urb);
1484	return err;
1485}
1486
1487static int submit_or_queue_tx_urb(struct hci_dev *hdev, struct urb *urb)
1488{
1489	struct btusb_data *data = hci_get_drvdata(hdev);
1490	unsigned long flags;
1491	bool suspending;
1492
1493	spin_lock_irqsave(&data->txlock, flags);
1494	suspending = test_bit(BTUSB_SUSPENDING, &data->flags);
1495	if (!suspending)
1496		data->tx_in_flight++;
1497	spin_unlock_irqrestore(&data->txlock, flags);
1498
1499	if (!suspending)
1500		return submit_tx_urb(hdev, urb);
1501
1502	usb_anchor_urb(urb, &data->deferred);
1503	schedule_work(&data->waker);
1504
1505	usb_free_urb(urb);
1506	return 0;
1507}
1508
1509static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
1510{
1511	struct urb *urb;
1512
1513	BT_DBG("%s", hdev->name);
1514
1515	switch (hci_skb_pkt_type(skb)) {
1516	case HCI_COMMAND_PKT:
1517		urb = alloc_ctrl_urb(hdev, skb);
1518		if (IS_ERR(urb))
1519			return PTR_ERR(urb);
1520
1521		hdev->stat.cmd_tx++;
1522		return submit_or_queue_tx_urb(hdev, urb);
1523
1524	case HCI_ACLDATA_PKT:
1525		urb = alloc_bulk_urb(hdev, skb);
1526		if (IS_ERR(urb))
1527			return PTR_ERR(urb);
1528
1529		hdev->stat.acl_tx++;
1530		return submit_or_queue_tx_urb(hdev, urb);
1531
1532	case HCI_SCODATA_PKT:
1533		if (hci_conn_num(hdev, SCO_LINK) < 1)
1534			return -ENODEV;
1535
1536		urb = alloc_isoc_urb(hdev, skb);
1537		if (IS_ERR(urb))
1538			return PTR_ERR(urb);
1539
1540		hdev->stat.sco_tx++;
1541		return submit_tx_urb(hdev, urb);
1542	}
1543
1544	return -EILSEQ;
1545}
1546
1547static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
1548{
1549	struct btusb_data *data = hci_get_drvdata(hdev);
1550
1551	BT_DBG("%s evt %d", hdev->name, evt);
1552
1553	if (hci_conn_num(hdev, SCO_LINK) != data->sco_num) {
1554		data->sco_num = hci_conn_num(hdev, SCO_LINK);
1555		data->air_mode = evt;
1556		schedule_work(&data->work);
1557	}
1558}
1559
1560static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
1561{
1562	struct btusb_data *data = hci_get_drvdata(hdev);
1563	struct usb_interface *intf = data->isoc;
1564	struct usb_endpoint_descriptor *ep_desc;
1565	int i, err;
1566
1567	if (!data->isoc)
1568		return -ENODEV;
1569
1570	err = usb_set_interface(data->udev, data->isoc_ifnum, altsetting);
1571	if (err < 0) {
1572		bt_dev_err(hdev, "setting interface failed (%d)", -err);
1573		return err;
1574	}
1575
1576	data->isoc_altsetting = altsetting;
1577
1578	data->isoc_tx_ep = NULL;
1579	data->isoc_rx_ep = NULL;
1580
1581	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1582		ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1583
1584		if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
1585			data->isoc_tx_ep = ep_desc;
1586			continue;
1587		}
1588
1589		if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
1590			data->isoc_rx_ep = ep_desc;
1591			continue;
1592		}
1593	}
1594
1595	if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
1596		bt_dev_err(hdev, "invalid SCO descriptors");
1597		return -ENODEV;
1598	}
1599
1600	return 0;
1601}
1602
1603static int btusb_switch_alt_setting(struct hci_dev *hdev, int new_alts)
1604{
1605	struct btusb_data *data = hci_get_drvdata(hdev);
1606	int err;
1607
1608	if (data->isoc_altsetting != new_alts) {
1609		unsigned long flags;
1610
1611		clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1612		usb_kill_anchored_urbs(&data->isoc_anchor);
1613
1614		/* When isochronous alternate setting needs to be
1615		 * changed, because SCO connection has been added
1616		 * or removed, a packet fragment may be left in the
1617		 * reassembling state. This could lead to wrongly
1618		 * assembled fragments.
1619		 *
1620		 * Clear outstanding fragment when selecting a new
1621		 * alternate setting.
1622		 */
1623		spin_lock_irqsave(&data->rxlock, flags);
1624		kfree_skb(data->sco_skb);
1625		data->sco_skb = NULL;
1626		spin_unlock_irqrestore(&data->rxlock, flags);
1627
1628		err = __set_isoc_interface(hdev, new_alts);
1629		if (err < 0)
1630			return err;
1631	}
1632
1633	if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
1634		if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
1635			clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1636		else
1637			btusb_submit_isoc_urb(hdev, GFP_KERNEL);
1638	}
1639
1640	return 0;
1641}
1642
1643static struct usb_host_interface *btusb_find_altsetting(struct btusb_data *data,
1644							int alt)
1645{
1646	struct usb_interface *intf = data->isoc;
1647	int i;
1648
1649	BT_DBG("Looking for Alt no :%d", alt);
1650
1651	if (!intf)
1652		return NULL;
1653
1654	for (i = 0; i < intf->num_altsetting; i++) {
1655		if (intf->altsetting[i].desc.bAlternateSetting == alt)
1656			return &intf->altsetting[i];
1657	}
1658
1659	return NULL;
1660}
1661
1662static void btusb_work(struct work_struct *work)
1663{
1664	struct btusb_data *data = container_of(work, struct btusb_data, work);
1665	struct hci_dev *hdev = data->hdev;
1666	int new_alts = 0;
1667	int err;
1668
1669	if (data->sco_num > 0) {
1670		if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
1671			err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
1672			if (err < 0) {
1673				clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1674				usb_kill_anchored_urbs(&data->isoc_anchor);
1675				return;
1676			}
1677
1678			set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
1679		}
1680
1681		if (data->air_mode == HCI_NOTIFY_ENABLE_SCO_CVSD) {
1682			if (hdev->voice_setting & 0x0020) {
1683				static const int alts[3] = { 2, 4, 5 };
1684
1685				new_alts = alts[data->sco_num - 1];
1686			} else {
1687				new_alts = data->sco_num;
1688			}
1689		} else if (data->air_mode == HCI_NOTIFY_ENABLE_SCO_TRANSP) {
1690			/* Check if Alt 6 is supported for Transparent audio */
1691			if (btusb_find_altsetting(data, 6)) {
1692				data->usb_alt6_packet_flow = true;
1693				new_alts = 6;
1694			} else if (test_bit(BTUSB_USE_ALT1_FOR_WBS, &data->flags)) {
1695				new_alts = 1;
1696			} else {
1697				bt_dev_err(hdev, "Device does not support ALT setting 6");
1698			}
1699		}
1700
1701		if (btusb_switch_alt_setting(hdev, new_alts) < 0)
1702			bt_dev_err(hdev, "set USB alt:(%d) failed!", new_alts);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1703	} else {
1704		clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1705		usb_kill_anchored_urbs(&data->isoc_anchor);
1706
1707		__set_isoc_interface(hdev, 0);
1708		if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
1709			usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
1710	}
1711}
1712
1713static void btusb_waker(struct work_struct *work)
1714{
1715	struct btusb_data *data = container_of(work, struct btusb_data, waker);
1716	int err;
1717
1718	err = usb_autopm_get_interface(data->intf);
1719	if (err < 0)
1720		return;
1721
1722	usb_autopm_put_interface(data->intf);
1723}
1724
1725static int btusb_setup_bcm92035(struct hci_dev *hdev)
1726{
1727	struct sk_buff *skb;
1728	u8 val = 0x00;
1729
1730	BT_DBG("%s", hdev->name);
1731
1732	skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);
1733	if (IS_ERR(skb))
1734		bt_dev_err(hdev, "BCM92035 command failed (%ld)", PTR_ERR(skb));
1735	else
1736		kfree_skb(skb);
1737
1738	return 0;
1739}
1740
1741static int btusb_setup_csr(struct hci_dev *hdev)
1742{
1743	struct hci_rp_read_local_version *rp;
1744	struct sk_buff *skb;
1745	bool is_fake = false;
1746
1747	BT_DBG("%s", hdev->name);
1748
1749	skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1750			     HCI_INIT_TIMEOUT);
1751	if (IS_ERR(skb)) {
1752		int err = PTR_ERR(skb);
1753		bt_dev_err(hdev, "CSR: Local version failed (%d)", err);
1754		return err;
1755	}
1756
1757	if (skb->len != sizeof(struct hci_rp_read_local_version)) {
1758		bt_dev_err(hdev, "CSR: Local version length mismatch");
1759		kfree_skb(skb);
1760		return -EIO;
1761	}
1762
1763	rp = (struct hci_rp_read_local_version *)skb->data;
1764
1765	/* Detect a wide host of Chinese controllers that aren't CSR.
1766	 *
1767	 * Known fake bcdDevices: 0x0100, 0x0134, 0x1915, 0x2520, 0x7558, 0x8891
1768	 *
1769	 * The main thing they have in common is that these are really popular low-cost
1770	 * options that support newer Bluetooth versions but rely on heavy VID/PID
1771	 * squatting of this poor old Bluetooth 1.1 device. Even sold as such.
1772	 *
1773	 * We detect actual CSR devices by checking that the HCI manufacturer code
1774	 * is Cambridge Silicon Radio (10) and ensuring that LMP sub-version and
1775	 * HCI rev values always match. As they both store the firmware number.
1776	 */
1777	if (le16_to_cpu(rp->manufacturer) != 10 ||
1778	    le16_to_cpu(rp->hci_rev) != le16_to_cpu(rp->lmp_subver))
1779		is_fake = true;
1780
1781	/* Known legit CSR firmware build numbers and their supported BT versions:
1782	 * - 1.1 (0x1) -> 0x0073, 0x020d, 0x033c, 0x034e
1783	 * - 1.2 (0x2) ->                 0x04d9, 0x0529
1784	 * - 2.0 (0x3) ->         0x07a6, 0x07ad, 0x0c5c
1785	 * - 2.1 (0x4) ->         0x149c, 0x1735, 0x1899 (0x1899 is a BlueCore4-External)
1786	 * - 4.0 (0x6) ->         0x1d86, 0x2031, 0x22bb
1787	 *
1788	 * e.g. Real CSR dongles with LMP subversion 0x73 are old enough that
1789	 *      support BT 1.1 only; so it's a dead giveaway when some
1790	 *      third-party BT 4.0 dongle reuses it.
1791	 */
1792	else if (le16_to_cpu(rp->lmp_subver) <= 0x034e &&
1793		 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_1_1)
1794		is_fake = true;
1795
1796	else if (le16_to_cpu(rp->lmp_subver) <= 0x0529 &&
1797		 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_1_2)
1798		is_fake = true;
1799
1800	else if (le16_to_cpu(rp->lmp_subver) <= 0x0c5c &&
1801		 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_2_0)
1802		is_fake = true;
1803
1804	else if (le16_to_cpu(rp->lmp_subver) <= 0x1899 &&
1805		 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_2_1)
1806		is_fake = true;
1807
1808	else if (le16_to_cpu(rp->lmp_subver) <= 0x22bb &&
1809		 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_4_0)
1810		is_fake = true;
1811
1812	if (is_fake) {
1813		bt_dev_warn(hdev, "CSR: Unbranded CSR clone detected; adding workarounds...");
1814
1815		/* Generally these clones have big discrepancies between
1816		 * advertised features and what's actually supported.
1817		 * Probably will need to be expanded in the future;
1818		 * without these the controller will lock up.
1819		 */
1820		set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
1821		set_bit(HCI_QUIRK_BROKEN_ERR_DATA_REPORTING, &hdev->quirks);
1822
1823		/* Clear the reset quirk since this is not an actual
1824		 * early Bluetooth 1.1 device from CSR.
1825		 */
1826		clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
1827		clear_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
 
 
 
 
1828	}
1829
1830	kfree_skb(skb);
1831
1832	return 0;
1833}
1834
1835static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev,
1836						       struct intel_version *ver)
1837{
1838	const struct firmware *fw;
1839	char fwname[64];
1840	int ret;
1841
1842	snprintf(fwname, sizeof(fwname),
1843		 "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq",
1844		 ver->hw_platform, ver->hw_variant, ver->hw_revision,
1845		 ver->fw_variant,  ver->fw_revision, ver->fw_build_num,
1846		 ver->fw_build_ww, ver->fw_build_yy);
1847
1848	ret = request_firmware(&fw, fwname, &hdev->dev);
1849	if (ret < 0) {
1850		if (ret == -EINVAL) {
1851			bt_dev_err(hdev, "Intel firmware file request failed (%d)",
1852				   ret);
1853			return NULL;
1854		}
1855
1856		bt_dev_err(hdev, "failed to open Intel firmware file: %s (%d)",
1857			   fwname, ret);
1858
1859		/* If the correct firmware patch file is not found, use the
1860		 * default firmware patch file instead
1861		 */
1862		snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq",
1863			 ver->hw_platform, ver->hw_variant);
1864		if (request_firmware(&fw, fwname, &hdev->dev) < 0) {
1865			bt_dev_err(hdev, "failed to open default fw file: %s",
1866				   fwname);
1867			return NULL;
1868		}
1869	}
1870
1871	bt_dev_info(hdev, "Intel Bluetooth firmware file: %s", fwname);
1872
1873	return fw;
1874}
1875
1876static int btusb_setup_intel_patching(struct hci_dev *hdev,
1877				      const struct firmware *fw,
1878				      const u8 **fw_ptr, int *disable_patch)
1879{
1880	struct sk_buff *skb;
1881	struct hci_command_hdr *cmd;
1882	const u8 *cmd_param;
1883	struct hci_event_hdr *evt = NULL;
1884	const u8 *evt_param = NULL;
1885	int remain = fw->size - (*fw_ptr - fw->data);
1886
1887	/* The first byte indicates the types of the patch command or event.
1888	 * 0x01 means HCI command and 0x02 is HCI event. If the first bytes
1889	 * in the current firmware buffer doesn't start with 0x01 or
1890	 * the size of remain buffer is smaller than HCI command header,
1891	 * the firmware file is corrupted and it should stop the patching
1892	 * process.
1893	 */
1894	if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) {
1895		bt_dev_err(hdev, "Intel fw corrupted: invalid cmd read");
1896		return -EINVAL;
1897	}
1898	(*fw_ptr)++;
1899	remain--;
1900
1901	cmd = (struct hci_command_hdr *)(*fw_ptr);
1902	*fw_ptr += sizeof(*cmd);
1903	remain -= sizeof(*cmd);
1904
1905	/* Ensure that the remain firmware data is long enough than the length
1906	 * of command parameter. If not, the firmware file is corrupted.
1907	 */
1908	if (remain < cmd->plen) {
1909		bt_dev_err(hdev, "Intel fw corrupted: invalid cmd len");
1910		return -EFAULT;
1911	}
1912
1913	/* If there is a command that loads a patch in the firmware
1914	 * file, then enable the patch upon success, otherwise just
1915	 * disable the manufacturer mode, for example patch activation
1916	 * is not required when the default firmware patch file is used
1917	 * because there are no patch data to load.
1918	 */
1919	if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e)
1920		*disable_patch = 0;
1921
1922	cmd_param = *fw_ptr;
1923	*fw_ptr += cmd->plen;
1924	remain -= cmd->plen;
1925
1926	/* This reads the expected events when the above command is sent to the
1927	 * device. Some vendor commands expects more than one events, for
1928	 * example command status event followed by vendor specific event.
1929	 * For this case, it only keeps the last expected event. so the command
1930	 * can be sent with __hci_cmd_sync_ev() which returns the sk_buff of
1931	 * last expected event.
1932	 */
1933	while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) {
1934		(*fw_ptr)++;
1935		remain--;
1936
1937		evt = (struct hci_event_hdr *)(*fw_ptr);
1938		*fw_ptr += sizeof(*evt);
1939		remain -= sizeof(*evt);
1940
1941		if (remain < evt->plen) {
1942			bt_dev_err(hdev, "Intel fw corrupted: invalid evt len");
 
1943			return -EFAULT;
1944		}
1945
1946		evt_param = *fw_ptr;
1947		*fw_ptr += evt->plen;
1948		remain -= evt->plen;
1949	}
1950
1951	/* Every HCI commands in the firmware file has its correspond event.
1952	 * If event is not found or remain is smaller than zero, the firmware
1953	 * file is corrupted.
1954	 */
1955	if (!evt || !evt_param || remain < 0) {
1956		bt_dev_err(hdev, "Intel fw corrupted: invalid evt read");
1957		return -EFAULT;
1958	}
1959
1960	skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen,
1961				cmd_param, evt->evt, HCI_INIT_TIMEOUT);
1962	if (IS_ERR(skb)) {
1963		bt_dev_err(hdev, "sending Intel patch command (0x%4.4x) failed (%ld)",
1964			   cmd->opcode, PTR_ERR(skb));
1965		return PTR_ERR(skb);
1966	}
1967
1968	/* It ensures that the returned event matches the event data read from
1969	 * the firmware file. At fist, it checks the length and then
1970	 * the contents of the event.
1971	 */
1972	if (skb->len != evt->plen) {
1973		bt_dev_err(hdev, "mismatch event length (opcode 0x%4.4x)",
1974			   le16_to_cpu(cmd->opcode));
1975		kfree_skb(skb);
1976		return -EFAULT;
1977	}
1978
1979	if (memcmp(skb->data, evt_param, evt->plen)) {
1980		bt_dev_err(hdev, "mismatch event parameter (opcode 0x%4.4x)",
1981			   le16_to_cpu(cmd->opcode));
1982		kfree_skb(skb);
1983		return -EFAULT;
1984	}
1985	kfree_skb(skb);
1986
1987	return 0;
1988}
1989
1990static int btusb_setup_intel(struct hci_dev *hdev)
1991{
1992	struct sk_buff *skb;
1993	const struct firmware *fw;
1994	const u8 *fw_ptr;
1995	int disable_patch, err;
1996	struct intel_version ver;
1997
1998	BT_DBG("%s", hdev->name);
1999
2000	/* The controller has a bug with the first HCI command sent to it
2001	 * returning number of completed commands as zero. This would stall the
2002	 * command processing in the Bluetooth core.
2003	 *
2004	 * As a workaround, send HCI Reset command first which will reset the
2005	 * number of completed commands and allow normal command processing
2006	 * from now on.
2007	 */
2008	skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
2009	if (IS_ERR(skb)) {
2010		bt_dev_err(hdev, "sending initial HCI reset command failed (%ld)",
2011			   PTR_ERR(skb));
2012		return PTR_ERR(skb);
2013	}
2014	kfree_skb(skb);
2015
2016	/* Read Intel specific controller version first to allow selection of
2017	 * which firmware file to load.
2018	 *
2019	 * The returned information are hardware variant and revision plus
2020	 * firmware variant, revision and build number.
2021	 */
2022	err = btintel_read_version(hdev, &ver);
2023	if (err)
2024		return err;
2025
2026	bt_dev_info(hdev, "read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x",
2027		    ver.hw_platform, ver.hw_variant, ver.hw_revision,
2028		    ver.fw_variant,  ver.fw_revision, ver.fw_build_num,
2029		    ver.fw_build_ww, ver.fw_build_yy, ver.fw_patch_num);
2030
2031	/* fw_patch_num indicates the version of patch the device currently
2032	 * have. If there is no patch data in the device, it is always 0x00.
2033	 * So, if it is other than 0x00, no need to patch the device again.
2034	 */
2035	if (ver.fw_patch_num) {
2036		bt_dev_info(hdev, "Intel device is already patched. "
2037			    "patch num: %02x", ver.fw_patch_num);
2038		goto complete;
2039	}
2040
2041	/* Opens the firmware patch file based on the firmware version read
2042	 * from the controller. If it fails to open the matching firmware
2043	 * patch file, it tries to open the default firmware patch file.
2044	 * If no patch file is found, allow the device to operate without
2045	 * a patch.
2046	 */
2047	fw = btusb_setup_intel_get_fw(hdev, &ver);
2048	if (!fw)
2049		goto complete;
2050	fw_ptr = fw->data;
2051
2052	/* Enable the manufacturer mode of the controller.
2053	 * Only while this mode is enabled, the driver can download the
2054	 * firmware patch data and configuration parameters.
2055	 */
2056	err = btintel_enter_mfg(hdev);
2057	if (err) {
2058		release_firmware(fw);
2059		return err;
2060	}
2061
2062	disable_patch = 1;
2063
2064	/* The firmware data file consists of list of Intel specific HCI
2065	 * commands and its expected events. The first byte indicates the
2066	 * type of the message, either HCI command or HCI event.
2067	 *
2068	 * It reads the command and its expected event from the firmware file,
2069	 * and send to the controller. Once __hci_cmd_sync_ev() returns,
2070	 * the returned event is compared with the event read from the firmware
2071	 * file and it will continue until all the messages are downloaded to
2072	 * the controller.
2073	 *
2074	 * Once the firmware patching is completed successfully,
2075	 * the manufacturer mode is disabled with reset and activating the
2076	 * downloaded patch.
2077	 *
2078	 * If the firmware patching fails, the manufacturer mode is
2079	 * disabled with reset and deactivating the patch.
2080	 *
2081	 * If the default patch file is used, no reset is done when disabling
2082	 * the manufacturer.
2083	 */
2084	while (fw->size > fw_ptr - fw->data) {
2085		int ret;
2086
2087		ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr,
2088						 &disable_patch);
2089		if (ret < 0)
2090			goto exit_mfg_deactivate;
2091	}
2092
2093	release_firmware(fw);
2094
2095	if (disable_patch)
2096		goto exit_mfg_disable;
2097
2098	/* Patching completed successfully and disable the manufacturer mode
2099	 * with reset and activate the downloaded firmware patches.
2100	 */
2101	err = btintel_exit_mfg(hdev, true, true);
2102	if (err)
2103		return err;
2104
2105	/* Need build number for downloaded fw patches in
2106	 * every power-on boot
2107	 */
2108       err = btintel_read_version(hdev, &ver);
2109       if (err)
2110               return err;
2111       bt_dev_info(hdev, "Intel BT fw patch 0x%02x completed & activated",
2112		   ver.fw_patch_num);
2113
2114	goto complete;
2115
2116exit_mfg_disable:
2117	/* Disable the manufacturer mode without reset */
2118	err = btintel_exit_mfg(hdev, false, false);
2119	if (err)
2120		return err;
2121
2122	bt_dev_info(hdev, "Intel firmware patch completed");
2123
2124	goto complete;
2125
2126exit_mfg_deactivate:
2127	release_firmware(fw);
2128
2129	/* Patching failed. Disable the manufacturer mode with reset and
2130	 * deactivate the downloaded firmware patches.
2131	 */
2132	err = btintel_exit_mfg(hdev, true, false);
2133	if (err)
2134		return err;
2135
2136	bt_dev_info(hdev, "Intel firmware patch completed and deactivated");
 
2137
2138complete:
2139	/* Set the event mask for Intel specific vendor events. This enables
2140	 * a few extra events that are useful during general operation.
2141	 */
2142	btintel_set_event_mask_mfg(hdev, false);
2143
2144	btintel_check_bdaddr(hdev);
2145	return 0;
2146}
2147
2148static int inject_cmd_complete(struct hci_dev *hdev, __u16 opcode)
2149{
2150	struct sk_buff *skb;
2151	struct hci_event_hdr *hdr;
2152	struct hci_ev_cmd_complete *evt;
2153
2154	skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_KERNEL);
2155	if (!skb)
2156		return -ENOMEM;
2157
2158	hdr = skb_put(skb, sizeof(*hdr));
2159	hdr->evt = HCI_EV_CMD_COMPLETE;
2160	hdr->plen = sizeof(*evt) + 1;
2161
2162	evt = skb_put(skb, sizeof(*evt));
2163	evt->ncmd = 0x01;
2164	evt->opcode = cpu_to_le16(opcode);
2165
2166	skb_put_u8(skb, 0x00);
2167
2168	hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
2169
2170	return hci_recv_frame(hdev, skb);
2171}
2172
2173static int btusb_recv_bulk_intel(struct btusb_data *data, void *buffer,
2174				 int count)
2175{
2176	/* When the device is in bootloader mode, then it can send
2177	 * events via the bulk endpoint. These events are treated the
2178	 * same way as the ones received from the interrupt endpoint.
2179	 */
2180	if (test_bit(BTUSB_BOOTLOADER, &data->flags))
2181		return btusb_recv_intr(data, buffer, count);
2182
2183	return btusb_recv_bulk(data, buffer, count);
2184}
2185
2186static void btusb_intel_bootup(struct btusb_data *data, const void *ptr,
2187			       unsigned int len)
2188{
2189	const struct intel_bootup *evt = ptr;
2190
2191	if (len != sizeof(*evt))
2192		return;
2193
2194	if (test_and_clear_bit(BTUSB_BOOTING, &data->flags))
 
2195		wake_up_bit(&data->flags, BTUSB_BOOTING);
 
2196}
2197
2198static void btusb_intel_secure_send_result(struct btusb_data *data,
2199					   const void *ptr, unsigned int len)
2200{
2201	const struct intel_secure_send_result *evt = ptr;
2202
2203	if (len != sizeof(*evt))
2204		return;
2205
2206	if (evt->result)
2207		set_bit(BTUSB_FIRMWARE_FAILED, &data->flags);
2208
2209	if (test_and_clear_bit(BTUSB_DOWNLOADING, &data->flags) &&
2210	    test_bit(BTUSB_FIRMWARE_LOADED, &data->flags))
 
2211		wake_up_bit(&data->flags, BTUSB_DOWNLOADING);
 
2212}
2213
2214static int btusb_recv_event_intel(struct hci_dev *hdev, struct sk_buff *skb)
2215{
2216	struct btusb_data *data = hci_get_drvdata(hdev);
2217
2218	if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2219		struct hci_event_hdr *hdr = (void *)skb->data;
2220
2221		if (skb->len > HCI_EVENT_HDR_SIZE && hdr->evt == 0xff &&
2222		    hdr->plen > 0) {
2223			const void *ptr = skb->data + HCI_EVENT_HDR_SIZE + 1;
2224			unsigned int len = skb->len - HCI_EVENT_HDR_SIZE - 1;
2225
2226			switch (skb->data[2]) {
2227			case 0x02:
2228				/* When switching to the operational firmware
2229				 * the device sends a vendor specific event
2230				 * indicating that the bootup completed.
2231				 */
2232				btusb_intel_bootup(data, ptr, len);
2233				break;
2234			case 0x06:
2235				/* When the firmware loading completes the
2236				 * device sends out a vendor specific event
2237				 * indicating the result of the firmware
2238				 * loading.
2239				 */
2240				btusb_intel_secure_send_result(data, ptr, len);
2241				break;
2242			}
2243		}
2244	}
2245
2246	return hci_recv_frame(hdev, skb);
2247}
2248
2249static int btusb_send_frame_intel(struct hci_dev *hdev, struct sk_buff *skb)
2250{
2251	struct btusb_data *data = hci_get_drvdata(hdev);
2252	struct urb *urb;
2253
2254	BT_DBG("%s", hdev->name);
2255
2256	switch (hci_skb_pkt_type(skb)) {
2257	case HCI_COMMAND_PKT:
2258		if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2259			struct hci_command_hdr *cmd = (void *)skb->data;
2260			__u16 opcode = le16_to_cpu(cmd->opcode);
2261
2262			/* When in bootloader mode and the command 0xfc09
2263			 * is received, it needs to be send down the
2264			 * bulk endpoint. So allocate a bulk URB instead.
2265			 */
2266			if (opcode == 0xfc09)
2267				urb = alloc_bulk_urb(hdev, skb);
2268			else
2269				urb = alloc_ctrl_urb(hdev, skb);
2270
2271			/* When the 0xfc01 command is issued to boot into
2272			 * the operational firmware, it will actually not
2273			 * send a command complete event. To keep the flow
2274			 * control working inject that event here.
2275			 */
2276			if (opcode == 0xfc01)
2277				inject_cmd_complete(hdev, opcode);
2278		} else {
2279			urb = alloc_ctrl_urb(hdev, skb);
2280		}
2281		if (IS_ERR(urb))
2282			return PTR_ERR(urb);
2283
2284		hdev->stat.cmd_tx++;
2285		return submit_or_queue_tx_urb(hdev, urb);
2286
2287	case HCI_ACLDATA_PKT:
2288		urb = alloc_bulk_urb(hdev, skb);
2289		if (IS_ERR(urb))
2290			return PTR_ERR(urb);
2291
2292		hdev->stat.acl_tx++;
2293		return submit_or_queue_tx_urb(hdev, urb);
2294
2295	case HCI_SCODATA_PKT:
2296		if (hci_conn_num(hdev, SCO_LINK) < 1)
2297			return -ENODEV;
2298
2299		urb = alloc_isoc_urb(hdev, skb);
2300		if (IS_ERR(urb))
2301			return PTR_ERR(urb);
2302
2303		hdev->stat.sco_tx++;
2304		return submit_tx_urb(hdev, urb);
2305	}
2306
2307	return -EILSEQ;
2308}
2309
2310static bool btusb_setup_intel_new_get_fw_name(struct intel_version *ver,
2311					     struct intel_boot_params *params,
2312					     char *fw_name, size_t len,
2313					     const char *suffix)
2314{
2315	switch (ver->hw_variant) {
2316	case 0x0b:	/* SfP */
2317	case 0x0c:	/* WsP */
2318		snprintf(fw_name, len, "intel/ibt-%u-%u.%s",
2319			le16_to_cpu(ver->hw_variant),
2320			le16_to_cpu(params->dev_revid),
2321			suffix);
2322		break;
2323	case 0x11:	/* JfP */
2324	case 0x12:	/* ThP */
2325	case 0x13:	/* HrP */
2326	case 0x14:	/* CcP */
2327		snprintf(fw_name, len, "intel/ibt-%u-%u-%u.%s",
2328			le16_to_cpu(ver->hw_variant),
2329			le16_to_cpu(ver->hw_revision),
2330			le16_to_cpu(ver->fw_revision),
2331			suffix);
2332		break;
2333	default:
2334		return false;
2335	}
2336	return true;
2337}
2338
2339static int btusb_intel_download_firmware(struct hci_dev *hdev,
2340					 struct intel_version *ver,
2341					 struct intel_boot_params *params)
2342{
 
 
 
 
 
 
2343	const struct firmware *fw;
2344	u32 boot_param;
 
2345	char fwname[64];
 
 
2346	int err;
2347	struct btusb_data *data = hci_get_drvdata(hdev);
2348
2349	if (!ver || !params)
2350		return -EINVAL;
 
 
 
 
 
 
 
 
 
2351
2352	/* The hardware platform number has a fixed value of 0x37 and
2353	 * for now only accept this single value.
2354	 */
2355	if (ver->hw_platform != 0x37) {
2356		bt_dev_err(hdev, "Unsupported Intel hardware platform (%u)",
2357			   ver->hw_platform);
2358		return -EINVAL;
2359	}
2360
2361	/* Check for supported iBT hardware variants of this firmware
2362	 * loading method.
2363	 *
2364	 * This check has been put in place to ensure correct forward
2365	 * compatibility options when newer hardware variants come along.
2366	 */
2367	switch (ver->hw_variant) {
2368	case 0x0b:	/* SfP */
2369	case 0x0c:	/* WsP */
2370	case 0x11:	/* JfP */
2371	case 0x12:	/* ThP */
2372	case 0x13:	/* HrP */
2373	case 0x14:	/* CcP */
2374		break;
2375	default:
2376		bt_dev_err(hdev, "Unsupported Intel hardware variant (%u)",
2377			   ver->hw_variant);
2378		return -EINVAL;
2379	}
2380
2381	btintel_version_info(hdev, ver);
2382
2383	/* The firmware variant determines if the device is in bootloader
2384	 * mode or is running operational firmware. The value 0x06 identifies
2385	 * the bootloader and the value 0x23 identifies the operational
2386	 * firmware.
2387	 *
2388	 * When the operational firmware is already present, then only
2389	 * the check for valid Bluetooth device address is needed. This
2390	 * determines if the device will be added as configured or
2391	 * unconfigured controller.
2392	 *
2393	 * It is not possible to use the Secure Boot Parameters in this
2394	 * case since that command is only available in bootloader mode.
2395	 */
2396	if (ver->fw_variant == 0x23) {
2397		clear_bit(BTUSB_BOOTLOADER, &data->flags);
2398		btintel_check_bdaddr(hdev);
2399		return 0;
2400	}
2401
2402	/* If the device is not in bootloader mode, then the only possible
2403	 * choice is to return an error and abort the device initialization.
2404	 */
2405	if (ver->fw_variant != 0x06) {
2406		bt_dev_err(hdev, "Unsupported Intel firmware variant (%u)",
2407			   ver->fw_variant);
2408		return -ENODEV;
2409	}
2410
2411	/* Read the secure boot parameters to identify the operating
2412	 * details of the bootloader.
2413	 */
2414	err = btintel_read_boot_params(hdev, params);
2415	if (err)
2416		return err;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2417
2418	/* It is required that every single firmware fragment is acknowledged
2419	 * with a command complete event. If the boot parameters indicate
2420	 * that this bootloader does not send them, then abort the setup.
2421	 */
2422	if (params->limited_cce != 0x00) {
2423		bt_dev_err(hdev, "Unsupported Intel firmware loading method (%u)",
2424			   params->limited_cce);
 
2425		return -EINVAL;
2426	}
2427
2428	/* If the OTP has no valid Bluetooth device address, then there will
2429	 * also be no valid address for the operational firmware.
2430	 */
2431	if (!bacmp(&params->otp_bdaddr, BDADDR_ANY)) {
2432		bt_dev_info(hdev, "No device address configured");
2433		set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
2434	}
2435
2436	/* With this Intel bootloader only the hardware variant and device
2437	 * revision information are used to select the right firmware for SfP
2438	 * and WsP.
2439	 *
2440	 * The firmware filename is ibt-<hw_variant>-<dev_revid>.sfi.
2441	 *
2442	 * Currently the supported hardware variants are:
2443	 *   11 (0x0b) for iBT3.0 (LnP/SfP)
2444	 *   12 (0x0c) for iBT3.5 (WsP)
2445	 *
2446	 * For ThP/JfP and for future SKU's, the FW name varies based on HW
2447	 * variant, HW revision and FW revision, as these are dependent on CNVi
2448	 * and RF Combination.
2449	 *
2450	 *   17 (0x11) for iBT3.5 (JfP)
2451	 *   18 (0x12) for iBT3.5 (ThP)
2452	 *
2453	 * The firmware file name for these will be
2454	 * ibt-<hw_variant>-<hw_revision>-<fw_revision>.sfi.
2455	 *
 
 
2456	 */
2457	err = btusb_setup_intel_new_get_fw_name(ver, params, fwname,
2458						sizeof(fwname), "sfi");
2459	if (!err) {
2460		bt_dev_err(hdev, "Unsupported Intel firmware naming");
2461		return -EINVAL;
2462	}
2463
2464	err = request_firmware(&fw, fwname, &hdev->dev);
2465	if (err < 0) {
2466		bt_dev_err(hdev, "Failed to load Intel firmware file (%d)", err);
 
 
2467		return err;
2468	}
2469
2470	bt_dev_info(hdev, "Found device firmware: %s", fwname);
 
 
 
 
 
 
 
 
2471
2472	if (fw->size < 644) {
2473		bt_dev_err(hdev, "Invalid size of firmware file (%zu)",
2474			   fw->size);
2475		err = -EBADF;
2476		goto done;
2477	}
2478
2479	set_bit(BTUSB_DOWNLOADING, &data->flags);
2480
2481	/* Start firmware downloading and get boot parameter */
2482	err = btintel_download_firmware(hdev, fw, &boot_param);
 
 
2483	if (err < 0) {
2484		/* When FW download fails, send Intel Reset to retry
2485		 * FW download.
2486		 */
2487		btintel_reset_to_bootloader(hdev);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2488		goto done;
2489	}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2490	set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2491
2492	bt_dev_info(hdev, "Waiting for firmware download to complete");
2493
2494	/* Before switching the device into operational mode and with that
2495	 * booting the loaded firmware, wait for the bootloader notification
2496	 * that all fragments have been successfully received.
2497	 *
2498	 * When the event processing receives the notification, then the
2499	 * BTUSB_DOWNLOADING flag will be cleared.
2500	 *
2501	 * The firmware loading should not take longer than 5 seconds
2502	 * and thus just timeout if that happens and fail the setup
2503	 * of this device.
2504	 */
2505	err = wait_on_bit_timeout(&data->flags, BTUSB_DOWNLOADING,
2506				  TASK_INTERRUPTIBLE,
2507				  msecs_to_jiffies(5000));
2508	if (err == -EINTR) {
2509		bt_dev_err(hdev, "Firmware loading interrupted");
 
2510		goto done;
2511	}
2512
2513	if (err) {
2514		bt_dev_err(hdev, "Firmware loading timeout");
2515		err = -ETIMEDOUT;
2516		btintel_reset_to_bootloader(hdev);
2517		goto done;
2518	}
2519
2520	if (test_bit(BTUSB_FIRMWARE_FAILED, &data->flags)) {
2521		bt_dev_err(hdev, "Firmware loading failed");
2522		err = -ENOEXEC;
2523		goto done;
2524	}
2525
2526done:
2527	release_firmware(fw);
2528	return err;
2529}
2530
2531static int btusb_setup_intel_new(struct hci_dev *hdev)
2532{
2533	struct btusb_data *data = hci_get_drvdata(hdev);
2534	struct intel_version ver;
2535	struct intel_boot_params params;
2536	u32 boot_param;
2537	char ddcname[64];
2538	ktime_t calltime, delta, rettime;
2539	unsigned long long duration;
2540	int err;
2541	struct intel_debug_features features;
2542
2543	BT_DBG("%s", hdev->name);
2544
2545	/* Set the default boot parameter to 0x0 and it is updated to
2546	 * SKU specific boot parameter after reading Intel_Write_Boot_Params
2547	 * command while downloading the firmware.
2548	 */
2549	boot_param = 0x00000000;
2550
2551	calltime = ktime_get();
2552
2553	/* Read the Intel version information to determine if the device
2554	 * is in bootloader mode or if it already has operational firmware
2555	 * loaded.
2556	 */
2557	err = btintel_read_version(hdev, &ver);
2558	if (err) {
2559		bt_dev_err(hdev, "Intel Read version failed (%d)", err);
2560		btintel_reset_to_bootloader(hdev);
2561		return err;
2562	}
2563
2564	err = btusb_intel_download_firmware(hdev, &ver, &params);
2565	if (err)
2566		return err;
2567
2568	/* controller is already having an operational firmware */
2569	if (ver.fw_variant == 0x23)
2570		goto finish;
2571
2572	rettime = ktime_get();
2573	delta = ktime_sub(rettime, calltime);
2574	duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2575
2576	bt_dev_info(hdev, "Firmware loaded in %llu usecs", duration);
 
 
 
 
 
 
2577
2578	calltime = ktime_get();
2579
2580	set_bit(BTUSB_BOOTING, &data->flags);
2581
2582	err = btintel_send_intel_reset(hdev, boot_param);
2583	if (err) {
2584		bt_dev_err(hdev, "Intel Soft Reset failed (%d)", err);
2585		btintel_reset_to_bootloader(hdev);
2586		return err;
2587	}
2588
2589	/* The bootloader will not indicate when the device is ready. This
2590	 * is done by the operational firmware sending bootup notification.
2591	 *
2592	 * Booting into operational firmware should not take longer than
2593	 * 1 second. However if that happens, then just fail the setup
2594	 * since something went wrong.
2595	 */
2596	bt_dev_info(hdev, "Waiting for device to boot");
2597
2598	err = wait_on_bit_timeout(&data->flags, BTUSB_BOOTING,
2599				  TASK_INTERRUPTIBLE,
2600				  msecs_to_jiffies(1000));
2601
2602	if (err == -EINTR) {
2603		bt_dev_err(hdev, "Device boot interrupted");
2604		return -EINTR;
2605	}
2606
2607	if (err) {
2608		bt_dev_err(hdev, "Device boot timeout");
2609		btintel_reset_to_bootloader(hdev);
2610		return -ETIMEDOUT;
2611	}
2612
2613	rettime = ktime_get();
2614	delta = ktime_sub(rettime, calltime);
2615	duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2616
2617	bt_dev_info(hdev, "Device booted in %llu usecs", duration);
2618
2619	clear_bit(BTUSB_BOOTLOADER, &data->flags);
2620
2621	err = btusb_setup_intel_new_get_fw_name(&ver, &params, ddcname,
2622						sizeof(ddcname), "ddc");
2623
2624	if (!err) {
2625		bt_dev_err(hdev, "Unsupported Intel firmware naming");
2626	} else {
2627		/* Once the device is running in operational mode, it needs to
2628		 * apply the device configuration (DDC) parameters.
2629		 *
2630		 * The device can work without DDC parameters, so even if it
2631		 * fails to load the file, no need to fail the setup.
2632		 */
2633		btintel_load_ddc_config(hdev, ddcname);
2634	}
2635
2636	/* Read the Intel supported features and if new exception formats
2637	 * supported, need to load the additional DDC config to enable.
2638	 */
2639	btintel_read_debug_features(hdev, &features);
2640
2641	/* Set DDC mask for available debug features */
2642	btintel_set_debug_features(hdev, &features);
2643
2644	/* Read the Intel version information after loading the FW  */
2645	err = btintel_read_version(hdev, &ver);
2646	if (err)
2647		return err;
2648
2649	btintel_version_info(hdev, &ver);
2650
2651finish:
2652	/* All Intel controllers that support the Microsoft vendor
2653	 * extension are using 0xFC1E for VsMsftOpCode.
2654	 */
2655	switch (ver.hw_variant) {
2656	case 0x12:	/* ThP */
2657		hci_set_msft_opcode(hdev, 0xFC1E);
2658		break;
2659	}
2660
2661	/* Set the event mask for Intel specific vendor events. This enables
2662	 * a few extra events that are useful during general operation. It
2663	 * does not enable any debugging related events.
2664	 *
2665	 * The device will function correctly without these events enabled
2666	 * and thus no need to fail the setup.
2667	 */
2668	btintel_set_event_mask(hdev, false);
2669
2670	return 0;
2671}
2672
2673static int btusb_shutdown_intel(struct hci_dev *hdev)
2674{
2675	struct sk_buff *skb;
2676	long ret;
2677
2678	/* In the shutdown sequence where Bluetooth is turned off followed
2679	 * by WiFi being turned off, turning WiFi back on causes issue with
2680	 * the RF calibration.
2681	 *
2682	 * To ensure that any RF activity has been stopped, issue HCI Reset
2683	 * command to clear all ongoing activity including advertising,
2684	 * scanning etc.
2685	 */
2686	skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
2687	if (IS_ERR(skb)) {
2688		ret = PTR_ERR(skb);
2689		bt_dev_err(hdev, "HCI reset during shutdown failed");
2690		return ret;
2691	}
2692	kfree_skb(skb);
2693
2694	/* Some platforms have an issue with BT LED when the interface is
2695	 * down or BT radio is turned off, which takes 5 seconds to BT LED
2696	 * goes off. This command turns off the BT LED immediately.
2697	 */
2698	skb = __hci_cmd_sync(hdev, 0xfc3f, 0, NULL, HCI_INIT_TIMEOUT);
2699	if (IS_ERR(skb)) {
2700		ret = PTR_ERR(skb);
2701		bt_dev_err(hdev, "turning off Intel device LED failed");
 
2702		return ret;
2703	}
2704	kfree_skb(skb);
2705
2706	return 0;
2707}
2708
2709static int btusb_shutdown_intel_new(struct hci_dev *hdev)
2710{
2711	struct sk_buff *skb;
2712
2713	/* Send HCI Reset to the controller to stop any BT activity which
2714	 * were triggered. This will help to save power and maintain the
2715	 * sync b/w Host and controller
2716	 */
2717	skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
2718	if (IS_ERR(skb)) {
2719		bt_dev_err(hdev, "HCI reset during shutdown failed");
2720		return PTR_ERR(skb);
2721	}
2722	kfree_skb(skb);
2723
2724	return 0;
2725}
2726
2727#define FIRMWARE_MT7663		"mediatek/mt7663pr2h.bin"
2728#define FIRMWARE_MT7668		"mediatek/mt7668pr2h.bin"
2729
2730#define HCI_WMT_MAX_EVENT_SIZE		64
2731
2732enum {
2733	BTMTK_WMT_PATCH_DWNLD = 0x1,
2734	BTMTK_WMT_FUNC_CTRL = 0x6,
2735	BTMTK_WMT_RST = 0x7,
2736	BTMTK_WMT_SEMAPHORE = 0x17,
2737};
2738
2739enum {
2740	BTMTK_WMT_INVALID,
2741	BTMTK_WMT_PATCH_UNDONE,
2742	BTMTK_WMT_PATCH_DONE,
2743	BTMTK_WMT_ON_UNDONE,
2744	BTMTK_WMT_ON_DONE,
2745	BTMTK_WMT_ON_PROGRESS,
2746};
2747
2748struct btmtk_wmt_hdr {
2749	u8	dir;
2750	u8	op;
2751	__le16	dlen;
2752	u8	flag;
2753} __packed;
2754
2755struct btmtk_hci_wmt_cmd {
2756	struct btmtk_wmt_hdr hdr;
2757	u8 data[256];
2758} __packed;
2759
2760struct btmtk_hci_wmt_evt {
2761	struct hci_event_hdr hhdr;
2762	struct btmtk_wmt_hdr whdr;
2763} __packed;
2764
2765struct btmtk_hci_wmt_evt_funcc {
2766	struct btmtk_hci_wmt_evt hwhdr;
2767	__be16 status;
2768} __packed;
2769
2770struct btmtk_tci_sleep {
2771	u8 mode;
2772	__le16 duration;
2773	__le16 host_duration;
2774	u8 host_wakeup_pin;
2775	u8 time_compensation;
2776} __packed;
2777
2778struct btmtk_hci_wmt_params {
2779	u8 op;
2780	u8 flag;
2781	u16 dlen;
2782	const void *data;
2783	u32 *status;
2784};
2785
2786static void btusb_mtk_wmt_recv(struct urb *urb)
2787{
2788	struct hci_dev *hdev = urb->context;
2789	struct btusb_data *data = hci_get_drvdata(hdev);
2790	struct hci_event_hdr *hdr;
2791	struct sk_buff *skb;
2792	int err;
2793
2794	if (urb->status == 0 && urb->actual_length > 0) {
2795		hdev->stat.byte_rx += urb->actual_length;
2796
2797		/* WMT event shouldn't be fragmented and the size should be
2798		 * less than HCI_WMT_MAX_EVENT_SIZE.
2799		 */
2800		skb = bt_skb_alloc(HCI_WMT_MAX_EVENT_SIZE, GFP_ATOMIC);
2801		if (!skb) {
2802			hdev->stat.err_rx++;
2803			goto err_out;
2804		}
2805
2806		hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
2807		skb_put_data(skb, urb->transfer_buffer, urb->actual_length);
2808
2809		hdr = (void *)skb->data;
2810		/* Fix up the vendor event id with 0xff for vendor specific
2811		 * instead of 0xe4 so that event send via monitoring socket can
2812		 * be parsed properly.
2813		 */
2814		hdr->evt = 0xff;
2815
2816		/* When someone waits for the WMT event, the skb is being cloned
2817		 * and being processed the events from there then.
2818		 */
2819		if (test_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags)) {
2820			data->evt_skb = skb_clone(skb, GFP_ATOMIC);
2821			if (!data->evt_skb)
2822				goto err_out;
2823		}
2824
2825		err = hci_recv_frame(hdev, skb);
2826		if (err < 0)
2827			goto err_free_skb;
2828
2829		if (test_and_clear_bit(BTUSB_TX_WAIT_VND_EVT,
2830				       &data->flags)) {
2831			/* Barrier to sync with other CPUs */
2832			smp_mb__after_atomic();
2833			wake_up_bit(&data->flags,
2834				    BTUSB_TX_WAIT_VND_EVT);
2835		}
2836err_out:
2837		return;
2838err_free_skb:
2839		kfree_skb(data->evt_skb);
2840		data->evt_skb = NULL;
2841		return;
2842	} else if (urb->status == -ENOENT) {
2843		/* Avoid suspend failed when usb_kill_urb */
2844		return;
2845	}
2846
2847	usb_mark_last_busy(data->udev);
2848
2849	/* The URB complete handler is still called with urb->actual_length = 0
2850	 * when the event is not available, so we should keep re-submitting
2851	 * URB until WMT event returns, Also, It's necessary to wait some time
2852	 * between the two consecutive control URBs to relax the target device
2853	 * to generate the event. Otherwise, the WMT event cannot return from
2854	 * the device successfully.
2855	 */
2856	udelay(100);
2857
2858	usb_anchor_urb(urb, &data->ctrl_anchor);
2859	err = usb_submit_urb(urb, GFP_ATOMIC);
2860	if (err < 0) {
2861		/* -EPERM: urb is being killed;
2862		 * -ENODEV: device got disconnected
2863		 */
2864		if (err != -EPERM && err != -ENODEV)
2865			bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
2866				   urb, -err);
2867		usb_unanchor_urb(urb);
2868	}
2869}
2870
2871static int btusb_mtk_submit_wmt_recv_urb(struct hci_dev *hdev)
2872{
2873	struct btusb_data *data = hci_get_drvdata(hdev);
2874	struct usb_ctrlrequest *dr;
2875	unsigned char *buf;
2876	int err, size = 64;
2877	unsigned int pipe;
2878	struct urb *urb;
2879
2880	urb = usb_alloc_urb(0, GFP_KERNEL);
2881	if (!urb)
2882		return -ENOMEM;
2883
2884	dr = kmalloc(sizeof(*dr), GFP_KERNEL);
2885	if (!dr) {
2886		usb_free_urb(urb);
2887		return -ENOMEM;
2888	}
2889
2890	dr->bRequestType = USB_TYPE_VENDOR | USB_DIR_IN;
2891	dr->bRequest     = 1;
2892	dr->wIndex       = cpu_to_le16(0);
2893	dr->wValue       = cpu_to_le16(48);
2894	dr->wLength      = cpu_to_le16(size);
2895
2896	buf = kmalloc(size, GFP_KERNEL);
2897	if (!buf) {
2898		kfree(dr);
2899		return -ENOMEM;
2900	}
2901
2902	pipe = usb_rcvctrlpipe(data->udev, 0);
2903
2904	usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
2905			     buf, size, btusb_mtk_wmt_recv, hdev);
2906
2907	urb->transfer_flags |= URB_FREE_BUFFER;
2908
2909	usb_anchor_urb(urb, &data->ctrl_anchor);
2910	err = usb_submit_urb(urb, GFP_KERNEL);
2911	if (err < 0) {
2912		if (err != -EPERM && err != -ENODEV)
2913			bt_dev_err(hdev, "urb %p submission failed (%d)",
2914				   urb, -err);
2915		usb_unanchor_urb(urb);
2916	}
2917
2918	usb_free_urb(urb);
2919
2920	return err;
2921}
2922
2923static int btusb_mtk_hci_wmt_sync(struct hci_dev *hdev,
2924				  struct btmtk_hci_wmt_params *wmt_params)
2925{
2926	struct btusb_data *data = hci_get_drvdata(hdev);
2927	struct btmtk_hci_wmt_evt_funcc *wmt_evt_funcc;
2928	u32 hlen, status = BTMTK_WMT_INVALID;
2929	struct btmtk_hci_wmt_evt *wmt_evt;
2930	struct btmtk_hci_wmt_cmd wc;
2931	struct btmtk_wmt_hdr *hdr;
2932	int err;
2933
2934	/* Submit control IN URB on demand to process the WMT event */
2935	err = btusb_mtk_submit_wmt_recv_urb(hdev);
2936	if (err < 0)
2937		return err;
2938
2939	/* Send the WMT command and wait until the WMT event returns */
2940	hlen = sizeof(*hdr) + wmt_params->dlen;
2941	if (hlen > 255)
2942		return -EINVAL;
2943
2944	hdr = (struct btmtk_wmt_hdr *)&wc;
2945	hdr->dir = 1;
2946	hdr->op = wmt_params->op;
2947	hdr->dlen = cpu_to_le16(wmt_params->dlen + 1);
2948	hdr->flag = wmt_params->flag;
2949	memcpy(wc.data, wmt_params->data, wmt_params->dlen);
2950
2951	set_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
2952
2953	err = __hci_cmd_send(hdev, 0xfc6f, hlen, &wc);
2954
2955	if (err < 0) {
2956		clear_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
2957		return err;
2958	}
2959
2960	/* The vendor specific WMT commands are all answered by a vendor
2961	 * specific event and will have the Command Status or Command
2962	 * Complete as with usual HCI command flow control.
2963	 *
2964	 * After sending the command, wait for BTUSB_TX_WAIT_VND_EVT
2965	 * state to be cleared. The driver specific event receive routine
2966	 * will clear that state and with that indicate completion of the
2967	 * WMT command.
2968	 */
2969	err = wait_on_bit_timeout(&data->flags, BTUSB_TX_WAIT_VND_EVT,
2970				  TASK_INTERRUPTIBLE, HCI_INIT_TIMEOUT);
2971	if (err == -EINTR) {
2972		bt_dev_err(hdev, "Execution of wmt command interrupted");
2973		clear_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
2974		return err;
2975	}
2976
2977	if (err) {
2978		bt_dev_err(hdev, "Execution of wmt command timed out");
2979		clear_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
2980		return -ETIMEDOUT;
2981	}
2982
2983	/* Parse and handle the return WMT event */
2984	wmt_evt = (struct btmtk_hci_wmt_evt *)data->evt_skb->data;
2985	if (wmt_evt->whdr.op != hdr->op) {
2986		bt_dev_err(hdev, "Wrong op received %d expected %d",
2987			   wmt_evt->whdr.op, hdr->op);
2988		err = -EIO;
2989		goto err_free_skb;
2990	}
2991
2992	switch (wmt_evt->whdr.op) {
2993	case BTMTK_WMT_SEMAPHORE:
2994		if (wmt_evt->whdr.flag == 2)
2995			status = BTMTK_WMT_PATCH_UNDONE;
2996		else
2997			status = BTMTK_WMT_PATCH_DONE;
2998		break;
2999	case BTMTK_WMT_FUNC_CTRL:
3000		wmt_evt_funcc = (struct btmtk_hci_wmt_evt_funcc *)wmt_evt;
3001		if (be16_to_cpu(wmt_evt_funcc->status) == 0x404)
3002			status = BTMTK_WMT_ON_DONE;
3003		else if (be16_to_cpu(wmt_evt_funcc->status) == 0x420)
3004			status = BTMTK_WMT_ON_PROGRESS;
3005		else
3006			status = BTMTK_WMT_ON_UNDONE;
3007		break;
3008	}
3009
3010	if (wmt_params->status)
3011		*wmt_params->status = status;
3012
3013err_free_skb:
3014	kfree_skb(data->evt_skb);
3015	data->evt_skb = NULL;
3016
3017	return err;
3018}
3019
3020static int btusb_mtk_setup_firmware(struct hci_dev *hdev, const char *fwname)
3021{
3022	struct btmtk_hci_wmt_params wmt_params;
3023	const struct firmware *fw;
3024	const u8 *fw_ptr;
3025	size_t fw_size;
3026	int err, dlen;
3027	u8 flag, param;
3028
3029	err = request_firmware(&fw, fwname, &hdev->dev);
3030	if (err < 0) {
3031		bt_dev_err(hdev, "Failed to load firmware file (%d)", err);
3032		return err;
3033	}
3034
3035	/* Power on data RAM the firmware relies on. */
3036	param = 1;
3037	wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3038	wmt_params.flag = 3;
3039	wmt_params.dlen = sizeof(param);
3040	wmt_params.data = &param;
3041	wmt_params.status = NULL;
3042
3043	err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3044	if (err < 0) {
3045		bt_dev_err(hdev, "Failed to power on data RAM (%d)", err);
3046		return err;
3047	}
3048
3049	fw_ptr = fw->data;
3050	fw_size = fw->size;
3051
3052	/* The size of patch header is 30 bytes, should be skip */
3053	if (fw_size < 30) {
3054		err = -EINVAL;
3055		goto err_release_fw;
3056	}
3057
3058	fw_size -= 30;
3059	fw_ptr += 30;
3060	flag = 1;
3061
3062	wmt_params.op = BTMTK_WMT_PATCH_DWNLD;
3063	wmt_params.status = NULL;
3064
3065	while (fw_size > 0) {
3066		dlen = min_t(int, 250, fw_size);
3067
3068		/* Tell deivice the position in sequence */
3069		if (fw_size - dlen <= 0)
3070			flag = 3;
3071		else if (fw_size < fw->size - 30)
3072			flag = 2;
3073
3074		wmt_params.flag = flag;
3075		wmt_params.dlen = dlen;
3076		wmt_params.data = fw_ptr;
3077
3078		err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3079		if (err < 0) {
3080			bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)",
3081				   err);
3082			goto err_release_fw;
3083		}
3084
3085		fw_size -= dlen;
3086		fw_ptr += dlen;
3087	}
3088
3089	wmt_params.op = BTMTK_WMT_RST;
3090	wmt_params.flag = 4;
3091	wmt_params.dlen = 0;
3092	wmt_params.data = NULL;
3093	wmt_params.status = NULL;
3094
3095	/* Activate funciton the firmware providing to */
3096	err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3097	if (err < 0) {
3098		bt_dev_err(hdev, "Failed to send wmt rst (%d)", err);
3099		goto err_release_fw;
3100	}
3101
3102	/* Wait a few moments for firmware activation done */
3103	usleep_range(10000, 12000);
3104
3105err_release_fw:
3106	release_firmware(fw);
3107
3108	return err;
3109}
3110
3111static int btusb_mtk_func_query(struct hci_dev *hdev)
3112{
3113	struct btmtk_hci_wmt_params wmt_params;
3114	int status, err;
3115	u8 param = 0;
3116
3117	/* Query whether the function is enabled */
3118	wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3119	wmt_params.flag = 4;
3120	wmt_params.dlen = sizeof(param);
3121	wmt_params.data = &param;
3122	wmt_params.status = &status;
3123
3124	err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3125	if (err < 0) {
3126		bt_dev_err(hdev, "Failed to query function status (%d)", err);
3127		return err;
3128	}
3129
3130	return status;
3131}
3132
3133static int btusb_mtk_reg_read(struct btusb_data *data, u32 reg, u32 *val)
3134{
3135	int pipe, err, size = sizeof(u32);
3136	void *buf;
3137
3138	buf = kzalloc(size, GFP_KERNEL);
3139	if (!buf)
3140		return -ENOMEM;
3141
3142	pipe = usb_rcvctrlpipe(data->udev, 0);
3143	err = usb_control_msg(data->udev, pipe, 0x63,
3144			      USB_TYPE_VENDOR | USB_DIR_IN,
3145			      reg >> 16, reg & 0xffff,
3146			      buf, size, USB_CTRL_SET_TIMEOUT);
3147	if (err < 0)
3148		goto err_free_buf;
3149
3150	*val = get_unaligned_le32(buf);
3151
3152err_free_buf:
3153	kfree(buf);
3154
3155	return err;
3156}
3157
3158static int btusb_mtk_id_get(struct btusb_data *data, u32 *id)
3159{
3160	return btusb_mtk_reg_read(data, 0x80000008, id);
3161}
3162
3163static int btusb_mtk_setup(struct hci_dev *hdev)
3164{
3165	struct btusb_data *data = hci_get_drvdata(hdev);
3166	struct btmtk_hci_wmt_params wmt_params;
3167	ktime_t calltime, delta, rettime;
3168	struct btmtk_tci_sleep tci_sleep;
3169	unsigned long long duration;
3170	struct sk_buff *skb;
3171	const char *fwname;
3172	int err, status;
3173	u32 dev_id;
3174	u8 param;
3175
3176	calltime = ktime_get();
3177
3178	err = btusb_mtk_id_get(data, &dev_id);
3179	if (err < 0) {
3180		bt_dev_err(hdev, "Failed to get device id (%d)", err);
3181		return err;
3182	}
3183
3184	switch (dev_id) {
3185	case 0x7663:
3186		fwname = FIRMWARE_MT7663;
3187		break;
3188	case 0x7668:
3189		fwname = FIRMWARE_MT7668;
3190		break;
3191	default:
3192		bt_dev_err(hdev, "Unsupported support hardware variant (%08x)",
3193			   dev_id);
3194		return -ENODEV;
3195	}
3196
3197	/* Query whether the firmware is already download */
3198	wmt_params.op = BTMTK_WMT_SEMAPHORE;
3199	wmt_params.flag = 1;
3200	wmt_params.dlen = 0;
3201	wmt_params.data = NULL;
3202	wmt_params.status = &status;
3203
3204	err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3205	if (err < 0) {
3206		bt_dev_err(hdev, "Failed to query firmware status (%d)", err);
3207		return err;
3208	}
3209
3210	if (status == BTMTK_WMT_PATCH_DONE) {
3211		bt_dev_info(hdev, "firmware already downloaded");
3212		goto ignore_setup_fw;
3213	}
3214
3215	/* Setup a firmware which the device definitely requires */
3216	err = btusb_mtk_setup_firmware(hdev, fwname);
3217	if (err < 0)
3218		return err;
3219
3220ignore_setup_fw:
3221	err = readx_poll_timeout(btusb_mtk_func_query, hdev, status,
3222				 status < 0 || status != BTMTK_WMT_ON_PROGRESS,
3223				 2000, 5000000);
3224	/* -ETIMEDOUT happens */
3225	if (err < 0)
3226		return err;
3227
3228	/* The other errors happen in btusb_mtk_func_query */
3229	if (status < 0)
3230		return status;
3231
3232	if (status == BTMTK_WMT_ON_DONE) {
3233		bt_dev_info(hdev, "function already on");
3234		goto ignore_func_on;
3235	}
3236
3237	/* Enable Bluetooth protocol */
3238	param = 1;
3239	wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3240	wmt_params.flag = 0;
3241	wmt_params.dlen = sizeof(param);
3242	wmt_params.data = &param;
3243	wmt_params.status = NULL;
3244
3245	err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3246	if (err < 0) {
3247		bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);
3248		return err;
3249	}
3250
3251ignore_func_on:
3252	/* Apply the low power environment setup */
3253	tci_sleep.mode = 0x5;
3254	tci_sleep.duration = cpu_to_le16(0x640);
3255	tci_sleep.host_duration = cpu_to_le16(0x640);
3256	tci_sleep.host_wakeup_pin = 0;
3257	tci_sleep.time_compensation = 0;
3258
3259	skb = __hci_cmd_sync(hdev, 0xfc7a, sizeof(tci_sleep), &tci_sleep,
3260			     HCI_INIT_TIMEOUT);
3261	if (IS_ERR(skb)) {
3262		err = PTR_ERR(skb);
3263		bt_dev_err(hdev, "Failed to apply low power setting (%d)", err);
3264		return err;
3265	}
3266	kfree_skb(skb);
3267
3268	rettime = ktime_get();
3269	delta = ktime_sub(rettime, calltime);
3270	duration = (unsigned long long)ktime_to_ns(delta) >> 10;
3271
3272	bt_dev_info(hdev, "Device setup in %llu usecs", duration);
3273
3274	return 0;
3275}
3276
3277static int btusb_mtk_shutdown(struct hci_dev *hdev)
3278{
3279	struct btmtk_hci_wmt_params wmt_params;
3280	u8 param = 0;
3281	int err;
3282
3283	/* Disable the device */
3284	wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3285	wmt_params.flag = 0;
3286	wmt_params.dlen = sizeof(param);
3287	wmt_params.data = &param;
3288	wmt_params.status = NULL;
3289
3290	err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3291	if (err < 0) {
3292		bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);
3293		return err;
3294	}
3295
3296	return 0;
3297}
3298
3299MODULE_FIRMWARE(FIRMWARE_MT7663);
3300MODULE_FIRMWARE(FIRMWARE_MT7668);
3301
3302#ifdef CONFIG_PM
3303/* Configure an out-of-band gpio as wake-up pin, if specified in device tree */
3304static int marvell_config_oob_wake(struct hci_dev *hdev)
3305{
3306	struct sk_buff *skb;
3307	struct btusb_data *data = hci_get_drvdata(hdev);
3308	struct device *dev = &data->udev->dev;
3309	u16 pin, gap, opcode;
3310	int ret;
3311	u8 cmd[5];
3312
3313	/* Move on if no wakeup pin specified */
3314	if (of_property_read_u16(dev->of_node, "marvell,wakeup-pin", &pin) ||
3315	    of_property_read_u16(dev->of_node, "marvell,wakeup-gap-ms", &gap))
3316		return 0;
3317
3318	/* Vendor specific command to configure a GPIO as wake-up pin */
3319	opcode = hci_opcode_pack(0x3F, 0x59);
3320	cmd[0] = opcode & 0xFF;
3321	cmd[1] = opcode >> 8;
3322	cmd[2] = 2; /* length of parameters that follow */
3323	cmd[3] = pin;
3324	cmd[4] = gap; /* time in ms, for which wakeup pin should be asserted */
3325
3326	skb = bt_skb_alloc(sizeof(cmd), GFP_KERNEL);
3327	if (!skb) {
3328		bt_dev_err(hdev, "%s: No memory\n", __func__);
3329		return -ENOMEM;
3330	}
3331
3332	skb_put_data(skb, cmd, sizeof(cmd));
3333	hci_skb_pkt_type(skb) = HCI_COMMAND_PKT;
3334
3335	ret = btusb_send_frame(hdev, skb);
3336	if (ret) {
3337		bt_dev_err(hdev, "%s: configuration failed\n", __func__);
3338		kfree_skb(skb);
3339		return ret;
3340	}
3341
3342	return 0;
3343}
3344#endif
3345
3346static int btusb_set_bdaddr_marvell(struct hci_dev *hdev,
3347				    const bdaddr_t *bdaddr)
3348{
3349	struct sk_buff *skb;
3350	u8 buf[8];
3351	long ret;
3352
3353	buf[0] = 0xfe;
3354	buf[1] = sizeof(bdaddr_t);
3355	memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
3356
3357	skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT);
3358	if (IS_ERR(skb)) {
3359		ret = PTR_ERR(skb);
3360		bt_dev_err(hdev, "changing Marvell device address failed (%ld)",
3361			   ret);
3362		return ret;
3363	}
3364	kfree_skb(skb);
3365
3366	return 0;
3367}
3368
3369static int btusb_set_bdaddr_ath3012(struct hci_dev *hdev,
3370				    const bdaddr_t *bdaddr)
3371{
3372	struct sk_buff *skb;
3373	u8 buf[10];
3374	long ret;
3375
3376	buf[0] = 0x01;
3377	buf[1] = 0x01;
3378	buf[2] = 0x00;
3379	buf[3] = sizeof(bdaddr_t);
3380	memcpy(buf + 4, bdaddr, sizeof(bdaddr_t));
3381
3382	skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT);
3383	if (IS_ERR(skb)) {
3384		ret = PTR_ERR(skb);
3385		bt_dev_err(hdev, "Change address command failed (%ld)", ret);
 
3386		return ret;
3387	}
3388	kfree_skb(skb);
3389
3390	return 0;
3391}
3392
3393#define QCA_DFU_PACKET_LEN	4096
3394
3395#define QCA_GET_TARGET_VERSION	0x09
3396#define QCA_CHECK_STATUS	0x05
3397#define QCA_DFU_DOWNLOAD	0x01
3398
3399#define QCA_SYSCFG_UPDATED	0x40
3400#define QCA_PATCH_UPDATED	0x80
3401#define QCA_DFU_TIMEOUT		3000
3402
3403struct qca_version {
3404	__le32	rom_version;
3405	__le32	patch_version;
3406	__le32	ram_version;
3407	__le32	ref_clock;
3408	__u8	reserved[4];
3409} __packed;
3410
3411struct qca_rampatch_version {
3412	__le16	rom_version;
3413	__le16	patch_version;
3414} __packed;
3415
3416struct qca_device_info {
3417	u32	rom_version;
3418	u8	rampatch_hdr;	/* length of header in rampatch */
3419	u8	nvm_hdr;	/* length of header in NVM */
3420	u8	ver_offset;	/* offset of version structure in rampatch */
3421};
3422
3423static const struct qca_device_info qca_devices_table[] = {
3424	{ 0x00000100, 20, 4, 10 }, /* Rome 1.0 */
3425	{ 0x00000101, 20, 4, 10 }, /* Rome 1.1 */
3426	{ 0x00000200, 28, 4, 18 }, /* Rome 2.0 */
3427	{ 0x00000201, 28, 4, 18 }, /* Rome 2.1 */
3428	{ 0x00000300, 28, 4, 18 }, /* Rome 3.0 */
3429	{ 0x00000302, 28, 4, 18 }, /* Rome 3.2 */
3430};
3431
3432static int btusb_qca_send_vendor_req(struct usb_device *udev, u8 request,
3433				     void *data, u16 size)
3434{
 
 
3435	int pipe, err;
3436	u8 *buf;
3437
3438	buf = kmalloc(size, GFP_KERNEL);
3439	if (!buf)
3440		return -ENOMEM;
3441
3442	/* Found some of USB hosts have IOT issues with ours so that we should
3443	 * not wait until HCI layer is ready.
3444	 */
3445	pipe = usb_rcvctrlpipe(udev, 0);
3446	err = usb_control_msg(udev, pipe, request, USB_TYPE_VENDOR | USB_DIR_IN,
3447			      0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
3448	if (err < 0) {
3449		dev_err(&udev->dev, "Failed to access otp area (%d)", err);
3450		goto done;
3451	}
3452
3453	memcpy(data, buf, size);
3454
3455done:
3456	kfree(buf);
3457
3458	return err;
3459}
3460
3461static int btusb_setup_qca_download_fw(struct hci_dev *hdev,
3462				       const struct firmware *firmware,
3463				       size_t hdr_size)
3464{
3465	struct btusb_data *btdata = hci_get_drvdata(hdev);
3466	struct usb_device *udev = btdata->udev;
3467	size_t count, size, sent = 0;
3468	int pipe, len, err;
3469	u8 *buf;
3470
3471	buf = kmalloc(QCA_DFU_PACKET_LEN, GFP_KERNEL);
3472	if (!buf)
3473		return -ENOMEM;
3474
3475	count = firmware->size;
3476
3477	size = min_t(size_t, count, hdr_size);
3478	memcpy(buf, firmware->data, size);
3479
3480	/* USB patches should go down to controller through USB path
3481	 * because binary format fits to go down through USB channel.
3482	 * USB control path is for patching headers and USB bulk is for
3483	 * patch body.
3484	 */
3485	pipe = usb_sndctrlpipe(udev, 0);
3486	err = usb_control_msg(udev, pipe, QCA_DFU_DOWNLOAD, USB_TYPE_VENDOR,
3487			      0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
3488	if (err < 0) {
3489		bt_dev_err(hdev, "Failed to send headers (%d)", err);
3490		goto done;
3491	}
3492
3493	sent += size;
3494	count -= size;
3495
3496	while (count) {
3497		size = min_t(size_t, count, QCA_DFU_PACKET_LEN);
3498
3499		memcpy(buf, firmware->data + sent, size);
3500
3501		pipe = usb_sndbulkpipe(udev, 0x02);
3502		err = usb_bulk_msg(udev, pipe, buf, size, &len,
3503				   QCA_DFU_TIMEOUT);
3504		if (err < 0) {
3505			bt_dev_err(hdev, "Failed to send body at %zd of %zd (%d)",
3506				   sent, firmware->size, err);
3507			break;
3508		}
3509
3510		if (size != len) {
3511			bt_dev_err(hdev, "Failed to get bulk buffer");
3512			err = -EILSEQ;
3513			break;
3514		}
3515
3516		sent  += size;
3517		count -= size;
3518	}
3519
3520done:
3521	kfree(buf);
3522	return err;
3523}
3524
3525static int btusb_setup_qca_load_rampatch(struct hci_dev *hdev,
3526					 struct qca_version *ver,
3527					 const struct qca_device_info *info)
3528{
3529	struct qca_rampatch_version *rver;
3530	const struct firmware *fw;
3531	u32 ver_rom, ver_patch;
3532	u16 rver_rom, rver_patch;
3533	char fwname[64];
3534	int err;
3535
3536	ver_rom = le32_to_cpu(ver->rom_version);
3537	ver_patch = le32_to_cpu(ver->patch_version);
3538
3539	snprintf(fwname, sizeof(fwname), "qca/rampatch_usb_%08x.bin", ver_rom);
3540
3541	err = request_firmware(&fw, fwname, &hdev->dev);
3542	if (err) {
3543		bt_dev_err(hdev, "failed to request rampatch file: %s (%d)",
3544			   fwname, err);
3545		return err;
3546	}
3547
3548	bt_dev_info(hdev, "using rampatch file: %s", fwname);
3549
3550	rver = (struct qca_rampatch_version *)(fw->data + info->ver_offset);
3551	rver_rom = le16_to_cpu(rver->rom_version);
3552	rver_patch = le16_to_cpu(rver->patch_version);
3553
3554	bt_dev_info(hdev, "QCA: patch rome 0x%x build 0x%x, "
3555		    "firmware rome 0x%x build 0x%x",
3556		    rver_rom, rver_patch, ver_rom, ver_patch);
3557
3558	if (rver_rom != ver_rom || rver_patch <= ver_patch) {
3559		bt_dev_err(hdev, "rampatch file version did not match with firmware");
 
3560		err = -EINVAL;
3561		goto done;
3562	}
3563
3564	err = btusb_setup_qca_download_fw(hdev, fw, info->rampatch_hdr);
3565
3566done:
3567	release_firmware(fw);
3568
3569	return err;
3570}
3571
3572static int btusb_setup_qca_load_nvm(struct hci_dev *hdev,
3573				    struct qca_version *ver,
3574				    const struct qca_device_info *info)
3575{
3576	const struct firmware *fw;
3577	char fwname[64];
3578	int err;
3579
3580	snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x.bin",
3581		 le32_to_cpu(ver->rom_version));
3582
3583	err = request_firmware(&fw, fwname, &hdev->dev);
3584	if (err) {
3585		bt_dev_err(hdev, "failed to request NVM file: %s (%d)",
3586			   fwname, err);
3587		return err;
3588	}
3589
3590	bt_dev_info(hdev, "using NVM file: %s", fwname);
3591
3592	err = btusb_setup_qca_download_fw(hdev, fw, info->nvm_hdr);
3593
3594	release_firmware(fw);
3595
3596	return err;
3597}
3598
3599/* identify the ROM version and check whether patches are needed */
3600static bool btusb_qca_need_patch(struct usb_device *udev)
3601{
3602	struct qca_version ver;
3603
3604	if (btusb_qca_send_vendor_req(udev, QCA_GET_TARGET_VERSION, &ver,
3605				      sizeof(ver)) < 0)
3606		return false;
3607	/* only low ROM versions need patches */
3608	return !(le32_to_cpu(ver.rom_version) & ~0xffffU);
3609}
3610
3611static int btusb_setup_qca(struct hci_dev *hdev)
3612{
3613	struct btusb_data *btdata = hci_get_drvdata(hdev);
3614	struct usb_device *udev = btdata->udev;
3615	const struct qca_device_info *info = NULL;
3616	struct qca_version ver;
3617	u32 ver_rom;
3618	u8 status;
3619	int i, err;
3620
3621	err = btusb_qca_send_vendor_req(udev, QCA_GET_TARGET_VERSION, &ver,
3622					sizeof(ver));
3623	if (err < 0)
3624		return err;
3625
3626	ver_rom = le32_to_cpu(ver.rom_version);
3627	/* Don't care about high ROM versions */
3628	if (ver_rom & ~0xffffU)
3629		return 0;
3630
3631	for (i = 0; i < ARRAY_SIZE(qca_devices_table); i++) {
3632		if (ver_rom == qca_devices_table[i].rom_version)
3633			info = &qca_devices_table[i];
3634	}
3635	if (!info) {
3636		bt_dev_err(hdev, "don't support firmware rome 0x%x", ver_rom);
 
3637		return -ENODEV;
3638	}
3639
3640	err = btusb_qca_send_vendor_req(udev, QCA_CHECK_STATUS, &status,
3641					sizeof(status));
3642	if (err < 0)
3643		return err;
3644
3645	if (!(status & QCA_PATCH_UPDATED)) {
3646		err = btusb_setup_qca_load_rampatch(hdev, &ver, info);
3647		if (err < 0)
3648			return err;
3649	}
3650
3651	if (!(status & QCA_SYSCFG_UPDATED)) {
3652		err = btusb_setup_qca_load_nvm(hdev, &ver, info);
3653		if (err < 0)
3654			return err;
3655	}
3656
3657	return 0;
3658}
3659
 
3660static inline int __set_diag_interface(struct hci_dev *hdev)
3661{
3662	struct btusb_data *data = hci_get_drvdata(hdev);
3663	struct usb_interface *intf = data->diag;
3664	int i;
3665
3666	if (!data->diag)
3667		return -ENODEV;
3668
3669	data->diag_tx_ep = NULL;
3670	data->diag_rx_ep = NULL;
3671
3672	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
3673		struct usb_endpoint_descriptor *ep_desc;
3674
3675		ep_desc = &intf->cur_altsetting->endpoint[i].desc;
3676
3677		if (!data->diag_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
3678			data->diag_tx_ep = ep_desc;
3679			continue;
3680		}
3681
3682		if (!data->diag_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
3683			data->diag_rx_ep = ep_desc;
3684			continue;
3685		}
3686	}
3687
3688	if (!data->diag_tx_ep || !data->diag_rx_ep) {
3689		bt_dev_err(hdev, "invalid diagnostic descriptors");
3690		return -ENODEV;
3691	}
3692
3693	return 0;
3694}
3695
3696static struct urb *alloc_diag_urb(struct hci_dev *hdev, bool enable)
3697{
3698	struct btusb_data *data = hci_get_drvdata(hdev);
3699	struct sk_buff *skb;
3700	struct urb *urb;
3701	unsigned int pipe;
3702
3703	if (!data->diag_tx_ep)
3704		return ERR_PTR(-ENODEV);
3705
3706	urb = usb_alloc_urb(0, GFP_KERNEL);
3707	if (!urb)
3708		return ERR_PTR(-ENOMEM);
3709
3710	skb = bt_skb_alloc(2, GFP_KERNEL);
3711	if (!skb) {
3712		usb_free_urb(urb);
3713		return ERR_PTR(-ENOMEM);
3714	}
3715
3716	skb_put_u8(skb, 0xf0);
3717	skb_put_u8(skb, enable);
3718
3719	pipe = usb_sndbulkpipe(data->udev, data->diag_tx_ep->bEndpointAddress);
3720
3721	usb_fill_bulk_urb(urb, data->udev, pipe,
3722			  skb->data, skb->len, btusb_tx_complete, skb);
3723
3724	skb->dev = (void *)hdev;
3725
3726	return urb;
3727}
3728
3729static int btusb_bcm_set_diag(struct hci_dev *hdev, bool enable)
3730{
3731	struct btusb_data *data = hci_get_drvdata(hdev);
3732	struct urb *urb;
3733
3734	if (!data->diag)
3735		return -ENODEV;
3736
3737	if (!test_bit(HCI_RUNNING, &hdev->flags))
3738		return -ENETDOWN;
3739
3740	urb = alloc_diag_urb(hdev, enable);
3741	if (IS_ERR(urb))
3742		return PTR_ERR(urb);
3743
3744	return submit_or_queue_tx_urb(hdev, urb);
3745}
3746
3747#ifdef CONFIG_PM
3748static irqreturn_t btusb_oob_wake_handler(int irq, void *priv)
3749{
3750	struct btusb_data *data = priv;
3751
3752	pm_wakeup_event(&data->udev->dev, 0);
3753	pm_system_wakeup();
3754
3755	/* Disable only if not already disabled (keep it balanced) */
3756	if (test_and_clear_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags)) {
3757		disable_irq_nosync(irq);
3758		disable_irq_wake(irq);
3759	}
3760	return IRQ_HANDLED;
3761}
3762
3763static const struct of_device_id btusb_match_table[] = {
3764	{ .compatible = "usb1286,204e" },
3765	{ .compatible = "usbcf3,e300" }, /* QCA6174A */
3766	{ .compatible = "usb4ca,301a" }, /* QCA6174A (Lite-On) */
3767	{ }
3768};
3769MODULE_DEVICE_TABLE(of, btusb_match_table);
3770
3771/* Use an oob wakeup pin? */
3772static int btusb_config_oob_wake(struct hci_dev *hdev)
3773{
3774	struct btusb_data *data = hci_get_drvdata(hdev);
3775	struct device *dev = &data->udev->dev;
3776	int irq, ret;
3777
3778	clear_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags);
3779
3780	if (!of_match_device(btusb_match_table, dev))
3781		return 0;
3782
3783	/* Move on if no IRQ specified */
3784	irq = of_irq_get_byname(dev->of_node, "wakeup");
3785	if (irq <= 0) {
3786		bt_dev_dbg(hdev, "%s: no OOB Wakeup IRQ in DT", __func__);
3787		return 0;
3788	}
3789
3790	irq_set_status_flags(irq, IRQ_NOAUTOEN);
3791	ret = devm_request_irq(&hdev->dev, irq, btusb_oob_wake_handler,
3792			       0, "OOB Wake-on-BT", data);
3793	if (ret) {
3794		bt_dev_err(hdev, "%s: IRQ request failed", __func__);
3795		return ret;
3796	}
3797
3798	ret = device_init_wakeup(dev, true);
3799	if (ret) {
3800		bt_dev_err(hdev, "%s: failed to init_wakeup", __func__);
3801		return ret;
3802	}
3803
3804	data->oob_wake_irq = irq;
3805	bt_dev_info(hdev, "OOB Wake-on-BT configured at IRQ %u", irq);
3806	return 0;
3807}
3808#endif
3809
3810static void btusb_check_needs_reset_resume(struct usb_interface *intf)
3811{
3812	if (dmi_check_system(btusb_needs_reset_resume_table))
3813		interface_to_usbdev(intf)->quirks |= USB_QUIRK_RESET_RESUME;
3814}
3815
3816static bool btusb_prevent_wake(struct hci_dev *hdev)
3817{
3818	struct btusb_data *data = hci_get_drvdata(hdev);
3819
3820	if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags))
3821		return true;
3822
3823	return !device_may_wakeup(&data->udev->dev);
3824}
3825
3826static int btusb_probe(struct usb_interface *intf,
3827		       const struct usb_device_id *id)
3828{
3829	struct usb_endpoint_descriptor *ep_desc;
3830	struct gpio_desc *reset_gpio;
3831	struct btusb_data *data;
3832	struct hci_dev *hdev;
3833	unsigned ifnum_base;
3834	int i, err;
3835
3836	BT_DBG("intf %p id %p", intf, id);
3837
3838	/* interface numbers are hardcoded in the spec */
3839	if (intf->cur_altsetting->desc.bInterfaceNumber != 0) {
3840		if (!(id->driver_info & BTUSB_IFNUM_2))
3841			return -ENODEV;
3842		if (intf->cur_altsetting->desc.bInterfaceNumber != 2)
3843			return -ENODEV;
3844	}
3845
3846	ifnum_base = intf->cur_altsetting->desc.bInterfaceNumber;
3847
3848	if (!id->driver_info) {
3849		const struct usb_device_id *match;
3850
3851		match = usb_match_id(intf, blacklist_table);
3852		if (match)
3853			id = match;
3854	}
3855
3856	if (id->driver_info == BTUSB_IGNORE)
3857		return -ENODEV;
3858
3859	if (id->driver_info & BTUSB_ATH3012) {
3860		struct usb_device *udev = interface_to_usbdev(intf);
3861
3862		/* Old firmware would otherwise let ath3k driver load
3863		 * patch and sysconfig files
3864		 */
3865		if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001 &&
3866		    !btusb_qca_need_patch(udev))
3867			return -ENODEV;
3868	}
3869
3870	data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
3871	if (!data)
3872		return -ENOMEM;
3873
3874	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
3875		ep_desc = &intf->cur_altsetting->endpoint[i].desc;
3876
3877		if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
3878			data->intr_ep = ep_desc;
3879			continue;
3880		}
3881
3882		if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
3883			data->bulk_tx_ep = ep_desc;
3884			continue;
3885		}
3886
3887		if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
3888			data->bulk_rx_ep = ep_desc;
3889			continue;
3890		}
3891	}
3892
3893	if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep)
3894		return -ENODEV;
3895
3896	if (id->driver_info & BTUSB_AMP) {
3897		data->cmdreq_type = USB_TYPE_CLASS | 0x01;
3898		data->cmdreq = 0x2b;
3899	} else {
3900		data->cmdreq_type = USB_TYPE_CLASS;
3901		data->cmdreq = 0x00;
3902	}
3903
3904	data->udev = interface_to_usbdev(intf);
3905	data->intf = intf;
3906
3907	INIT_WORK(&data->work, btusb_work);
3908	INIT_WORK(&data->waker, btusb_waker);
3909	init_usb_anchor(&data->deferred);
3910	init_usb_anchor(&data->tx_anchor);
3911	spin_lock_init(&data->txlock);
3912
3913	init_usb_anchor(&data->intr_anchor);
3914	init_usb_anchor(&data->bulk_anchor);
3915	init_usb_anchor(&data->isoc_anchor);
3916	init_usb_anchor(&data->diag_anchor);
3917	init_usb_anchor(&data->ctrl_anchor);
3918	spin_lock_init(&data->rxlock);
3919
3920	if (id->driver_info & BTUSB_INTEL_NEW) {
3921		data->recv_event = btusb_recv_event_intel;
3922		data->recv_bulk = btusb_recv_bulk_intel;
3923		set_bit(BTUSB_BOOTLOADER, &data->flags);
3924	} else {
3925		data->recv_event = hci_recv_frame;
3926		data->recv_bulk = btusb_recv_bulk;
3927	}
3928
3929	hdev = hci_alloc_dev();
3930	if (!hdev)
3931		return -ENOMEM;
3932
3933	hdev->bus = HCI_USB;
3934	hci_set_drvdata(hdev, data);
3935
3936	if (id->driver_info & BTUSB_AMP)
3937		hdev->dev_type = HCI_AMP;
3938	else
3939		hdev->dev_type = HCI_PRIMARY;
3940
3941	data->hdev = hdev;
3942
3943	SET_HCIDEV_DEV(hdev, &intf->dev);
3944
3945	reset_gpio = gpiod_get_optional(&data->udev->dev, "reset",
3946					GPIOD_OUT_LOW);
3947	if (IS_ERR(reset_gpio)) {
3948		err = PTR_ERR(reset_gpio);
3949		goto out_free_dev;
3950	} else if (reset_gpio) {
3951		data->reset_gpio = reset_gpio;
3952	}
3953
3954	hdev->open   = btusb_open;
3955	hdev->close  = btusb_close;
3956	hdev->flush  = btusb_flush;
3957	hdev->send   = btusb_send_frame;
3958	hdev->notify = btusb_notify;
3959	hdev->prevent_wake = btusb_prevent_wake;
3960
3961#ifdef CONFIG_PM
3962	err = btusb_config_oob_wake(hdev);
3963	if (err)
3964		goto out_free_dev;
3965
3966	/* Marvell devices may need a specific chip configuration */
3967	if (id->driver_info & BTUSB_MARVELL && data->oob_wake_irq) {
3968		err = marvell_config_oob_wake(hdev);
3969		if (err)
3970			goto out_free_dev;
3971	}
3972#endif
3973	if (id->driver_info & BTUSB_CW6622)
3974		set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
3975
3976	if (id->driver_info & BTUSB_BCM2045)
3977		set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
3978
3979	if (id->driver_info & BTUSB_BCM92035)
3980		hdev->setup = btusb_setup_bcm92035;
3981
3982	if (IS_ENABLED(CONFIG_BT_HCIBTUSB_BCM) &&
3983	    (id->driver_info & BTUSB_BCM_PATCHRAM)) {
3984		hdev->manufacturer = 15;
3985		hdev->setup = btbcm_setup_patchram;
3986		hdev->set_diag = btusb_bcm_set_diag;
3987		hdev->set_bdaddr = btbcm_set_bdaddr;
3988
3989		/* Broadcom LM_DIAG Interface numbers are hardcoded */
3990		data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2);
3991	}
3992
3993	if (IS_ENABLED(CONFIG_BT_HCIBTUSB_BCM) &&
3994	    (id->driver_info & BTUSB_BCM_APPLE)) {
3995		hdev->manufacturer = 15;
3996		hdev->setup = btbcm_setup_apple;
3997		hdev->set_diag = btusb_bcm_set_diag;
3998
3999		/* Broadcom LM_DIAG Interface numbers are hardcoded */
4000		data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2);
4001	}
 
4002
4003	if (id->driver_info & BTUSB_INTEL) {
4004		hdev->manufacturer = 2;
4005		hdev->setup = btusb_setup_intel;
4006		hdev->shutdown = btusb_shutdown_intel;
4007		hdev->set_diag = btintel_set_diag_mfg;
4008		hdev->set_bdaddr = btintel_set_bdaddr;
4009		hdev->cmd_timeout = btusb_intel_cmd_timeout;
4010		set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4011		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4012		set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
4013	}
4014
4015	if (id->driver_info & BTUSB_INTEL_NEW) {
4016		hdev->manufacturer = 2;
4017		hdev->send = btusb_send_frame_intel;
4018		hdev->setup = btusb_setup_intel_new;
4019		hdev->shutdown = btusb_shutdown_intel_new;
4020		hdev->hw_error = btintel_hw_error;
4021		hdev->set_diag = btintel_set_diag;
4022		hdev->set_bdaddr = btintel_set_bdaddr;
4023		hdev->cmd_timeout = btusb_intel_cmd_timeout;
4024		set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4025		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4026		set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
4027	}
4028
4029	if (id->driver_info & BTUSB_MARVELL)
4030		hdev->set_bdaddr = btusb_set_bdaddr_marvell;
4031
4032	if (IS_ENABLED(CONFIG_BT_HCIBTUSB_MTK) &&
4033	    (id->driver_info & BTUSB_MEDIATEK)) {
4034		hdev->setup = btusb_mtk_setup;
4035		hdev->shutdown = btusb_mtk_shutdown;
4036		hdev->manufacturer = 70;
4037		set_bit(HCI_QUIRK_NON_PERSISTENT_SETUP, &hdev->quirks);
4038	}
4039
4040	if (id->driver_info & BTUSB_SWAVE) {
4041		set_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks);
4042		set_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks);
4043	}
4044
4045	if (id->driver_info & BTUSB_INTEL_BOOT) {
4046		hdev->manufacturer = 2;
4047		set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
4048	}
4049
4050	if (id->driver_info & BTUSB_ATH3012) {
4051		data->setup_on_usb = btusb_setup_qca;
4052		hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
4053		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4054		set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4055	}
4056
4057	if (id->driver_info & BTUSB_QCA_ROME) {
4058		data->setup_on_usb = btusb_setup_qca;
4059		hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
4060		hdev->cmd_timeout = btusb_qca_cmd_timeout;
4061		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4062		btusb_check_needs_reset_resume(intf);
4063	}
4064
 
 
 
 
 
 
 
 
 
 
 
 
4065	if (id->driver_info & BTUSB_AMP) {
4066		/* AMP controllers do not support SCO packets */
4067		data->isoc = NULL;
4068	} else {
4069		/* Interface orders are hardcoded in the specification */
4070		data->isoc = usb_ifnum_to_if(data->udev, ifnum_base + 1);
4071		data->isoc_ifnum = ifnum_base + 1;
4072	}
4073
4074	if (IS_ENABLED(CONFIG_BT_HCIBTUSB_RTL) &&
4075	    (id->driver_info & BTUSB_REALTEK)) {
4076		hdev->setup = btrtl_setup_realtek;
4077		hdev->shutdown = btrtl_shutdown_realtek;
4078		hdev->cmd_timeout = btusb_rtl_cmd_timeout;
4079
4080		/* Realtek devices lose their updated firmware over global
4081		 * suspend that means host doesn't send SET_FEATURE
4082		 * (DEVICE_REMOTE_WAKEUP)
4083		 */
4084		set_bit(BTUSB_WAKEUP_DISABLE, &data->flags);
4085		if (btusb_find_altsetting(data, 1))
4086			set_bit(BTUSB_USE_ALT1_FOR_WBS, &data->flags);
4087		else
4088			bt_dev_err(hdev, "Device does not support ALT setting 1");
4089	}
4090
4091	if (!reset)
4092		set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
4093
4094	if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
4095		if (!disable_scofix)
4096			set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
4097	}
4098
4099	if (id->driver_info & BTUSB_BROKEN_ISOC)
4100		data->isoc = NULL;
4101
4102	if (id->driver_info & BTUSB_WIDEBAND_SPEECH)
4103		set_bit(HCI_QUIRK_WIDEBAND_SPEECH_SUPPORTED, &hdev->quirks);
4104
4105	if (id->driver_info & BTUSB_VALID_LE_STATES)
4106		set_bit(HCI_QUIRK_VALID_LE_STATES, &hdev->quirks);
4107
4108	if (id->driver_info & BTUSB_DIGIANSWER) {
4109		data->cmdreq_type = USB_TYPE_VENDOR;
4110		set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
4111	}
4112
4113	if (id->driver_info & BTUSB_CSR) {
4114		struct usb_device *udev = data->udev;
4115		u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice);
4116
4117		/* Old firmware would otherwise execute USB reset */
4118		if (bcdDevice < 0x117)
4119			set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
4120
4121		/* This must be set first in case we disable it for fakes */
4122		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4123
4124		/* Fake CSR devices with broken commands */
4125		if (le16_to_cpu(udev->descriptor.idVendor)  == 0x0a12 &&
4126		    le16_to_cpu(udev->descriptor.idProduct) == 0x0001)
4127			hdev->setup = btusb_setup_csr;
 
 
4128	}
4129
4130	if (id->driver_info & BTUSB_SNIFFER) {
4131		struct usb_device *udev = data->udev;
4132
4133		/* New sniffer firmware has crippled HCI interface */
4134		if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
4135			set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
4136	}
4137
4138	if (id->driver_info & BTUSB_INTEL_BOOT) {
4139		/* A bug in the bootloader causes that interrupt interface is
4140		 * only enabled after receiving SetInterface(0, AltSetting=0).
4141		 */
4142		err = usb_set_interface(data->udev, 0, 0);
4143		if (err < 0) {
4144			BT_ERR("failed to set interface 0, alt 0 %d", err);
4145			goto out_free_dev;
 
4146		}
4147	}
4148
4149	if (data->isoc) {
4150		err = usb_driver_claim_interface(&btusb_driver,
4151						 data->isoc, data);
4152		if (err < 0)
4153			goto out_free_dev;
 
 
4154	}
4155
4156	if (IS_ENABLED(CONFIG_BT_HCIBTUSB_BCM) && data->diag) {
 
4157		if (!usb_driver_claim_interface(&btusb_driver,
4158						data->diag, data))
4159			__set_diag_interface(hdev);
4160		else
4161			data->diag = NULL;
4162	}
4163
4164	if (enable_autosuspend)
4165		usb_enable_autosuspend(data->udev);
4166
4167	err = hci_register_dev(hdev);
4168	if (err < 0)
4169		goto out_free_dev;
 
 
4170
4171	usb_set_intfdata(intf, data);
4172
4173	return 0;
4174
4175out_free_dev:
4176	if (data->reset_gpio)
4177		gpiod_put(data->reset_gpio);
4178	hci_free_dev(hdev);
4179	return err;
4180}
4181
4182static void btusb_disconnect(struct usb_interface *intf)
4183{
4184	struct btusb_data *data = usb_get_intfdata(intf);
4185	struct hci_dev *hdev;
4186
4187	BT_DBG("intf %p", intf);
4188
4189	if (!data)
4190		return;
4191
4192	hdev = data->hdev;
4193	usb_set_intfdata(data->intf, NULL);
4194
4195	if (data->isoc)
4196		usb_set_intfdata(data->isoc, NULL);
4197
4198	if (data->diag)
4199		usb_set_intfdata(data->diag, NULL);
4200
4201	hci_unregister_dev(hdev);
4202
4203	if (intf == data->intf) {
4204		if (data->isoc)
4205			usb_driver_release_interface(&btusb_driver, data->isoc);
4206		if (data->diag)
4207			usb_driver_release_interface(&btusb_driver, data->diag);
4208	} else if (intf == data->isoc) {
4209		if (data->diag)
4210			usb_driver_release_interface(&btusb_driver, data->diag);
4211		usb_driver_release_interface(&btusb_driver, data->intf);
4212	} else if (intf == data->diag) {
4213		usb_driver_release_interface(&btusb_driver, data->intf);
4214		if (data->isoc)
4215			usb_driver_release_interface(&btusb_driver, data->isoc);
4216	}
4217
4218	if (data->oob_wake_irq)
4219		device_init_wakeup(&data->udev->dev, false);
4220
4221	if (data->reset_gpio)
4222		gpiod_put(data->reset_gpio);
4223
4224	hci_free_dev(hdev);
4225}
4226
4227#ifdef CONFIG_PM
4228static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
4229{
4230	struct btusb_data *data = usb_get_intfdata(intf);
4231
4232	BT_DBG("intf %p", intf);
4233
4234	if (data->suspend_count++)
4235		return 0;
4236
4237	spin_lock_irq(&data->txlock);
4238	if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) {
4239		set_bit(BTUSB_SUSPENDING, &data->flags);
4240		spin_unlock_irq(&data->txlock);
4241	} else {
4242		spin_unlock_irq(&data->txlock);
4243		data->suspend_count--;
4244		return -EBUSY;
4245	}
4246
4247	cancel_work_sync(&data->work);
4248
4249	btusb_stop_traffic(data);
4250	usb_kill_anchored_urbs(&data->tx_anchor);
4251
4252	if (data->oob_wake_irq && device_may_wakeup(&data->udev->dev)) {
4253		set_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags);
4254		enable_irq_wake(data->oob_wake_irq);
4255		enable_irq(data->oob_wake_irq);
4256	}
4257
4258	/* For global suspend, Realtek devices lose the loaded fw
4259	 * in them. But for autosuspend, firmware should remain.
4260	 * Actually, it depends on whether the usb host sends
4261	 * set feature (enable wakeup) or not.
4262	 */
4263	if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags)) {
4264		if (PMSG_IS_AUTO(message) &&
4265		    device_can_wakeup(&data->udev->dev))
4266			data->udev->do_remote_wakeup = 1;
4267		else if (!PMSG_IS_AUTO(message))
4268			data->udev->reset_resume = 1;
4269	}
4270
4271	return 0;
4272}
4273
4274static void play_deferred(struct btusb_data *data)
4275{
4276	struct urb *urb;
4277	int err;
4278
4279	while ((urb = usb_get_from_anchor(&data->deferred))) {
4280		usb_anchor_urb(urb, &data->tx_anchor);
4281
4282		err = usb_submit_urb(urb, GFP_ATOMIC);
4283		if (err < 0) {
4284			if (err != -EPERM && err != -ENODEV)
4285				BT_ERR("%s urb %p submission failed (%d)",
4286				       data->hdev->name, urb, -err);
4287			kfree(urb->setup_packet);
4288			usb_unanchor_urb(urb);
4289			usb_free_urb(urb);
4290			break;
4291		}
4292
4293		data->tx_in_flight++;
4294		usb_free_urb(urb);
4295	}
4296
4297	/* Cleanup the rest deferred urbs. */
4298	while ((urb = usb_get_from_anchor(&data->deferred))) {
4299		kfree(urb->setup_packet);
4300		usb_free_urb(urb);
4301	}
 
4302}
4303
4304static int btusb_resume(struct usb_interface *intf)
4305{
4306	struct btusb_data *data = usb_get_intfdata(intf);
4307	struct hci_dev *hdev = data->hdev;
4308	int err = 0;
4309
4310	BT_DBG("intf %p", intf);
4311
4312	if (--data->suspend_count)
4313		return 0;
4314
4315	/* Disable only if not already disabled (keep it balanced) */
4316	if (test_and_clear_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags)) {
4317		disable_irq(data->oob_wake_irq);
4318		disable_irq_wake(data->oob_wake_irq);
4319	}
4320
4321	if (!test_bit(HCI_RUNNING, &hdev->flags))
4322		goto done;
4323
4324	if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
4325		err = btusb_submit_intr_urb(hdev, GFP_NOIO);
4326		if (err < 0) {
4327			clear_bit(BTUSB_INTR_RUNNING, &data->flags);
4328			goto failed;
4329		}
4330	}
4331
4332	if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
4333		err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
4334		if (err < 0) {
4335			clear_bit(BTUSB_BULK_RUNNING, &data->flags);
4336			goto failed;
4337		}
4338
4339		btusb_submit_bulk_urb(hdev, GFP_NOIO);
4340	}
4341
4342	if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
4343		if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
4344			clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
4345		else
4346			btusb_submit_isoc_urb(hdev, GFP_NOIO);
4347	}
4348
4349	spin_lock_irq(&data->txlock);
4350	play_deferred(data);
4351	clear_bit(BTUSB_SUSPENDING, &data->flags);
4352	spin_unlock_irq(&data->txlock);
4353	schedule_work(&data->work);
4354
4355	return 0;
4356
4357failed:
4358	usb_scuttle_anchored_urbs(&data->deferred);
4359done:
4360	spin_lock_irq(&data->txlock);
4361	clear_bit(BTUSB_SUSPENDING, &data->flags);
4362	spin_unlock_irq(&data->txlock);
4363
4364	return err;
4365}
4366#endif
4367
4368static struct usb_driver btusb_driver = {
4369	.name		= "btusb",
4370	.probe		= btusb_probe,
4371	.disconnect	= btusb_disconnect,
4372#ifdef CONFIG_PM
4373	.suspend	= btusb_suspend,
4374	.resume		= btusb_resume,
4375#endif
4376	.id_table	= btusb_table,
4377	.supports_autosuspend = 1,
4378	.disable_hub_initiated_lpm = 1,
4379};
4380
4381module_usb_driver(btusb_driver);
4382
4383module_param(disable_scofix, bool, 0644);
4384MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
4385
4386module_param(force_scofix, bool, 0644);
4387MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
4388
4389module_param(enable_autosuspend, bool, 0644);
4390MODULE_PARM_DESC(enable_autosuspend, "Enable USB autosuspend by default");
4391
4392module_param(reset, bool, 0644);
4393MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
4394
4395MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
4396MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
4397MODULE_VERSION(VERSION);
4398MODULE_LICENSE("GPL");
v4.6
 
   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
  38static bool disable_scofix;
  39static bool force_scofix;
 
  40
  41static bool reset = true;
  42
  43static 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
  66static const struct usb_device_id btusb_table[] = {
  67	/* Generic Bluetooth USB device */
  68	{ USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
  69
  70	/* Generic Bluetooth AMP device */
  71	{ USB_DEVICE_INFO(0xe0, 0x01, 0x04), .driver_info = BTUSB_AMP },
  72
  73	/* Generic Bluetooth USB interface */
  74	{ USB_INTERFACE_INFO(0xe0, 0x01, 0x01) },
  75
  76	/* Apple-specific (Broadcom) devices */
  77	{ USB_VENDOR_AND_INTERFACE_INFO(0x05ac, 0xff, 0x01, 0x01),
  78	  .driver_info = BTUSB_BCM_APPLE | BTUSB_IFNUM_2 },
  79
  80	/* MediaTek MT76x0E */
  81	{ USB_DEVICE(0x0e8d, 0x763f) },
  82
  83	/* Broadcom SoftSailing reporting vendor specific */
  84	{ USB_DEVICE(0x0a5c, 0x21e1) },
  85
  86	/* Apple MacBookPro 7,1 */
  87	{ USB_DEVICE(0x05ac, 0x8213) },
  88
  89	/* Apple iMac11,1 */
  90	{ USB_DEVICE(0x05ac, 0x8215) },
  91
  92	/* Apple MacBookPro6,2 */
  93	{ USB_DEVICE(0x05ac, 0x8218) },
  94
  95	/* Apple MacBookAir3,1, MacBookAir3,2 */
  96	{ USB_DEVICE(0x05ac, 0x821b) },
  97
  98	/* Apple MacBookAir4,1 */
  99	{ USB_DEVICE(0x05ac, 0x821f) },
 100
 101	/* Apple MacBookPro8,2 */
 102	{ USB_DEVICE(0x05ac, 0x821a) },
 103
 104	/* Apple MacMini5,1 */
 105	{ USB_DEVICE(0x05ac, 0x8281) },
 106
 107	/* AVM BlueFRITZ! USB v2.0 */
 108	{ USB_DEVICE(0x057c, 0x3800), .driver_info = BTUSB_SWAVE },
 109
 110	/* Bluetooth Ultraport Module from IBM */
 111	{ USB_DEVICE(0x04bf, 0x030a) },
 112
 113	/* ALPS Modules with non-standard id */
 114	{ USB_DEVICE(0x044e, 0x3001) },
 115	{ USB_DEVICE(0x044e, 0x3002) },
 116
 117	/* Ericsson with non-standard id */
 118	{ USB_DEVICE(0x0bdb, 0x1002) },
 119
 120	/* Canyon CN-BTU1 with HID interfaces */
 121	{ USB_DEVICE(0x0c10, 0x0000) },
 122
 123	/* Broadcom BCM20702A0 */
 124	{ USB_DEVICE(0x413c, 0x8197) },
 125
 126	/* Broadcom BCM20702B0 (Dynex/Insignia) */
 127	{ USB_DEVICE(0x19ff, 0x0239), .driver_info = BTUSB_BCM_PATCHRAM },
 128
 129	/* Broadcom BCM43142A0 (Foxconn/Lenovo) */
 130	{ USB_DEVICE(0x105b, 0xe065), .driver_info = BTUSB_BCM_PATCHRAM },
 
 
 
 
 
 131
 132	/* Foxconn - Hon Hai */
 133	{ USB_VENDOR_AND_INTERFACE_INFO(0x0489, 0xff, 0x01, 0x01),
 134	  .driver_info = BTUSB_BCM_PATCHRAM },
 135
 136	/* Lite-On Technology - Broadcom based */
 137	{ USB_VENDOR_AND_INTERFACE_INFO(0x04ca, 0xff, 0x01, 0x01),
 138	  .driver_info = BTUSB_BCM_PATCHRAM },
 139
 140	/* Broadcom devices with vendor specific id */
 141	{ USB_VENDOR_AND_INTERFACE_INFO(0x0a5c, 0xff, 0x01, 0x01),
 142	  .driver_info = BTUSB_BCM_PATCHRAM },
 143
 144	/* ASUSTek Computer - Broadcom based */
 145	{ USB_VENDOR_AND_INTERFACE_INFO(0x0b05, 0xff, 0x01, 0x01),
 146	  .driver_info = BTUSB_BCM_PATCHRAM },
 147
 148	/* Belkin F8065bf - Broadcom based */
 149	{ USB_VENDOR_AND_INTERFACE_INFO(0x050d, 0xff, 0x01, 0x01),
 150	  .driver_info = BTUSB_BCM_PATCHRAM },
 151
 152	/* IMC Networks - Broadcom based */
 153	{ USB_VENDOR_AND_INTERFACE_INFO(0x13d3, 0xff, 0x01, 0x01),
 154	  .driver_info = BTUSB_BCM_PATCHRAM },
 155
 
 
 
 
 156	/* Toshiba Corp - Broadcom based */
 157	{ USB_VENDOR_AND_INTERFACE_INFO(0x0930, 0xff, 0x01, 0x01),
 158	  .driver_info = BTUSB_BCM_PATCHRAM },
 159
 160	/* Intel Bluetooth USB Bootloader (RAM module) */
 161	{ USB_DEVICE(0x8087, 0x0a5a),
 162	  .driver_info = BTUSB_INTEL_BOOT | BTUSB_BROKEN_ISOC },
 163
 164	{ }	/* Terminating entry */
 165};
 166
 167MODULE_DEVICE_TABLE(usb, btusb_table);
 168
 169static const struct usb_device_id blacklist_table[] = {
 170	/* CSR BlueCore devices */
 171	{ USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
 172
 173	/* Broadcom BCM2033 without firmware */
 174	{ USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
 175
 176	/* Broadcom BCM2045 devices */
 177	{ USB_DEVICE(0x0a5c, 0x2045), .driver_info = BTUSB_BCM2045 },
 178
 179	/* Atheros 3011 with sflash firmware */
 180	{ USB_DEVICE(0x0489, 0xe027), .driver_info = BTUSB_IGNORE },
 181	{ USB_DEVICE(0x0489, 0xe03d), .driver_info = BTUSB_IGNORE },
 182	{ USB_DEVICE(0x04f2, 0xaff1), .driver_info = BTUSB_IGNORE },
 183	{ USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
 184	{ USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
 185	{ USB_DEVICE(0x0cf3, 0xe019), .driver_info = BTUSB_IGNORE },
 186	{ USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
 187
 188	/* Atheros AR9285 Malbec with sflash firmware */
 189	{ USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
 190
 191	/* Atheros 3012 with sflash firmware */
 192	{ USB_DEVICE(0x0489, 0xe04d), .driver_info = BTUSB_ATH3012 },
 193	{ USB_DEVICE(0x0489, 0xe04e), .driver_info = BTUSB_ATH3012 },
 194	{ USB_DEVICE(0x0489, 0xe056), .driver_info = BTUSB_ATH3012 },
 195	{ USB_DEVICE(0x0489, 0xe057), .driver_info = BTUSB_ATH3012 },
 196	{ USB_DEVICE(0x0489, 0xe05f), .driver_info = BTUSB_ATH3012 },
 197	{ USB_DEVICE(0x0489, 0xe076), .driver_info = BTUSB_ATH3012 },
 198	{ USB_DEVICE(0x0489, 0xe078), .driver_info = BTUSB_ATH3012 },
 199	{ USB_DEVICE(0x0489, 0xe095), .driver_info = BTUSB_ATH3012 },
 200	{ USB_DEVICE(0x04c5, 0x1330), .driver_info = BTUSB_ATH3012 },
 201	{ USB_DEVICE(0x04ca, 0x3004), .driver_info = BTUSB_ATH3012 },
 202	{ USB_DEVICE(0x04ca, 0x3005), .driver_info = BTUSB_ATH3012 },
 203	{ USB_DEVICE(0x04ca, 0x3006), .driver_info = BTUSB_ATH3012 },
 204	{ USB_DEVICE(0x04ca, 0x3007), .driver_info = BTUSB_ATH3012 },
 205	{ USB_DEVICE(0x04ca, 0x3008), .driver_info = BTUSB_ATH3012 },
 206	{ USB_DEVICE(0x04ca, 0x300b), .driver_info = BTUSB_ATH3012 },
 207	{ USB_DEVICE(0x04ca, 0x300d), .driver_info = BTUSB_ATH3012 },
 208	{ USB_DEVICE(0x04ca, 0x300f), .driver_info = BTUSB_ATH3012 },
 209	{ USB_DEVICE(0x04ca, 0x3010), .driver_info = BTUSB_ATH3012 },
 210	{ USB_DEVICE(0x04ca, 0x3014), .driver_info = BTUSB_ATH3012 },
 
 211	{ USB_DEVICE(0x0930, 0x0219), .driver_info = BTUSB_ATH3012 },
 212	{ USB_DEVICE(0x0930, 0x021c), .driver_info = BTUSB_ATH3012 },
 213	{ USB_DEVICE(0x0930, 0x0220), .driver_info = BTUSB_ATH3012 },
 214	{ USB_DEVICE(0x0930, 0x0227), .driver_info = BTUSB_ATH3012 },
 215	{ USB_DEVICE(0x0b05, 0x17d0), .driver_info = BTUSB_ATH3012 },
 216	{ USB_DEVICE(0x0cf3, 0x0036), .driver_info = BTUSB_ATH3012 },
 217	{ USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
 218	{ USB_DEVICE(0x0cf3, 0x3008), .driver_info = BTUSB_ATH3012 },
 219	{ USB_DEVICE(0x0cf3, 0x311d), .driver_info = BTUSB_ATH3012 },
 220	{ USB_DEVICE(0x0cf3, 0x311e), .driver_info = BTUSB_ATH3012 },
 221	{ USB_DEVICE(0x0cf3, 0x311f), .driver_info = BTUSB_ATH3012 },
 222	{ USB_DEVICE(0x0cf3, 0x3121), .driver_info = BTUSB_ATH3012 },
 223	{ USB_DEVICE(0x0cf3, 0x817a), .driver_info = BTUSB_ATH3012 },
 224	{ USB_DEVICE(0x0cf3, 0x817b), .driver_info = BTUSB_ATH3012 },
 225	{ USB_DEVICE(0x0cf3, 0xe003), .driver_info = BTUSB_ATH3012 },
 226	{ USB_DEVICE(0x0cf3, 0xe004), .driver_info = BTUSB_ATH3012 },
 227	{ USB_DEVICE(0x0cf3, 0xe005), .driver_info = BTUSB_ATH3012 },
 228	{ USB_DEVICE(0x0cf3, 0xe006), .driver_info = BTUSB_ATH3012 },
 229	{ USB_DEVICE(0x13d3, 0x3362), .driver_info = BTUSB_ATH3012 },
 230	{ USB_DEVICE(0x13d3, 0x3375), .driver_info = BTUSB_ATH3012 },
 231	{ USB_DEVICE(0x13d3, 0x3393), .driver_info = BTUSB_ATH3012 },
 232	{ USB_DEVICE(0x13d3, 0x3395), .driver_info = BTUSB_ATH3012 },
 233	{ USB_DEVICE(0x13d3, 0x3402), .driver_info = BTUSB_ATH3012 },
 234	{ USB_DEVICE(0x13d3, 0x3408), .driver_info = BTUSB_ATH3012 },
 235	{ USB_DEVICE(0x13d3, 0x3423), .driver_info = BTUSB_ATH3012 },
 236	{ USB_DEVICE(0x13d3, 0x3432), .driver_info = BTUSB_ATH3012 },
 237	{ USB_DEVICE(0x13d3, 0x3472), .driver_info = BTUSB_ATH3012 },
 238	{ USB_DEVICE(0x13d3, 0x3474), .driver_info = BTUSB_ATH3012 },
 
 
 239
 240	/* Atheros AR5BBU12 with sflash firmware */
 241	{ USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
 242
 243	/* Atheros AR5BBU12 with sflash firmware */
 244	{ USB_DEVICE(0x0489, 0xe036), .driver_info = BTUSB_ATH3012 },
 245	{ USB_DEVICE(0x0489, 0xe03c), .driver_info = BTUSB_ATH3012 },
 246
 247	/* QCA ROME chipset */
 
 248	{ USB_DEVICE(0x0cf3, 0xe007), .driver_info = BTUSB_QCA_ROME },
 
 
 249	{ USB_DEVICE(0x0cf3, 0xe300), .driver_info = BTUSB_QCA_ROME },
 
 250	{ USB_DEVICE(0x0cf3, 0xe360), .driver_info = BTUSB_QCA_ROME },
 
 
 
 
 
 
 
 
 
 
 
 251
 252	/* Broadcom BCM2035 */
 253	{ USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
 254	{ USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
 255	{ USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
 256
 257	/* Broadcom BCM2045 */
 258	{ USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
 259	{ USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
 260
 261	/* IBM/Lenovo ThinkPad with Broadcom chip */
 262	{ USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
 263	{ USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
 264
 265	/* HP laptop with Broadcom chip */
 266	{ USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
 267
 268	/* Dell laptop with Broadcom chip */
 269	{ USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
 270
 271	/* Dell Wireless 370 and 410 devices */
 272	{ USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
 273	{ USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
 274
 275	/* Belkin F8T012 and F8T013 devices */
 276	{ USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
 277	{ USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
 278
 279	/* Asus WL-BTD202 device */
 280	{ USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
 281
 282	/* Kensington Bluetooth USB adapter */
 283	{ USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
 284
 285	/* RTX Telecom based adapters with buggy SCO support */
 286	{ USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
 287	{ USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
 288
 289	/* CONWISE Technology based adapters with buggy SCO support */
 290	{ USB_DEVICE(0x0e5e, 0x6622), .driver_info = BTUSB_BROKEN_ISOC },
 
 291
 292	/* Roper Class 1 Bluetooth Dongle (Silicon Wave based) */
 293	{ USB_DEVICE(0x1310, 0x0001), .driver_info = BTUSB_SWAVE },
 294
 295	/* Digianswer devices */
 296	{ USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
 297	{ USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
 298
 299	/* CSR BlueCore Bluetooth Sniffer */
 300	{ USB_DEVICE(0x0a12, 0x0002),
 301	  .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
 302
 303	/* Frontline ComProbe Bluetooth Sniffer */
 304	{ USB_DEVICE(0x16d3, 0x0002),
 305	  .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
 306
 307	/* Marvell Bluetooth devices */
 308	{ USB_DEVICE(0x1286, 0x2044), .driver_info = BTUSB_MARVELL },
 309	{ USB_DEVICE(0x1286, 0x2046), .driver_info = BTUSB_MARVELL },
 
 310
 311	/* Intel Bluetooth devices */
 
 
 
 
 
 
 
 
 
 312	{ USB_DEVICE(0x8087, 0x07da), .driver_info = BTUSB_CSR },
 313	{ USB_DEVICE(0x8087, 0x07dc), .driver_info = BTUSB_INTEL },
 314	{ USB_DEVICE(0x8087, 0x0a2a), .driver_info = BTUSB_INTEL },
 315	{ USB_DEVICE(0x8087, 0x0a2b), .driver_info = BTUSB_INTEL_NEW },
 
 
 
 
 
 
 316
 317	/* Other Intel Bluetooth devices */
 318	{ USB_VENDOR_AND_INTERFACE_INFO(0x8087, 0xe0, 0x01, 0x01),
 319	  .driver_info = BTUSB_IGNORE },
 320
 
 
 
 
 321	/* Realtek Bluetooth devices */
 322	{ USB_VENDOR_AND_INTERFACE_INFO(0x0bda, 0xe0, 0x01, 0x01),
 323	  .driver_info = BTUSB_REALTEK },
 324
 
 
 
 
 325	/* Additional Realtek 8723AE Bluetooth devices */
 326	{ USB_DEVICE(0x0930, 0x021d), .driver_info = BTUSB_REALTEK },
 327	{ USB_DEVICE(0x13d3, 0x3394), .driver_info = BTUSB_REALTEK },
 328
 329	/* Additional Realtek 8723BE Bluetooth devices */
 330	{ USB_DEVICE(0x0489, 0xe085), .driver_info = BTUSB_REALTEK },
 331	{ USB_DEVICE(0x0489, 0xe08b), .driver_info = BTUSB_REALTEK },
 332	{ USB_DEVICE(0x13d3, 0x3410), .driver_info = BTUSB_REALTEK },
 333	{ USB_DEVICE(0x13d3, 0x3416), .driver_info = BTUSB_REALTEK },
 334	{ USB_DEVICE(0x13d3, 0x3459), .driver_info = BTUSB_REALTEK },
 
 
 
 
 
 
 
 
 335
 336	/* Additional Realtek 8821AE Bluetooth devices */
 337	{ USB_DEVICE(0x0b05, 0x17dc), .driver_info = BTUSB_REALTEK },
 338	{ USB_DEVICE(0x13d3, 0x3414), .driver_info = BTUSB_REALTEK },
 339	{ USB_DEVICE(0x13d3, 0x3458), .driver_info = BTUSB_REALTEK },
 340	{ USB_DEVICE(0x13d3, 0x3461), .driver_info = BTUSB_REALTEK },
 341	{ USB_DEVICE(0x13d3, 0x3462), .driver_info = BTUSB_REALTEK },
 342
 
 
 
 
 
 
 
 
 343	/* Silicon Wave based devices */
 344	{ USB_DEVICE(0x0c10, 0x0000), .driver_info = BTUSB_SWAVE },
 345
 346	{ }	/* Terminating entry */
 347};
 348
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 349#define BTUSB_MAX_ISOC_FRAMES	10
 350
 351#define BTUSB_INTR_RUNNING	0
 352#define BTUSB_BULK_RUNNING	1
 353#define BTUSB_ISOC_RUNNING	2
 354#define BTUSB_SUSPENDING	3
 355#define BTUSB_DID_ISO_RESUME	4
 356#define BTUSB_BOOTLOADER	5
 357#define BTUSB_DOWNLOADING	6
 358#define BTUSB_FIRMWARE_LOADED	7
 359#define BTUSB_FIRMWARE_FAILED	8
 360#define BTUSB_BOOTING		9
 361#define BTUSB_RESET_RESUME	10
 362#define BTUSB_DIAG_RUNNING	11
 
 
 
 
 363
 364struct btusb_data {
 365	struct hci_dev       *hdev;
 366	struct usb_device    *udev;
 367	struct usb_interface *intf;
 368	struct usb_interface *isoc;
 369	struct usb_interface *diag;
 
 370
 371	unsigned long flags;
 372
 373	struct work_struct work;
 374	struct work_struct waker;
 375
 376	struct usb_anchor deferred;
 377	struct usb_anchor tx_anchor;
 378	int tx_in_flight;
 379	spinlock_t txlock;
 380
 381	struct usb_anchor intr_anchor;
 382	struct usb_anchor bulk_anchor;
 383	struct usb_anchor isoc_anchor;
 384	struct usb_anchor diag_anchor;
 
 385	spinlock_t rxlock;
 386
 387	struct sk_buff *evt_skb;
 388	struct sk_buff *acl_skb;
 389	struct sk_buff *sco_skb;
 390
 391	struct usb_endpoint_descriptor *intr_ep;
 392	struct usb_endpoint_descriptor *bulk_tx_ep;
 393	struct usb_endpoint_descriptor *bulk_rx_ep;
 394	struct usb_endpoint_descriptor *isoc_tx_ep;
 395	struct usb_endpoint_descriptor *isoc_rx_ep;
 396	struct usb_endpoint_descriptor *diag_tx_ep;
 397	struct usb_endpoint_descriptor *diag_rx_ep;
 398
 
 
 399	__u8 cmdreq_type;
 400	__u8 cmdreq;
 401
 402	unsigned int sco_num;
 
 
 403	int isoc_altsetting;
 404	int suspend_count;
 405
 406	int (*recv_event)(struct hci_dev *hdev, struct sk_buff *skb);
 407	int (*recv_bulk)(struct btusb_data *data, void *buffer, int count);
 408
 409	int (*setup_on_usb)(struct hci_dev *hdev);
 
 
 
 410};
 411
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 412static inline void btusb_free_frags(struct btusb_data *data)
 413{
 414	unsigned long flags;
 415
 416	spin_lock_irqsave(&data->rxlock, flags);
 417
 418	kfree_skb(data->evt_skb);
 419	data->evt_skb = NULL;
 420
 421	kfree_skb(data->acl_skb);
 422	data->acl_skb = NULL;
 423
 424	kfree_skb(data->sco_skb);
 425	data->sco_skb = NULL;
 426
 427	spin_unlock_irqrestore(&data->rxlock, flags);
 428}
 429
 430static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count)
 431{
 432	struct sk_buff *skb;
 
 433	int err = 0;
 434
 435	spin_lock(&data->rxlock);
 436	skb = data->evt_skb;
 437
 438	while (count) {
 439		int len;
 440
 441		if (!skb) {
 442			skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC);
 443			if (!skb) {
 444				err = -ENOMEM;
 445				break;
 446			}
 447
 448			hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
 449			hci_skb_expect(skb) = HCI_EVENT_HDR_SIZE;
 450		}
 451
 452		len = min_t(uint, hci_skb_expect(skb), count);
 453		memcpy(skb_put(skb, len), buffer, len);
 454
 455		count -= len;
 456		buffer += len;
 457		hci_skb_expect(skb) -= len;
 458
 459		if (skb->len == HCI_EVENT_HDR_SIZE) {
 460			/* Complete event header */
 461			hci_skb_expect(skb) = hci_event_hdr(skb)->plen;
 462
 463			if (skb_tailroom(skb) < hci_skb_expect(skb)) {
 464				kfree_skb(skb);
 465				skb = NULL;
 466
 467				err = -EILSEQ;
 468				break;
 469			}
 470		}
 471
 472		if (!hci_skb_expect(skb)) {
 473			/* Complete frame */
 474			data->recv_event(data->hdev, skb);
 475			skb = NULL;
 476		}
 477	}
 478
 479	data->evt_skb = skb;
 480	spin_unlock(&data->rxlock);
 481
 482	return err;
 483}
 484
 485static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count)
 486{
 487	struct sk_buff *skb;
 
 488	int err = 0;
 489
 490	spin_lock(&data->rxlock);
 491	skb = data->acl_skb;
 492
 493	while (count) {
 494		int len;
 495
 496		if (!skb) {
 497			skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
 498			if (!skb) {
 499				err = -ENOMEM;
 500				break;
 501			}
 502
 503			hci_skb_pkt_type(skb) = HCI_ACLDATA_PKT;
 504			hci_skb_expect(skb) = HCI_ACL_HDR_SIZE;
 505		}
 506
 507		len = min_t(uint, hci_skb_expect(skb), count);
 508		memcpy(skb_put(skb, len), buffer, len);
 509
 510		count -= len;
 511		buffer += len;
 512		hci_skb_expect(skb) -= len;
 513
 514		if (skb->len == HCI_ACL_HDR_SIZE) {
 515			__le16 dlen = hci_acl_hdr(skb)->dlen;
 516
 517			/* Complete ACL header */
 518			hci_skb_expect(skb) = __le16_to_cpu(dlen);
 519
 520			if (skb_tailroom(skb) < hci_skb_expect(skb)) {
 521				kfree_skb(skb);
 522				skb = NULL;
 523
 524				err = -EILSEQ;
 525				break;
 526			}
 527		}
 528
 529		if (!hci_skb_expect(skb)) {
 530			/* Complete frame */
 531			hci_recv_frame(data->hdev, skb);
 532			skb = NULL;
 533		}
 534	}
 535
 536	data->acl_skb = skb;
 537	spin_unlock(&data->rxlock);
 538
 539	return err;
 540}
 541
 542static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count)
 543{
 544	struct sk_buff *skb;
 
 545	int err = 0;
 546
 547	spin_lock(&data->rxlock);
 548	skb = data->sco_skb;
 549
 550	while (count) {
 551		int len;
 552
 553		if (!skb) {
 554			skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC);
 555			if (!skb) {
 556				err = -ENOMEM;
 557				break;
 558			}
 559
 560			hci_skb_pkt_type(skb) = HCI_SCODATA_PKT;
 561			hci_skb_expect(skb) = HCI_SCO_HDR_SIZE;
 562		}
 563
 564		len = min_t(uint, hci_skb_expect(skb), count);
 565		memcpy(skb_put(skb, len), buffer, len);
 566
 567		count -= len;
 568		buffer += len;
 569		hci_skb_expect(skb) -= len;
 570
 571		if (skb->len == HCI_SCO_HDR_SIZE) {
 572			/* Complete SCO header */
 573			hci_skb_expect(skb) = hci_sco_hdr(skb)->dlen;
 574
 575			if (skb_tailroom(skb) < hci_skb_expect(skb)) {
 576				kfree_skb(skb);
 577				skb = NULL;
 578
 579				err = -EILSEQ;
 580				break;
 581			}
 582		}
 583
 584		if (!hci_skb_expect(skb)) {
 585			/* Complete frame */
 586			hci_recv_frame(data->hdev, skb);
 587			skb = NULL;
 588		}
 589	}
 590
 591	data->sco_skb = skb;
 592	spin_unlock(&data->rxlock);
 593
 594	return err;
 595}
 596
 597static void btusb_intr_complete(struct urb *urb)
 598{
 599	struct hci_dev *hdev = urb->context;
 600	struct btusb_data *data = hci_get_drvdata(hdev);
 601	int err;
 602
 603	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 604	       urb->actual_length);
 605
 606	if (!test_bit(HCI_RUNNING, &hdev->flags))
 607		return;
 608
 609	if (urb->status == 0) {
 610		hdev->stat.byte_rx += urb->actual_length;
 611
 612		if (btusb_recv_intr(data, urb->transfer_buffer,
 613				    urb->actual_length) < 0) {
 614			BT_ERR("%s corrupted event packet", hdev->name);
 615			hdev->stat.err_rx++;
 616		}
 617	} else if (urb->status == -ENOENT) {
 618		/* Avoid suspend failed when usb_kill_urb */
 619		return;
 620	}
 621
 622	if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
 623		return;
 624
 625	usb_mark_last_busy(data->udev);
 626	usb_anchor_urb(urb, &data->intr_anchor);
 627
 628	err = usb_submit_urb(urb, GFP_ATOMIC);
 629	if (err < 0) {
 630		/* -EPERM: urb is being killed;
 631		 * -ENODEV: device got disconnected */
 
 632		if (err != -EPERM && err != -ENODEV)
 633			BT_ERR("%s urb %p failed to resubmit (%d)",
 634			       hdev->name, urb, -err);
 635		usb_unanchor_urb(urb);
 636	}
 637}
 638
 639static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
 640{
 641	struct btusb_data *data = hci_get_drvdata(hdev);
 642	struct urb *urb;
 643	unsigned char *buf;
 644	unsigned int pipe;
 645	int err, size;
 646
 647	BT_DBG("%s", hdev->name);
 648
 649	if (!data->intr_ep)
 650		return -ENODEV;
 651
 652	urb = usb_alloc_urb(0, mem_flags);
 653	if (!urb)
 654		return -ENOMEM;
 655
 656	size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
 657
 658	buf = kmalloc(size, mem_flags);
 659	if (!buf) {
 660		usb_free_urb(urb);
 661		return -ENOMEM;
 662	}
 663
 664	pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
 665
 666	usb_fill_int_urb(urb, data->udev, pipe, buf, size,
 667			 btusb_intr_complete, hdev, data->intr_ep->bInterval);
 668
 669	urb->transfer_flags |= URB_FREE_BUFFER;
 670
 671	usb_anchor_urb(urb, &data->intr_anchor);
 672
 673	err = usb_submit_urb(urb, mem_flags);
 674	if (err < 0) {
 675		if (err != -EPERM && err != -ENODEV)
 676			BT_ERR("%s urb %p submission failed (%d)",
 677			       hdev->name, urb, -err);
 678		usb_unanchor_urb(urb);
 679	}
 680
 681	usb_free_urb(urb);
 682
 683	return err;
 684}
 685
 686static void btusb_bulk_complete(struct urb *urb)
 687{
 688	struct hci_dev *hdev = urb->context;
 689	struct btusb_data *data = hci_get_drvdata(hdev);
 690	int err;
 691
 692	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 693	       urb->actual_length);
 694
 695	if (!test_bit(HCI_RUNNING, &hdev->flags))
 696		return;
 697
 698	if (urb->status == 0) {
 699		hdev->stat.byte_rx += urb->actual_length;
 700
 701		if (data->recv_bulk(data, urb->transfer_buffer,
 702				    urb->actual_length) < 0) {
 703			BT_ERR("%s corrupted ACL packet", hdev->name);
 704			hdev->stat.err_rx++;
 705		}
 706	} else if (urb->status == -ENOENT) {
 707		/* Avoid suspend failed when usb_kill_urb */
 708		return;
 709	}
 710
 711	if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
 712		return;
 713
 714	usb_anchor_urb(urb, &data->bulk_anchor);
 715	usb_mark_last_busy(data->udev);
 716
 717	err = usb_submit_urb(urb, GFP_ATOMIC);
 718	if (err < 0) {
 719		/* -EPERM: urb is being killed;
 720		 * -ENODEV: device got disconnected */
 
 721		if (err != -EPERM && err != -ENODEV)
 722			BT_ERR("%s urb %p failed to resubmit (%d)",
 723			       hdev->name, urb, -err);
 724		usb_unanchor_urb(urb);
 725	}
 726}
 727
 728static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
 729{
 730	struct btusb_data *data = hci_get_drvdata(hdev);
 731	struct urb *urb;
 732	unsigned char *buf;
 733	unsigned int pipe;
 734	int err, size = HCI_MAX_FRAME_SIZE;
 735
 736	BT_DBG("%s", hdev->name);
 737
 738	if (!data->bulk_rx_ep)
 739		return -ENODEV;
 740
 741	urb = usb_alloc_urb(0, mem_flags);
 742	if (!urb)
 743		return -ENOMEM;
 744
 745	buf = kmalloc(size, mem_flags);
 746	if (!buf) {
 747		usb_free_urb(urb);
 748		return -ENOMEM;
 749	}
 750
 751	pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
 752
 753	usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
 754			  btusb_bulk_complete, hdev);
 755
 756	urb->transfer_flags |= URB_FREE_BUFFER;
 757
 758	usb_mark_last_busy(data->udev);
 759	usb_anchor_urb(urb, &data->bulk_anchor);
 760
 761	err = usb_submit_urb(urb, mem_flags);
 762	if (err < 0) {
 763		if (err != -EPERM && err != -ENODEV)
 764			BT_ERR("%s urb %p submission failed (%d)",
 765			       hdev->name, urb, -err);
 766		usb_unanchor_urb(urb);
 767	}
 768
 769	usb_free_urb(urb);
 770
 771	return err;
 772}
 773
 774static void btusb_isoc_complete(struct urb *urb)
 775{
 776	struct hci_dev *hdev = urb->context;
 777	struct btusb_data *data = hci_get_drvdata(hdev);
 778	int i, err;
 779
 780	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 781	       urb->actual_length);
 782
 783	if (!test_bit(HCI_RUNNING, &hdev->flags))
 784		return;
 785
 786	if (urb->status == 0) {
 787		for (i = 0; i < urb->number_of_packets; i++) {
 788			unsigned int offset = urb->iso_frame_desc[i].offset;
 789			unsigned int length = urb->iso_frame_desc[i].actual_length;
 790
 791			if (urb->iso_frame_desc[i].status)
 792				continue;
 793
 794			hdev->stat.byte_rx += length;
 795
 796			if (btusb_recv_isoc(data, urb->transfer_buffer + offset,
 797					    length) < 0) {
 798				BT_ERR("%s corrupted SCO packet", hdev->name);
 799				hdev->stat.err_rx++;
 800			}
 801		}
 802	} else if (urb->status == -ENOENT) {
 803		/* Avoid suspend failed when usb_kill_urb */
 804		return;
 805	}
 806
 807	if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
 808		return;
 809
 810	usb_anchor_urb(urb, &data->isoc_anchor);
 811
 812	err = usb_submit_urb(urb, GFP_ATOMIC);
 813	if (err < 0) {
 814		/* -EPERM: urb is being killed;
 815		 * -ENODEV: device got disconnected */
 
 816		if (err != -EPERM && err != -ENODEV)
 817			BT_ERR("%s urb %p failed to resubmit (%d)",
 818			       hdev->name, urb, -err);
 819		usb_unanchor_urb(urb);
 820	}
 821}
 822
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 823static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
 824{
 825	int i, offset = 0;
 826
 827	BT_DBG("len %d mtu %d", len, mtu);
 828
 829	for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
 830					i++, offset += mtu, len -= mtu) {
 831		urb->iso_frame_desc[i].offset = offset;
 832		urb->iso_frame_desc[i].length = mtu;
 833	}
 834
 835	if (len && i < BTUSB_MAX_ISOC_FRAMES) {
 836		urb->iso_frame_desc[i].offset = offset;
 837		urb->iso_frame_desc[i].length = len;
 838		i++;
 839	}
 840
 841	urb->number_of_packets = i;
 842}
 843
 844static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
 845{
 846	struct btusb_data *data = hci_get_drvdata(hdev);
 847	struct urb *urb;
 848	unsigned char *buf;
 849	unsigned int pipe;
 850	int err, size;
 851
 852	BT_DBG("%s", hdev->name);
 853
 854	if (!data->isoc_rx_ep)
 855		return -ENODEV;
 856
 857	urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
 858	if (!urb)
 859		return -ENOMEM;
 860
 861	size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
 862						BTUSB_MAX_ISOC_FRAMES;
 863
 864	buf = kmalloc(size, mem_flags);
 865	if (!buf) {
 866		usb_free_urb(urb);
 867		return -ENOMEM;
 868	}
 869
 870	pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
 871
 872	usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_isoc_complete,
 873			 hdev, data->isoc_rx_ep->bInterval);
 874
 875	urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
 876
 877	__fill_isoc_descriptor(urb, size,
 878			       le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
 879
 880	usb_anchor_urb(urb, &data->isoc_anchor);
 881
 882	err = usb_submit_urb(urb, mem_flags);
 883	if (err < 0) {
 884		if (err != -EPERM && err != -ENODEV)
 885			BT_ERR("%s urb %p submission failed (%d)",
 886			       hdev->name, urb, -err);
 887		usb_unanchor_urb(urb);
 888	}
 889
 890	usb_free_urb(urb);
 891
 892	return err;
 893}
 894
 895static void btusb_diag_complete(struct urb *urb)
 896{
 897	struct hci_dev *hdev = urb->context;
 898	struct btusb_data *data = hci_get_drvdata(hdev);
 899	int err;
 900
 901	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 902	       urb->actual_length);
 903
 904	if (urb->status == 0) {
 905		struct sk_buff *skb;
 906
 907		skb = bt_skb_alloc(urb->actual_length, GFP_ATOMIC);
 908		if (skb) {
 909			memcpy(skb_put(skb, urb->actual_length),
 910			       urb->transfer_buffer, urb->actual_length);
 911			hci_recv_diag(hdev, skb);
 912		}
 913	} else if (urb->status == -ENOENT) {
 914		/* Avoid suspend failed when usb_kill_urb */
 915		return;
 916	}
 917
 918	if (!test_bit(BTUSB_DIAG_RUNNING, &data->flags))
 919		return;
 920
 921	usb_anchor_urb(urb, &data->diag_anchor);
 922	usb_mark_last_busy(data->udev);
 923
 924	err = usb_submit_urb(urb, GFP_ATOMIC);
 925	if (err < 0) {
 926		/* -EPERM: urb is being killed;
 927		 * -ENODEV: device got disconnected */
 
 928		if (err != -EPERM && err != -ENODEV)
 929			BT_ERR("%s urb %p failed to resubmit (%d)",
 930			       hdev->name, urb, -err);
 931		usb_unanchor_urb(urb);
 932	}
 933}
 934
 935static int btusb_submit_diag_urb(struct hci_dev *hdev, gfp_t mem_flags)
 936{
 937	struct btusb_data *data = hci_get_drvdata(hdev);
 938	struct urb *urb;
 939	unsigned char *buf;
 940	unsigned int pipe;
 941	int err, size = HCI_MAX_FRAME_SIZE;
 942
 943	BT_DBG("%s", hdev->name);
 944
 945	if (!data->diag_rx_ep)
 946		return -ENODEV;
 947
 948	urb = usb_alloc_urb(0, mem_flags);
 949	if (!urb)
 950		return -ENOMEM;
 951
 952	buf = kmalloc(size, mem_flags);
 953	if (!buf) {
 954		usb_free_urb(urb);
 955		return -ENOMEM;
 956	}
 957
 958	pipe = usb_rcvbulkpipe(data->udev, data->diag_rx_ep->bEndpointAddress);
 959
 960	usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
 961			  btusb_diag_complete, hdev);
 962
 963	urb->transfer_flags |= URB_FREE_BUFFER;
 964
 965	usb_mark_last_busy(data->udev);
 966	usb_anchor_urb(urb, &data->diag_anchor);
 967
 968	err = usb_submit_urb(urb, mem_flags);
 969	if (err < 0) {
 970		if (err != -EPERM && err != -ENODEV)
 971			BT_ERR("%s urb %p submission failed (%d)",
 972			       hdev->name, urb, -err);
 973		usb_unanchor_urb(urb);
 974	}
 975
 976	usb_free_urb(urb);
 977
 978	return err;
 979}
 980
 981static void btusb_tx_complete(struct urb *urb)
 982{
 983	struct sk_buff *skb = urb->context;
 984	struct hci_dev *hdev = (struct hci_dev *)skb->dev;
 985	struct btusb_data *data = hci_get_drvdata(hdev);
 
 986
 987	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
 988	       urb->actual_length);
 989
 990	if (!test_bit(HCI_RUNNING, &hdev->flags))
 991		goto done;
 992
 993	if (!urb->status)
 994		hdev->stat.byte_tx += urb->transfer_buffer_length;
 995	else
 996		hdev->stat.err_tx++;
 997
 998done:
 999	spin_lock(&data->txlock);
1000	data->tx_in_flight--;
1001	spin_unlock(&data->txlock);
1002
1003	kfree(urb->setup_packet);
1004
1005	kfree_skb(skb);
1006}
1007
1008static void btusb_isoc_tx_complete(struct urb *urb)
1009{
1010	struct sk_buff *skb = urb->context;
1011	struct hci_dev *hdev = (struct hci_dev *)skb->dev;
1012
1013	BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1014	       urb->actual_length);
1015
1016	if (!test_bit(HCI_RUNNING, &hdev->flags))
1017		goto done;
1018
1019	if (!urb->status)
1020		hdev->stat.byte_tx += urb->transfer_buffer_length;
1021	else
1022		hdev->stat.err_tx++;
1023
1024done:
1025	kfree(urb->setup_packet);
1026
1027	kfree_skb(skb);
1028}
1029
1030static int btusb_open(struct hci_dev *hdev)
1031{
1032	struct btusb_data *data = hci_get_drvdata(hdev);
1033	int err;
1034
1035	BT_DBG("%s", hdev->name);
1036
 
 
 
 
1037	/* Patching USB firmware files prior to starting any URBs of HCI path
1038	 * It is more safe to use USB bulk channel for downloading USB patch
1039	 */
1040	if (data->setup_on_usb) {
1041		err = data->setup_on_usb(hdev);
1042		if (err < 0)
1043			return err;
1044	}
1045
1046	err = usb_autopm_get_interface(data->intf);
1047	if (err < 0)
1048		return err;
1049
1050	data->intf->needs_remote_wakeup = 1;
 
 
 
 
 
1051
1052	if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
1053		goto done;
1054
1055	err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
1056	if (err < 0)
1057		goto failed;
1058
1059	err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1060	if (err < 0) {
1061		usb_kill_anchored_urbs(&data->intr_anchor);
1062		goto failed;
1063	}
1064
1065	set_bit(BTUSB_BULK_RUNNING, &data->flags);
1066	btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1067
1068	if (data->diag) {
1069		if (!btusb_submit_diag_urb(hdev, GFP_KERNEL))
1070			set_bit(BTUSB_DIAG_RUNNING, &data->flags);
1071	}
1072
1073done:
1074	usb_autopm_put_interface(data->intf);
1075	return 0;
1076
1077failed:
1078	clear_bit(BTUSB_INTR_RUNNING, &data->flags);
 
1079	usb_autopm_put_interface(data->intf);
1080	return err;
1081}
1082
1083static void btusb_stop_traffic(struct btusb_data *data)
1084{
1085	usb_kill_anchored_urbs(&data->intr_anchor);
1086	usb_kill_anchored_urbs(&data->bulk_anchor);
1087	usb_kill_anchored_urbs(&data->isoc_anchor);
1088	usb_kill_anchored_urbs(&data->diag_anchor);
 
1089}
1090
1091static int btusb_close(struct hci_dev *hdev)
1092{
1093	struct btusb_data *data = hci_get_drvdata(hdev);
1094	int err;
1095
1096	BT_DBG("%s", hdev->name);
1097
1098	cancel_work_sync(&data->work);
1099	cancel_work_sync(&data->waker);
1100
1101	clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1102	clear_bit(BTUSB_BULK_RUNNING, &data->flags);
1103	clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1104	clear_bit(BTUSB_DIAG_RUNNING, &data->flags);
1105
1106	btusb_stop_traffic(data);
1107	btusb_free_frags(data);
1108
1109	err = usb_autopm_get_interface(data->intf);
1110	if (err < 0)
1111		goto failed;
1112
1113	data->intf->needs_remote_wakeup = 0;
 
 
 
 
 
1114	usb_autopm_put_interface(data->intf);
1115
1116failed:
1117	usb_scuttle_anchored_urbs(&data->deferred);
1118	return 0;
1119}
1120
1121static int btusb_flush(struct hci_dev *hdev)
1122{
1123	struct btusb_data *data = hci_get_drvdata(hdev);
1124
1125	BT_DBG("%s", hdev->name);
1126
1127	usb_kill_anchored_urbs(&data->tx_anchor);
1128	btusb_free_frags(data);
1129
1130	return 0;
1131}
1132
1133static struct urb *alloc_ctrl_urb(struct hci_dev *hdev, struct sk_buff *skb)
1134{
1135	struct btusb_data *data = hci_get_drvdata(hdev);
1136	struct usb_ctrlrequest *dr;
1137	struct urb *urb;
1138	unsigned int pipe;
1139
1140	urb = usb_alloc_urb(0, GFP_KERNEL);
1141	if (!urb)
1142		return ERR_PTR(-ENOMEM);
1143
1144	dr = kmalloc(sizeof(*dr), GFP_KERNEL);
1145	if (!dr) {
1146		usb_free_urb(urb);
1147		return ERR_PTR(-ENOMEM);
1148	}
1149
1150	dr->bRequestType = data->cmdreq_type;
1151	dr->bRequest     = data->cmdreq;
1152	dr->wIndex       = 0;
1153	dr->wValue       = 0;
1154	dr->wLength      = __cpu_to_le16(skb->len);
1155
1156	pipe = usb_sndctrlpipe(data->udev, 0x00);
1157
1158	usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
1159			     skb->data, skb->len, btusb_tx_complete, skb);
1160
1161	skb->dev = (void *)hdev;
1162
1163	return urb;
1164}
1165
1166static struct urb *alloc_bulk_urb(struct hci_dev *hdev, struct sk_buff *skb)
1167{
1168	struct btusb_data *data = hci_get_drvdata(hdev);
1169	struct urb *urb;
1170	unsigned int pipe;
1171
1172	if (!data->bulk_tx_ep)
1173		return ERR_PTR(-ENODEV);
1174
1175	urb = usb_alloc_urb(0, GFP_KERNEL);
1176	if (!urb)
1177		return ERR_PTR(-ENOMEM);
1178
1179	pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress);
1180
1181	usb_fill_bulk_urb(urb, data->udev, pipe,
1182			  skb->data, skb->len, btusb_tx_complete, skb);
1183
1184	skb->dev = (void *)hdev;
1185
1186	return urb;
1187}
1188
1189static struct urb *alloc_isoc_urb(struct hci_dev *hdev, struct sk_buff *skb)
1190{
1191	struct btusb_data *data = hci_get_drvdata(hdev);
1192	struct urb *urb;
1193	unsigned int pipe;
1194
1195	if (!data->isoc_tx_ep)
1196		return ERR_PTR(-ENODEV);
1197
1198	urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_KERNEL);
1199	if (!urb)
1200		return ERR_PTR(-ENOMEM);
1201
1202	pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress);
1203
1204	usb_fill_int_urb(urb, data->udev, pipe,
1205			 skb->data, skb->len, btusb_isoc_tx_complete,
1206			 skb, data->isoc_tx_ep->bInterval);
1207
1208	urb->transfer_flags  = URB_ISO_ASAP;
1209
1210	__fill_isoc_descriptor(urb, skb->len,
1211			       le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
1212
 
 
 
 
1213	skb->dev = (void *)hdev;
1214
1215	return urb;
1216}
1217
1218static int submit_tx_urb(struct hci_dev *hdev, struct urb *urb)
1219{
1220	struct btusb_data *data = hci_get_drvdata(hdev);
1221	int err;
1222
1223	usb_anchor_urb(urb, &data->tx_anchor);
1224
1225	err = usb_submit_urb(urb, GFP_KERNEL);
1226	if (err < 0) {
1227		if (err != -EPERM && err != -ENODEV)
1228			BT_ERR("%s urb %p submission failed (%d)",
1229			       hdev->name, urb, -err);
1230		kfree(urb->setup_packet);
1231		usb_unanchor_urb(urb);
1232	} else {
1233		usb_mark_last_busy(data->udev);
1234	}
1235
1236	usb_free_urb(urb);
1237	return err;
1238}
1239
1240static int submit_or_queue_tx_urb(struct hci_dev *hdev, struct urb *urb)
1241{
1242	struct btusb_data *data = hci_get_drvdata(hdev);
1243	unsigned long flags;
1244	bool suspending;
1245
1246	spin_lock_irqsave(&data->txlock, flags);
1247	suspending = test_bit(BTUSB_SUSPENDING, &data->flags);
1248	if (!suspending)
1249		data->tx_in_flight++;
1250	spin_unlock_irqrestore(&data->txlock, flags);
1251
1252	if (!suspending)
1253		return submit_tx_urb(hdev, urb);
1254
1255	usb_anchor_urb(urb, &data->deferred);
1256	schedule_work(&data->waker);
1257
1258	usb_free_urb(urb);
1259	return 0;
1260}
1261
1262static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
1263{
1264	struct urb *urb;
1265
1266	BT_DBG("%s", hdev->name);
1267
1268	switch (hci_skb_pkt_type(skb)) {
1269	case HCI_COMMAND_PKT:
1270		urb = alloc_ctrl_urb(hdev, skb);
1271		if (IS_ERR(urb))
1272			return PTR_ERR(urb);
1273
1274		hdev->stat.cmd_tx++;
1275		return submit_or_queue_tx_urb(hdev, urb);
1276
1277	case HCI_ACLDATA_PKT:
1278		urb = alloc_bulk_urb(hdev, skb);
1279		if (IS_ERR(urb))
1280			return PTR_ERR(urb);
1281
1282		hdev->stat.acl_tx++;
1283		return submit_or_queue_tx_urb(hdev, urb);
1284
1285	case HCI_SCODATA_PKT:
1286		if (hci_conn_num(hdev, SCO_LINK) < 1)
1287			return -ENODEV;
1288
1289		urb = alloc_isoc_urb(hdev, skb);
1290		if (IS_ERR(urb))
1291			return PTR_ERR(urb);
1292
1293		hdev->stat.sco_tx++;
1294		return submit_tx_urb(hdev, urb);
1295	}
1296
1297	return -EILSEQ;
1298}
1299
1300static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
1301{
1302	struct btusb_data *data = hci_get_drvdata(hdev);
1303
1304	BT_DBG("%s evt %d", hdev->name, evt);
1305
1306	if (hci_conn_num(hdev, SCO_LINK) != data->sco_num) {
1307		data->sco_num = hci_conn_num(hdev, SCO_LINK);
 
1308		schedule_work(&data->work);
1309	}
1310}
1311
1312static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
1313{
1314	struct btusb_data *data = hci_get_drvdata(hdev);
1315	struct usb_interface *intf = data->isoc;
1316	struct usb_endpoint_descriptor *ep_desc;
1317	int i, err;
1318
1319	if (!data->isoc)
1320		return -ENODEV;
1321
1322	err = usb_set_interface(data->udev, 1, altsetting);
1323	if (err < 0) {
1324		BT_ERR("%s setting interface failed (%d)", hdev->name, -err);
1325		return err;
1326	}
1327
1328	data->isoc_altsetting = altsetting;
1329
1330	data->isoc_tx_ep = NULL;
1331	data->isoc_rx_ep = NULL;
1332
1333	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1334		ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1335
1336		if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
1337			data->isoc_tx_ep = ep_desc;
1338			continue;
1339		}
1340
1341		if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
1342			data->isoc_rx_ep = ep_desc;
1343			continue;
1344		}
1345	}
1346
1347	if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
1348		BT_ERR("%s invalid SCO descriptors", hdev->name);
1349		return -ENODEV;
1350	}
1351
1352	return 0;
1353}
1354
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1355static void btusb_work(struct work_struct *work)
1356{
1357	struct btusb_data *data = container_of(work, struct btusb_data, work);
1358	struct hci_dev *hdev = data->hdev;
1359	int new_alts;
1360	int err;
1361
1362	if (data->sco_num > 0) {
1363		if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
1364			err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
1365			if (err < 0) {
1366				clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1367				usb_kill_anchored_urbs(&data->isoc_anchor);
1368				return;
1369			}
1370
1371			set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
1372		}
1373
1374		if (hdev->voice_setting & 0x0020) {
1375			static const int alts[3] = { 2, 4, 5 };
1376
1377			new_alts = alts[data->sco_num - 1];
1378		} else {
1379			new_alts = data->sco_num;
 
 
 
 
 
 
 
 
 
 
 
 
1380		}
1381
1382		if (data->isoc_altsetting != new_alts) {
1383			unsigned long flags;
1384
1385			clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1386			usb_kill_anchored_urbs(&data->isoc_anchor);
1387
1388			/* When isochronous alternate setting needs to be
1389			 * changed, because SCO connection has been added
1390			 * or removed, a packet fragment may be left in the
1391			 * reassembling state. This could lead to wrongly
1392			 * assembled fragments.
1393			 *
1394			 * Clear outstanding fragment when selecting a new
1395			 * alternate setting.
1396			 */
1397			spin_lock_irqsave(&data->rxlock, flags);
1398			kfree_skb(data->sco_skb);
1399			data->sco_skb = NULL;
1400			spin_unlock_irqrestore(&data->rxlock, flags);
1401
1402			if (__set_isoc_interface(hdev, new_alts) < 0)
1403				return;
1404		}
1405
1406		if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
1407			if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
1408				clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1409			else
1410				btusb_submit_isoc_urb(hdev, GFP_KERNEL);
1411		}
1412	} else {
1413		clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1414		usb_kill_anchored_urbs(&data->isoc_anchor);
1415
1416		__set_isoc_interface(hdev, 0);
1417		if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
1418			usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
1419	}
1420}
1421
1422static void btusb_waker(struct work_struct *work)
1423{
1424	struct btusb_data *data = container_of(work, struct btusb_data, waker);
1425	int err;
1426
1427	err = usb_autopm_get_interface(data->intf);
1428	if (err < 0)
1429		return;
1430
1431	usb_autopm_put_interface(data->intf);
1432}
1433
1434static int btusb_setup_bcm92035(struct hci_dev *hdev)
1435{
1436	struct sk_buff *skb;
1437	u8 val = 0x00;
1438
1439	BT_DBG("%s", hdev->name);
1440
1441	skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);
1442	if (IS_ERR(skb))
1443		BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb));
1444	else
1445		kfree_skb(skb);
1446
1447	return 0;
1448}
1449
1450static int btusb_setup_csr(struct hci_dev *hdev)
1451{
1452	struct hci_rp_read_local_version *rp;
1453	struct sk_buff *skb;
 
1454
1455	BT_DBG("%s", hdev->name);
1456
1457	skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1458			     HCI_INIT_TIMEOUT);
1459	if (IS_ERR(skb)) {
1460		int err = PTR_ERR(skb);
1461		BT_ERR("%s: CSR: Local version failed (%d)", hdev->name, err);
1462		return err;
1463	}
1464
1465	if (skb->len != sizeof(struct hci_rp_read_local_version)) {
1466		BT_ERR("%s: CSR: Local version length mismatch", hdev->name);
1467		kfree_skb(skb);
1468		return -EIO;
1469	}
1470
1471	rp = (struct hci_rp_read_local_version *)skb->data;
1472
1473	/* Detect controllers which aren't real CSR ones. */
 
 
 
 
 
 
 
 
 
 
 
1474	if (le16_to_cpu(rp->manufacturer) != 10 ||
1475	    le16_to_cpu(rp->lmp_subver) == 0x0c5c) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1476		/* Clear the reset quirk since this is not an actual
1477		 * early Bluetooth 1.1 device from CSR.
1478		 */
1479		clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
1480
1481		/* These fake CSR controllers have all a broken
1482		 * stored link key handling and so just disable it.
1483		 */
1484		set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
1485	}
1486
1487	kfree_skb(skb);
1488
1489	return 0;
1490}
1491
1492static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev,
1493						       struct intel_version *ver)
1494{
1495	const struct firmware *fw;
1496	char fwname[64];
1497	int ret;
1498
1499	snprintf(fwname, sizeof(fwname),
1500		 "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq",
1501		 ver->hw_platform, ver->hw_variant, ver->hw_revision,
1502		 ver->fw_variant,  ver->fw_revision, ver->fw_build_num,
1503		 ver->fw_build_ww, ver->fw_build_yy);
1504
1505	ret = request_firmware(&fw, fwname, &hdev->dev);
1506	if (ret < 0) {
1507		if (ret == -EINVAL) {
1508			BT_ERR("%s Intel firmware file request failed (%d)",
1509			       hdev->name, ret);
1510			return NULL;
1511		}
1512
1513		BT_ERR("%s failed to open Intel firmware file: %s(%d)",
1514		       hdev->name, fwname, ret);
1515
1516		/* If the correct firmware patch file is not found, use the
1517		 * default firmware patch file instead
1518		 */
1519		snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq",
1520			 ver->hw_platform, ver->hw_variant);
1521		if (request_firmware(&fw, fwname, &hdev->dev) < 0) {
1522			BT_ERR("%s failed to open default Intel fw file: %s",
1523			       hdev->name, fwname);
1524			return NULL;
1525		}
1526	}
1527
1528	BT_INFO("%s: Intel Bluetooth firmware file: %s", hdev->name, fwname);
1529
1530	return fw;
1531}
1532
1533static int btusb_setup_intel_patching(struct hci_dev *hdev,
1534				      const struct firmware *fw,
1535				      const u8 **fw_ptr, int *disable_patch)
1536{
1537	struct sk_buff *skb;
1538	struct hci_command_hdr *cmd;
1539	const u8 *cmd_param;
1540	struct hci_event_hdr *evt = NULL;
1541	const u8 *evt_param = NULL;
1542	int remain = fw->size - (*fw_ptr - fw->data);
1543
1544	/* The first byte indicates the types of the patch command or event.
1545	 * 0x01 means HCI command and 0x02 is HCI event. If the first bytes
1546	 * in the current firmware buffer doesn't start with 0x01 or
1547	 * the size of remain buffer is smaller than HCI command header,
1548	 * the firmware file is corrupted and it should stop the patching
1549	 * process.
1550	 */
1551	if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) {
1552		BT_ERR("%s Intel fw corrupted: invalid cmd read", hdev->name);
1553		return -EINVAL;
1554	}
1555	(*fw_ptr)++;
1556	remain--;
1557
1558	cmd = (struct hci_command_hdr *)(*fw_ptr);
1559	*fw_ptr += sizeof(*cmd);
1560	remain -= sizeof(*cmd);
1561
1562	/* Ensure that the remain firmware data is long enough than the length
1563	 * of command parameter. If not, the firmware file is corrupted.
1564	 */
1565	if (remain < cmd->plen) {
1566		BT_ERR("%s Intel fw corrupted: invalid cmd len", hdev->name);
1567		return -EFAULT;
1568	}
1569
1570	/* If there is a command that loads a patch in the firmware
1571	 * file, then enable the patch upon success, otherwise just
1572	 * disable the manufacturer mode, for example patch activation
1573	 * is not required when the default firmware patch file is used
1574	 * because there are no patch data to load.
1575	 */
1576	if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e)
1577		*disable_patch = 0;
1578
1579	cmd_param = *fw_ptr;
1580	*fw_ptr += cmd->plen;
1581	remain -= cmd->plen;
1582
1583	/* This reads the expected events when the above command is sent to the
1584	 * device. Some vendor commands expects more than one events, for
1585	 * example command status event followed by vendor specific event.
1586	 * For this case, it only keeps the last expected event. so the command
1587	 * can be sent with __hci_cmd_sync_ev() which returns the sk_buff of
1588	 * last expected event.
1589	 */
1590	while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) {
1591		(*fw_ptr)++;
1592		remain--;
1593
1594		evt = (struct hci_event_hdr *)(*fw_ptr);
1595		*fw_ptr += sizeof(*evt);
1596		remain -= sizeof(*evt);
1597
1598		if (remain < evt->plen) {
1599			BT_ERR("%s Intel fw corrupted: invalid evt len",
1600			       hdev->name);
1601			return -EFAULT;
1602		}
1603
1604		evt_param = *fw_ptr;
1605		*fw_ptr += evt->plen;
1606		remain -= evt->plen;
1607	}
1608
1609	/* Every HCI commands in the firmware file has its correspond event.
1610	 * If event is not found or remain is smaller than zero, the firmware
1611	 * file is corrupted.
1612	 */
1613	if (!evt || !evt_param || remain < 0) {
1614		BT_ERR("%s Intel fw corrupted: invalid evt read", hdev->name);
1615		return -EFAULT;
1616	}
1617
1618	skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen,
1619				cmd_param, evt->evt, HCI_INIT_TIMEOUT);
1620	if (IS_ERR(skb)) {
1621		BT_ERR("%s sending Intel patch command (0x%4.4x) failed (%ld)",
1622		       hdev->name, cmd->opcode, PTR_ERR(skb));
1623		return PTR_ERR(skb);
1624	}
1625
1626	/* It ensures that the returned event matches the event data read from
1627	 * the firmware file. At fist, it checks the length and then
1628	 * the contents of the event.
1629	 */
1630	if (skb->len != evt->plen) {
1631		BT_ERR("%s mismatch event length (opcode 0x%4.4x)", hdev->name,
1632		       le16_to_cpu(cmd->opcode));
1633		kfree_skb(skb);
1634		return -EFAULT;
1635	}
1636
1637	if (memcmp(skb->data, evt_param, evt->plen)) {
1638		BT_ERR("%s mismatch event parameter (opcode 0x%4.4x)",
1639		       hdev->name, le16_to_cpu(cmd->opcode));
1640		kfree_skb(skb);
1641		return -EFAULT;
1642	}
1643	kfree_skb(skb);
1644
1645	return 0;
1646}
1647
1648static int btusb_setup_intel(struct hci_dev *hdev)
1649{
1650	struct sk_buff *skb;
1651	const struct firmware *fw;
1652	const u8 *fw_ptr;
1653	int disable_patch, err;
1654	struct intel_version ver;
1655
1656	BT_DBG("%s", hdev->name);
1657
1658	/* The controller has a bug with the first HCI command sent to it
1659	 * returning number of completed commands as zero. This would stall the
1660	 * command processing in the Bluetooth core.
1661	 *
1662	 * As a workaround, send HCI Reset command first which will reset the
1663	 * number of completed commands and allow normal command processing
1664	 * from now on.
1665	 */
1666	skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1667	if (IS_ERR(skb)) {
1668		BT_ERR("%s sending initial HCI reset command failed (%ld)",
1669		       hdev->name, PTR_ERR(skb));
1670		return PTR_ERR(skb);
1671	}
1672	kfree_skb(skb);
1673
1674	/* Read Intel specific controller version first to allow selection of
1675	 * which firmware file to load.
1676	 *
1677	 * The returned information are hardware variant and revision plus
1678	 * firmware variant, revision and build number.
1679	 */
1680	err = btintel_read_version(hdev, &ver);
1681	if (err)
1682		return err;
1683
1684	BT_INFO("%s: read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x",
1685		hdev->name, ver.hw_platform, ver.hw_variant, ver.hw_revision,
1686		ver.fw_variant,  ver.fw_revision, ver.fw_build_num,
1687		ver.fw_build_ww, ver.fw_build_yy, ver.fw_patch_num);
1688
1689	/* fw_patch_num indicates the version of patch the device currently
1690	 * have. If there is no patch data in the device, it is always 0x00.
1691	 * So, if it is other than 0x00, no need to patch the device again.
1692	 */
1693	if (ver.fw_patch_num) {
1694		BT_INFO("%s: Intel device is already patched. patch num: %02x",
1695			hdev->name, ver.fw_patch_num);
1696		goto complete;
1697	}
1698
1699	/* Opens the firmware patch file based on the firmware version read
1700	 * from the controller. If it fails to open the matching firmware
1701	 * patch file, it tries to open the default firmware patch file.
1702	 * If no patch file is found, allow the device to operate without
1703	 * a patch.
1704	 */
1705	fw = btusb_setup_intel_get_fw(hdev, &ver);
1706	if (!fw)
1707		goto complete;
1708	fw_ptr = fw->data;
1709
1710	/* Enable the manufacturer mode of the controller.
1711	 * Only while this mode is enabled, the driver can download the
1712	 * firmware patch data and configuration parameters.
1713	 */
1714	err = btintel_enter_mfg(hdev);
1715	if (err) {
1716		release_firmware(fw);
1717		return err;
1718	}
1719
1720	disable_patch = 1;
1721
1722	/* The firmware data file consists of list of Intel specific HCI
1723	 * commands and its expected events. The first byte indicates the
1724	 * type of the message, either HCI command or HCI event.
1725	 *
1726	 * It reads the command and its expected event from the firmware file,
1727	 * and send to the controller. Once __hci_cmd_sync_ev() returns,
1728	 * the returned event is compared with the event read from the firmware
1729	 * file and it will continue until all the messages are downloaded to
1730	 * the controller.
1731	 *
1732	 * Once the firmware patching is completed successfully,
1733	 * the manufacturer mode is disabled with reset and activating the
1734	 * downloaded patch.
1735	 *
1736	 * If the firmware patching fails, the manufacturer mode is
1737	 * disabled with reset and deactivating the patch.
1738	 *
1739	 * If the default patch file is used, no reset is done when disabling
1740	 * the manufacturer.
1741	 */
1742	while (fw->size > fw_ptr - fw->data) {
1743		int ret;
1744
1745		ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr,
1746						 &disable_patch);
1747		if (ret < 0)
1748			goto exit_mfg_deactivate;
1749	}
1750
1751	release_firmware(fw);
1752
1753	if (disable_patch)
1754		goto exit_mfg_disable;
1755
1756	/* Patching completed successfully and disable the manufacturer mode
1757	 * with reset and activate the downloaded firmware patches.
1758	 */
1759	err = btintel_exit_mfg(hdev, true, true);
1760	if (err)
1761		return err;
1762
1763	BT_INFO("%s: Intel Bluetooth firmware patch completed and activated",
1764		hdev->name);
 
 
 
 
 
 
1765
1766	goto complete;
1767
1768exit_mfg_disable:
1769	/* Disable the manufacturer mode without reset */
1770	err = btintel_exit_mfg(hdev, false, false);
1771	if (err)
1772		return err;
1773
1774	BT_INFO("%s: Intel Bluetooth firmware patch completed", hdev->name);
1775
1776	goto complete;
1777
1778exit_mfg_deactivate:
1779	release_firmware(fw);
1780
1781	/* Patching failed. Disable the manufacturer mode with reset and
1782	 * deactivate the downloaded firmware patches.
1783	 */
1784	err = btintel_exit_mfg(hdev, true, false);
1785	if (err)
1786		return err;
1787
1788	BT_INFO("%s: Intel Bluetooth firmware patch completed and deactivated",
1789		hdev->name);
1790
1791complete:
1792	/* Set the event mask for Intel specific vendor events. This enables
1793	 * a few extra events that are useful during general operation.
1794	 */
1795	btintel_set_event_mask_mfg(hdev, false);
1796
1797	btintel_check_bdaddr(hdev);
1798	return 0;
1799}
1800
1801static int inject_cmd_complete(struct hci_dev *hdev, __u16 opcode)
1802{
1803	struct sk_buff *skb;
1804	struct hci_event_hdr *hdr;
1805	struct hci_ev_cmd_complete *evt;
1806
1807	skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_ATOMIC);
1808	if (!skb)
1809		return -ENOMEM;
1810
1811	hdr = (struct hci_event_hdr *)skb_put(skb, sizeof(*hdr));
1812	hdr->evt = HCI_EV_CMD_COMPLETE;
1813	hdr->plen = sizeof(*evt) + 1;
1814
1815	evt = (struct hci_ev_cmd_complete *)skb_put(skb, sizeof(*evt));
1816	evt->ncmd = 0x01;
1817	evt->opcode = cpu_to_le16(opcode);
1818
1819	*skb_put(skb, 1) = 0x00;
1820
1821	hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
1822
1823	return hci_recv_frame(hdev, skb);
1824}
1825
1826static int btusb_recv_bulk_intel(struct btusb_data *data, void *buffer,
1827				 int count)
1828{
1829	/* When the device is in bootloader mode, then it can send
1830	 * events via the bulk endpoint. These events are treated the
1831	 * same way as the ones received from the interrupt endpoint.
1832	 */
1833	if (test_bit(BTUSB_BOOTLOADER, &data->flags))
1834		return btusb_recv_intr(data, buffer, count);
1835
1836	return btusb_recv_bulk(data, buffer, count);
1837}
1838
1839static void btusb_intel_bootup(struct btusb_data *data, const void *ptr,
1840			       unsigned int len)
1841{
1842	const struct intel_bootup *evt = ptr;
1843
1844	if (len != sizeof(*evt))
1845		return;
1846
1847	if (test_and_clear_bit(BTUSB_BOOTING, &data->flags)) {
1848		smp_mb__after_atomic();
1849		wake_up_bit(&data->flags, BTUSB_BOOTING);
1850	}
1851}
1852
1853static void btusb_intel_secure_send_result(struct btusb_data *data,
1854					   const void *ptr, unsigned int len)
1855{
1856	const struct intel_secure_send_result *evt = ptr;
1857
1858	if (len != sizeof(*evt))
1859		return;
1860
1861	if (evt->result)
1862		set_bit(BTUSB_FIRMWARE_FAILED, &data->flags);
1863
1864	if (test_and_clear_bit(BTUSB_DOWNLOADING, &data->flags) &&
1865	    test_bit(BTUSB_FIRMWARE_LOADED, &data->flags)) {
1866		smp_mb__after_atomic();
1867		wake_up_bit(&data->flags, BTUSB_DOWNLOADING);
1868	}
1869}
1870
1871static int btusb_recv_event_intel(struct hci_dev *hdev, struct sk_buff *skb)
1872{
1873	struct btusb_data *data = hci_get_drvdata(hdev);
1874
1875	if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
1876		struct hci_event_hdr *hdr = (void *)skb->data;
1877
1878		if (skb->len > HCI_EVENT_HDR_SIZE && hdr->evt == 0xff &&
1879		    hdr->plen > 0) {
1880			const void *ptr = skb->data + HCI_EVENT_HDR_SIZE + 1;
1881			unsigned int len = skb->len - HCI_EVENT_HDR_SIZE - 1;
1882
1883			switch (skb->data[2]) {
1884			case 0x02:
1885				/* When switching to the operational firmware
1886				 * the device sends a vendor specific event
1887				 * indicating that the bootup completed.
1888				 */
1889				btusb_intel_bootup(data, ptr, len);
1890				break;
1891			case 0x06:
1892				/* When the firmware loading completes the
1893				 * device sends out a vendor specific event
1894				 * indicating the result of the firmware
1895				 * loading.
1896				 */
1897				btusb_intel_secure_send_result(data, ptr, len);
1898				break;
1899			}
1900		}
1901	}
1902
1903	return hci_recv_frame(hdev, skb);
1904}
1905
1906static int btusb_send_frame_intel(struct hci_dev *hdev, struct sk_buff *skb)
1907{
1908	struct btusb_data *data = hci_get_drvdata(hdev);
1909	struct urb *urb;
1910
1911	BT_DBG("%s", hdev->name);
1912
1913	switch (hci_skb_pkt_type(skb)) {
1914	case HCI_COMMAND_PKT:
1915		if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
1916			struct hci_command_hdr *cmd = (void *)skb->data;
1917			__u16 opcode = le16_to_cpu(cmd->opcode);
1918
1919			/* When in bootloader mode and the command 0xfc09
1920			 * is received, it needs to be send down the
1921			 * bulk endpoint. So allocate a bulk URB instead.
1922			 */
1923			if (opcode == 0xfc09)
1924				urb = alloc_bulk_urb(hdev, skb);
1925			else
1926				urb = alloc_ctrl_urb(hdev, skb);
1927
1928			/* When the 0xfc01 command is issued to boot into
1929			 * the operational firmware, it will actually not
1930			 * send a command complete event. To keep the flow
1931			 * control working inject that event here.
1932			 */
1933			if (opcode == 0xfc01)
1934				inject_cmd_complete(hdev, opcode);
1935		} else {
1936			urb = alloc_ctrl_urb(hdev, skb);
1937		}
1938		if (IS_ERR(urb))
1939			return PTR_ERR(urb);
1940
1941		hdev->stat.cmd_tx++;
1942		return submit_or_queue_tx_urb(hdev, urb);
1943
1944	case HCI_ACLDATA_PKT:
1945		urb = alloc_bulk_urb(hdev, skb);
1946		if (IS_ERR(urb))
1947			return PTR_ERR(urb);
1948
1949		hdev->stat.acl_tx++;
1950		return submit_or_queue_tx_urb(hdev, urb);
1951
1952	case HCI_SCODATA_PKT:
1953		if (hci_conn_num(hdev, SCO_LINK) < 1)
1954			return -ENODEV;
1955
1956		urb = alloc_isoc_urb(hdev, skb);
1957		if (IS_ERR(urb))
1958			return PTR_ERR(urb);
1959
1960		hdev->stat.sco_tx++;
1961		return submit_tx_urb(hdev, urb);
1962	}
1963
1964	return -EILSEQ;
1965}
1966
1967static int btusb_setup_intel_new(struct hci_dev *hdev)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1968{
1969	static const u8 reset_param[] = { 0x00, 0x01, 0x00, 0x01,
1970					  0x00, 0x08, 0x04, 0x00 };
1971	struct btusb_data *data = hci_get_drvdata(hdev);
1972	struct sk_buff *skb;
1973	struct intel_version ver;
1974	struct intel_boot_params *params;
1975	const struct firmware *fw;
1976	const u8 *fw_ptr;
1977	u32 frag_len;
1978	char fwname[64];
1979	ktime_t calltime, delta, rettime;
1980	unsigned long long duration;
1981	int err;
 
1982
1983	BT_DBG("%s", hdev->name);
1984
1985	calltime = ktime_get();
1986
1987	/* Read the Intel version information to determine if the device
1988	 * is in bootloader mode or if it already has operational firmware
1989	 * loaded.
1990	 */
1991	err = btintel_read_version(hdev, &ver);
1992	if (err)
1993		return err;
1994
1995	/* The hardware platform number has a fixed value of 0x37 and
1996	 * for now only accept this single value.
1997	 */
1998	if (ver.hw_platform != 0x37) {
1999		BT_ERR("%s: Unsupported Intel hardware platform (%u)",
2000		       hdev->name, ver.hw_platform);
2001		return -EINVAL;
2002	}
2003
2004	/* At the moment only the hardware variant iBT 3.0 (LnP/SfP) is
2005	 * supported by this firmware loading method. This check has been
2006	 * put in place to ensure correct forward compatibility options
2007	 * when newer hardware variants come along.
2008	 */
2009	if (ver.hw_variant != 0x0b) {
2010		BT_ERR("%s: Unsupported Intel hardware variant (%u)",
2011		       hdev->name, ver.hw_variant);
 
 
 
 
 
 
 
 
 
2012		return -EINVAL;
2013	}
2014
2015	btintel_version_info(hdev, &ver);
2016
2017	/* The firmware variant determines if the device is in bootloader
2018	 * mode or is running operational firmware. The value 0x06 identifies
2019	 * the bootloader and the value 0x23 identifies the operational
2020	 * firmware.
2021	 *
2022	 * When the operational firmware is already present, then only
2023	 * the check for valid Bluetooth device address is needed. This
2024	 * determines if the device will be added as configured or
2025	 * unconfigured controller.
2026	 *
2027	 * It is not possible to use the Secure Boot Parameters in this
2028	 * case since that command is only available in bootloader mode.
2029	 */
2030	if (ver.fw_variant == 0x23) {
2031		clear_bit(BTUSB_BOOTLOADER, &data->flags);
2032		btintel_check_bdaddr(hdev);
2033		return 0;
2034	}
2035
2036	/* If the device is not in bootloader mode, then the only possible
2037	 * choice is to return an error and abort the device initialization.
2038	 */
2039	if (ver.fw_variant != 0x06) {
2040		BT_ERR("%s: Unsupported Intel firmware variant (%u)",
2041		       hdev->name, ver.fw_variant);
2042		return -ENODEV;
2043	}
2044
2045	/* Read the secure boot parameters to identify the operating
2046	 * details of the bootloader.
2047	 */
2048	skb = __hci_cmd_sync(hdev, 0xfc0d, 0, NULL, HCI_INIT_TIMEOUT);
2049	if (IS_ERR(skb)) {
2050		BT_ERR("%s: Reading Intel boot parameters failed (%ld)",
2051		       hdev->name, PTR_ERR(skb));
2052		return PTR_ERR(skb);
2053	}
2054
2055	if (skb->len != sizeof(*params)) {
2056		BT_ERR("%s: Intel boot parameters size mismatch", hdev->name);
2057		kfree_skb(skb);
2058		return -EILSEQ;
2059	}
2060
2061	params = (struct intel_boot_params *)skb->data;
2062
2063	BT_INFO("%s: Device revision is %u", hdev->name,
2064		le16_to_cpu(params->dev_revid));
2065
2066	BT_INFO("%s: Secure boot is %s", hdev->name,
2067		params->secure_boot ? "enabled" : "disabled");
2068
2069	BT_INFO("%s: OTP lock is %s", hdev->name,
2070		params->otp_lock ? "enabled" : "disabled");
2071
2072	BT_INFO("%s: API lock is %s", hdev->name,
2073		params->api_lock ? "enabled" : "disabled");
2074
2075	BT_INFO("%s: Debug lock is %s", hdev->name,
2076		params->debug_lock ? "enabled" : "disabled");
2077
2078	BT_INFO("%s: Minimum firmware build %u week %u %u", hdev->name,
2079		params->min_fw_build_nn, params->min_fw_build_cw,
2080		2000 + params->min_fw_build_yy);
2081
2082	/* It is required that every single firmware fragment is acknowledged
2083	 * with a command complete event. If the boot parameters indicate
2084	 * that this bootloader does not send them, then abort the setup.
2085	 */
2086	if (params->limited_cce != 0x00) {
2087		BT_ERR("%s: Unsupported Intel firmware loading method (%u)",
2088		       hdev->name, params->limited_cce);
2089		kfree_skb(skb);
2090		return -EINVAL;
2091	}
2092
2093	/* If the OTP has no valid Bluetooth device address, then there will
2094	 * also be no valid address for the operational firmware.
2095	 */
2096	if (!bacmp(&params->otp_bdaddr, BDADDR_ANY)) {
2097		BT_INFO("%s: No device address configured", hdev->name);
2098		set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
2099	}
2100
2101	/* With this Intel bootloader only the hardware variant and device
2102	 * revision information are used to select the right firmware.
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2103	 *
2104	 * Currently this bootloader support is limited to hardware variant
2105	 * iBT 3.0 (LnP/SfP) which is identified by the value 11 (0x0b).
2106	 */
2107	snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.sfi",
2108		 le16_to_cpu(params->dev_revid));
 
 
 
 
2109
2110	err = request_firmware(&fw, fwname, &hdev->dev);
2111	if (err < 0) {
2112		BT_ERR("%s: Failed to load Intel firmware file (%d)",
2113		       hdev->name, err);
2114		kfree_skb(skb);
2115		return err;
2116	}
2117
2118	BT_INFO("%s: Found device firmware: %s", hdev->name, fwname);
2119
2120	/* Save the DDC file name for later use to apply once the firmware
2121	 * downloading is done.
2122	 */
2123	snprintf(fwname, sizeof(fwname), "intel/ibt-11-%u.ddc",
2124		 le16_to_cpu(params->dev_revid));
2125
2126	kfree_skb(skb);
2127
2128	if (fw->size < 644) {
2129		BT_ERR("%s: Invalid size of firmware file (%zu)",
2130		       hdev->name, fw->size);
2131		err = -EBADF;
2132		goto done;
2133	}
2134
2135	set_bit(BTUSB_DOWNLOADING, &data->flags);
2136
2137	/* Start the firmware download transaction with the Init fragment
2138	 * represented by the 128 bytes of CSS header.
2139	 */
2140	err = btintel_secure_send(hdev, 0x00, 128, fw->data);
2141	if (err < 0) {
2142		BT_ERR("%s: Failed to send firmware header (%d)",
2143		       hdev->name, err);
2144		goto done;
2145	}
2146
2147	/* Send the 256 bytes of public key information from the firmware
2148	 * as the PKey fragment.
2149	 */
2150	err = btintel_secure_send(hdev, 0x03, 256, fw->data + 128);
2151	if (err < 0) {
2152		BT_ERR("%s: Failed to send firmware public key (%d)",
2153		       hdev->name, err);
2154		goto done;
2155	}
2156
2157	/* Send the 256 bytes of signature information from the firmware
2158	 * as the Sign fragment.
2159	 */
2160	err = btintel_secure_send(hdev, 0x02, 256, fw->data + 388);
2161	if (err < 0) {
2162		BT_ERR("%s: Failed to send firmware signature (%d)",
2163		       hdev->name, err);
2164		goto done;
2165	}
2166
2167	fw_ptr = fw->data + 644;
2168	frag_len = 0;
2169
2170	while (fw_ptr - fw->data < fw->size) {
2171		struct hci_command_hdr *cmd = (void *)(fw_ptr + frag_len);
2172
2173		frag_len += sizeof(*cmd) + cmd->plen;
2174
2175		/* The parameter length of the secure send command requires
2176		 * a 4 byte alignment. It happens so that the firmware file
2177		 * contains proper Intel_NOP commands to align the fragments
2178		 * as needed.
2179		 *
2180		 * Send set of commands with 4 byte alignment from the
2181		 * firmware data buffer as a single Data fragement.
2182		 */
2183		if (!(frag_len % 4)) {
2184			err = btintel_secure_send(hdev, 0x01, frag_len, fw_ptr);
2185			if (err < 0) {
2186				BT_ERR("%s: Failed to send firmware data (%d)",
2187				       hdev->name, err);
2188				goto done;
2189			}
2190
2191			fw_ptr += frag_len;
2192			frag_len = 0;
2193		}
2194	}
2195
2196	set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2197
2198	BT_INFO("%s: Waiting for firmware download to complete", hdev->name);
2199
2200	/* Before switching the device into operational mode and with that
2201	 * booting the loaded firmware, wait for the bootloader notification
2202	 * that all fragments have been successfully received.
2203	 *
2204	 * When the event processing receives the notification, then the
2205	 * BTUSB_DOWNLOADING flag will be cleared.
2206	 *
2207	 * The firmware loading should not take longer than 5 seconds
2208	 * and thus just timeout if that happens and fail the setup
2209	 * of this device.
2210	 */
2211	err = wait_on_bit_timeout(&data->flags, BTUSB_DOWNLOADING,
2212				  TASK_INTERRUPTIBLE,
2213				  msecs_to_jiffies(5000));
2214	if (err == 1) {
2215		BT_ERR("%s: Firmware loading interrupted", hdev->name);
2216		err = -EINTR;
2217		goto done;
2218	}
2219
2220	if (err) {
2221		BT_ERR("%s: Firmware loading timeout", hdev->name);
2222		err = -ETIMEDOUT;
 
2223		goto done;
2224	}
2225
2226	if (test_bit(BTUSB_FIRMWARE_FAILED, &data->flags)) {
2227		BT_ERR("%s: Firmware loading failed", hdev->name);
2228		err = -ENOEXEC;
2229		goto done;
2230	}
2231
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2232	rettime = ktime_get();
2233	delta = ktime_sub(rettime, calltime);
2234	duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2235
2236	BT_INFO("%s: Firmware loaded in %llu usecs", hdev->name, duration);
2237
2238done:
2239	release_firmware(fw);
2240
2241	if (err < 0)
2242		return err;
2243
2244	calltime = ktime_get();
2245
2246	set_bit(BTUSB_BOOTING, &data->flags);
2247
2248	skb = __hci_cmd_sync(hdev, 0xfc01, sizeof(reset_param), reset_param,
2249			     HCI_INIT_TIMEOUT);
2250	if (IS_ERR(skb))
2251		return PTR_ERR(skb);
2252
2253	kfree_skb(skb);
2254
2255	/* The bootloader will not indicate when the device is ready. This
2256	 * is done by the operational firmware sending bootup notification.
2257	 *
2258	 * Booting into operational firmware should not take longer than
2259	 * 1 second. However if that happens, then just fail the setup
2260	 * since something went wrong.
2261	 */
2262	BT_INFO("%s: Waiting for device to boot", hdev->name);
2263
2264	err = wait_on_bit_timeout(&data->flags, BTUSB_BOOTING,
2265				  TASK_INTERRUPTIBLE,
2266				  msecs_to_jiffies(1000));
2267
2268	if (err == 1) {
2269		BT_ERR("%s: Device boot interrupted", hdev->name);
2270		return -EINTR;
2271	}
2272
2273	if (err) {
2274		BT_ERR("%s: Device boot timeout", hdev->name);
 
2275		return -ETIMEDOUT;
2276	}
2277
2278	rettime = ktime_get();
2279	delta = ktime_sub(rettime, calltime);
2280	duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2281
2282	BT_INFO("%s: Device booted in %llu usecs", hdev->name, duration);
2283
2284	clear_bit(BTUSB_BOOTLOADER, &data->flags);
2285
2286	/* Once the device is running in operational mode, it needs to apply
2287	 * the device configuration (DDC) parameters.
2288	 *
2289	 * The device can work without DDC parameters, so even if it fails
2290	 * to load the file, no need to fail the setup.
 
 
 
 
 
 
 
 
 
 
 
 
2291	 */
2292	btintel_load_ddc_config(hdev, fwname);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2293
2294	/* Set the event mask for Intel specific vendor events. This enables
2295	 * a few extra events that are useful during general operation. It
2296	 * does not enable any debugging related events.
2297	 *
2298	 * The device will function correctly without these events enabled
2299	 * and thus no need to fail the setup.
2300	 */
2301	btintel_set_event_mask(hdev, false);
2302
2303	return 0;
2304}
2305
2306static int btusb_shutdown_intel(struct hci_dev *hdev)
2307{
2308	struct sk_buff *skb;
2309	long ret;
2310
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2311	/* Some platforms have an issue with BT LED when the interface is
2312	 * down or BT radio is turned off, which takes 5 seconds to BT LED
2313	 * goes off. This command turns off the BT LED immediately.
2314	 */
2315	skb = __hci_cmd_sync(hdev, 0xfc3f, 0, NULL, HCI_INIT_TIMEOUT);
2316	if (IS_ERR(skb)) {
2317		ret = PTR_ERR(skb);
2318		BT_ERR("%s: turning off Intel device LED failed (%ld)",
2319		       hdev->name, ret);
2320		return ret;
2321	}
2322	kfree_skb(skb);
2323
2324	return 0;
2325}
2326
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2327static int btusb_set_bdaddr_marvell(struct hci_dev *hdev,
2328				    const bdaddr_t *bdaddr)
2329{
2330	struct sk_buff *skb;
2331	u8 buf[8];
2332	long ret;
2333
2334	buf[0] = 0xfe;
2335	buf[1] = sizeof(bdaddr_t);
2336	memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
2337
2338	skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT);
2339	if (IS_ERR(skb)) {
2340		ret = PTR_ERR(skb);
2341		BT_ERR("%s: changing Marvell device address failed (%ld)",
2342		       hdev->name, ret);
2343		return ret;
2344	}
2345	kfree_skb(skb);
2346
2347	return 0;
2348}
2349
2350static int btusb_set_bdaddr_ath3012(struct hci_dev *hdev,
2351				    const bdaddr_t *bdaddr)
2352{
2353	struct sk_buff *skb;
2354	u8 buf[10];
2355	long ret;
2356
2357	buf[0] = 0x01;
2358	buf[1] = 0x01;
2359	buf[2] = 0x00;
2360	buf[3] = sizeof(bdaddr_t);
2361	memcpy(buf + 4, bdaddr, sizeof(bdaddr_t));
2362
2363	skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT);
2364	if (IS_ERR(skb)) {
2365		ret = PTR_ERR(skb);
2366		BT_ERR("%s: Change address command failed (%ld)",
2367		       hdev->name, ret);
2368		return ret;
2369	}
2370	kfree_skb(skb);
2371
2372	return 0;
2373}
2374
2375#define QCA_DFU_PACKET_LEN	4096
2376
2377#define QCA_GET_TARGET_VERSION	0x09
2378#define QCA_CHECK_STATUS	0x05
2379#define QCA_DFU_DOWNLOAD	0x01
2380
2381#define QCA_SYSCFG_UPDATED	0x40
2382#define QCA_PATCH_UPDATED	0x80
2383#define QCA_DFU_TIMEOUT		3000
2384
2385struct qca_version {
2386	__le32	rom_version;
2387	__le32	patch_version;
2388	__le32	ram_version;
2389	__le32	ref_clock;
2390	__u8	reserved[4];
2391} __packed;
2392
2393struct qca_rampatch_version {
2394	__le16	rom_version;
2395	__le16	patch_version;
2396} __packed;
2397
2398struct qca_device_info {
2399	u32	rom_version;
2400	u8	rampatch_hdr;	/* length of header in rampatch */
2401	u8	nvm_hdr;	/* length of header in NVM */
2402	u8	ver_offset;	/* offset of version structure in rampatch */
2403};
2404
2405static const struct qca_device_info qca_devices_table[] = {
2406	{ 0x00000100, 20, 4, 10 }, /* Rome 1.0 */
2407	{ 0x00000101, 20, 4, 10 }, /* Rome 1.1 */
2408	{ 0x00000200, 28, 4, 18 }, /* Rome 2.0 */
2409	{ 0x00000201, 28, 4, 18 }, /* Rome 2.1 */
2410	{ 0x00000300, 28, 4, 18 }, /* Rome 3.0 */
2411	{ 0x00000302, 28, 4, 18 }, /* Rome 3.2 */
2412};
2413
2414static int btusb_qca_send_vendor_req(struct hci_dev *hdev, u8 request,
2415				     void *data, u16 size)
2416{
2417	struct btusb_data *btdata = hci_get_drvdata(hdev);
2418	struct usb_device *udev = btdata->udev;
2419	int pipe, err;
2420	u8 *buf;
2421
2422	buf = kmalloc(size, GFP_KERNEL);
2423	if (!buf)
2424		return -ENOMEM;
2425
2426	/* Found some of USB hosts have IOT issues with ours so that we should
2427	 * not wait until HCI layer is ready.
2428	 */
2429	pipe = usb_rcvctrlpipe(udev, 0);
2430	err = usb_control_msg(udev, pipe, request, USB_TYPE_VENDOR | USB_DIR_IN,
2431			      0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
2432	if (err < 0) {
2433		BT_ERR("%s: Failed to access otp area (%d)", hdev->name, err);
2434		goto done;
2435	}
2436
2437	memcpy(data, buf, size);
2438
2439done:
2440	kfree(buf);
2441
2442	return err;
2443}
2444
2445static int btusb_setup_qca_download_fw(struct hci_dev *hdev,
2446				       const struct firmware *firmware,
2447				       size_t hdr_size)
2448{
2449	struct btusb_data *btdata = hci_get_drvdata(hdev);
2450	struct usb_device *udev = btdata->udev;
2451	size_t count, size, sent = 0;
2452	int pipe, len, err;
2453	u8 *buf;
2454
2455	buf = kmalloc(QCA_DFU_PACKET_LEN, GFP_KERNEL);
2456	if (!buf)
2457		return -ENOMEM;
2458
2459	count = firmware->size;
2460
2461	size = min_t(size_t, count, hdr_size);
2462	memcpy(buf, firmware->data, size);
2463
2464	/* USB patches should go down to controller through USB path
2465	 * because binary format fits to go down through USB channel.
2466	 * USB control path is for patching headers and USB bulk is for
2467	 * patch body.
2468	 */
2469	pipe = usb_sndctrlpipe(udev, 0);
2470	err = usb_control_msg(udev, pipe, QCA_DFU_DOWNLOAD, USB_TYPE_VENDOR,
2471			      0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
2472	if (err < 0) {
2473		BT_ERR("%s: Failed to send headers (%d)", hdev->name, err);
2474		goto done;
2475	}
2476
2477	sent += size;
2478	count -= size;
2479
2480	while (count) {
2481		size = min_t(size_t, count, QCA_DFU_PACKET_LEN);
2482
2483		memcpy(buf, firmware->data + sent, size);
2484
2485		pipe = usb_sndbulkpipe(udev, 0x02);
2486		err = usb_bulk_msg(udev, pipe, buf, size, &len,
2487				   QCA_DFU_TIMEOUT);
2488		if (err < 0) {
2489			BT_ERR("%s: Failed to send body at %zd of %zd (%d)",
2490			       hdev->name, sent, firmware->size, err);
2491			break;
2492		}
2493
2494		if (size != len) {
2495			BT_ERR("%s: Failed to get bulk buffer", hdev->name);
2496			err = -EILSEQ;
2497			break;
2498		}
2499
2500		sent  += size;
2501		count -= size;
2502	}
2503
2504done:
2505	kfree(buf);
2506	return err;
2507}
2508
2509static int btusb_setup_qca_load_rampatch(struct hci_dev *hdev,
2510					 struct qca_version *ver,
2511					 const struct qca_device_info *info)
2512{
2513	struct qca_rampatch_version *rver;
2514	const struct firmware *fw;
2515	u32 ver_rom, ver_patch;
2516	u16 rver_rom, rver_patch;
2517	char fwname[64];
2518	int err;
2519
2520	ver_rom = le32_to_cpu(ver->rom_version);
2521	ver_patch = le32_to_cpu(ver->patch_version);
2522
2523	snprintf(fwname, sizeof(fwname), "qca/rampatch_usb_%08x.bin", ver_rom);
2524
2525	err = request_firmware(&fw, fwname, &hdev->dev);
2526	if (err) {
2527		BT_ERR("%s: failed to request rampatch file: %s (%d)",
2528		       hdev->name, fwname, err);
2529		return err;
2530	}
2531
2532	BT_INFO("%s: using rampatch file: %s", hdev->name, fwname);
2533
2534	rver = (struct qca_rampatch_version *)(fw->data + info->ver_offset);
2535	rver_rom = le16_to_cpu(rver->rom_version);
2536	rver_patch = le16_to_cpu(rver->patch_version);
2537
2538	BT_INFO("%s: QCA: patch rome 0x%x build 0x%x, firmware rome 0x%x "
2539		"build 0x%x", hdev->name, rver_rom, rver_patch, ver_rom,
2540		ver_patch);
2541
2542	if (rver_rom != ver_rom || rver_patch <= ver_patch) {
2543		BT_ERR("%s: rampatch file version did not match with firmware",
2544		       hdev->name);
2545		err = -EINVAL;
2546		goto done;
2547	}
2548
2549	err = btusb_setup_qca_download_fw(hdev, fw, info->rampatch_hdr);
2550
2551done:
2552	release_firmware(fw);
2553
2554	return err;
2555}
2556
2557static int btusb_setup_qca_load_nvm(struct hci_dev *hdev,
2558				    struct qca_version *ver,
2559				    const struct qca_device_info *info)
2560{
2561	const struct firmware *fw;
2562	char fwname[64];
2563	int err;
2564
2565	snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x.bin",
2566		 le32_to_cpu(ver->rom_version));
2567
2568	err = request_firmware(&fw, fwname, &hdev->dev);
2569	if (err) {
2570		BT_ERR("%s: failed to request NVM file: %s (%d)",
2571		       hdev->name, fwname, err);
2572		return err;
2573	}
2574
2575	BT_INFO("%s: using NVM file: %s", hdev->name, fwname);
2576
2577	err = btusb_setup_qca_download_fw(hdev, fw, info->nvm_hdr);
2578
2579	release_firmware(fw);
2580
2581	return err;
2582}
2583
 
 
 
 
 
 
 
 
 
 
 
 
2584static int btusb_setup_qca(struct hci_dev *hdev)
2585{
 
 
2586	const struct qca_device_info *info = NULL;
2587	struct qca_version ver;
2588	u32 ver_rom;
2589	u8 status;
2590	int i, err;
2591
2592	err = btusb_qca_send_vendor_req(hdev, QCA_GET_TARGET_VERSION, &ver,
2593					sizeof(ver));
2594	if (err < 0)
2595		return err;
2596
2597	ver_rom = le32_to_cpu(ver.rom_version);
 
 
 
 
2598	for (i = 0; i < ARRAY_SIZE(qca_devices_table); i++) {
2599		if (ver_rom == qca_devices_table[i].rom_version)
2600			info = &qca_devices_table[i];
2601	}
2602	if (!info) {
2603		BT_ERR("%s: don't support firmware rome 0x%x", hdev->name,
2604		       ver_rom);
2605		return -ENODEV;
2606	}
2607
2608	err = btusb_qca_send_vendor_req(hdev, QCA_CHECK_STATUS, &status,
2609					sizeof(status));
2610	if (err < 0)
2611		return err;
2612
2613	if (!(status & QCA_PATCH_UPDATED)) {
2614		err = btusb_setup_qca_load_rampatch(hdev, &ver, info);
2615		if (err < 0)
2616			return err;
2617	}
2618
2619	if (!(status & QCA_SYSCFG_UPDATED)) {
2620		err = btusb_setup_qca_load_nvm(hdev, &ver, info);
2621		if (err < 0)
2622			return err;
2623	}
2624
2625	return 0;
2626}
2627
2628#ifdef CONFIG_BT_HCIBTUSB_BCM
2629static inline int __set_diag_interface(struct hci_dev *hdev)
2630{
2631	struct btusb_data *data = hci_get_drvdata(hdev);
2632	struct usb_interface *intf = data->diag;
2633	int i;
2634
2635	if (!data->diag)
2636		return -ENODEV;
2637
2638	data->diag_tx_ep = NULL;
2639	data->diag_rx_ep = NULL;
2640
2641	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
2642		struct usb_endpoint_descriptor *ep_desc;
2643
2644		ep_desc = &intf->cur_altsetting->endpoint[i].desc;
2645
2646		if (!data->diag_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
2647			data->diag_tx_ep = ep_desc;
2648			continue;
2649		}
2650
2651		if (!data->diag_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
2652			data->diag_rx_ep = ep_desc;
2653			continue;
2654		}
2655	}
2656
2657	if (!data->diag_tx_ep || !data->diag_rx_ep) {
2658		BT_ERR("%s invalid diagnostic descriptors", hdev->name);
2659		return -ENODEV;
2660	}
2661
2662	return 0;
2663}
2664
2665static struct urb *alloc_diag_urb(struct hci_dev *hdev, bool enable)
2666{
2667	struct btusb_data *data = hci_get_drvdata(hdev);
2668	struct sk_buff *skb;
2669	struct urb *urb;
2670	unsigned int pipe;
2671
2672	if (!data->diag_tx_ep)
2673		return ERR_PTR(-ENODEV);
2674
2675	urb = usb_alloc_urb(0, GFP_KERNEL);
2676	if (!urb)
2677		return ERR_PTR(-ENOMEM);
2678
2679	skb = bt_skb_alloc(2, GFP_KERNEL);
2680	if (!skb) {
2681		usb_free_urb(urb);
2682		return ERR_PTR(-ENOMEM);
2683	}
2684
2685	*skb_put(skb, 1) = 0xf0;
2686	*skb_put(skb, 1) = enable;
2687
2688	pipe = usb_sndbulkpipe(data->udev, data->diag_tx_ep->bEndpointAddress);
2689
2690	usb_fill_bulk_urb(urb, data->udev, pipe,
2691			  skb->data, skb->len, btusb_tx_complete, skb);
2692
2693	skb->dev = (void *)hdev;
2694
2695	return urb;
2696}
2697
2698static int btusb_bcm_set_diag(struct hci_dev *hdev, bool enable)
2699{
2700	struct btusb_data *data = hci_get_drvdata(hdev);
2701	struct urb *urb;
2702
2703	if (!data->diag)
2704		return -ENODEV;
2705
2706	if (!test_bit(HCI_RUNNING, &hdev->flags))
2707		return -ENETDOWN;
2708
2709	urb = alloc_diag_urb(hdev, enable);
2710	if (IS_ERR(urb))
2711		return PTR_ERR(urb);
2712
2713	return submit_or_queue_tx_urb(hdev, urb);
2714}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2715#endif
2716
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2717static int btusb_probe(struct usb_interface *intf,
2718		       const struct usb_device_id *id)
2719{
2720	struct usb_endpoint_descriptor *ep_desc;
 
2721	struct btusb_data *data;
2722	struct hci_dev *hdev;
2723	unsigned ifnum_base;
2724	int i, err;
2725
2726	BT_DBG("intf %p id %p", intf, id);
2727
2728	/* interface numbers are hardcoded in the spec */
2729	if (intf->cur_altsetting->desc.bInterfaceNumber != 0) {
2730		if (!(id->driver_info & BTUSB_IFNUM_2))
2731			return -ENODEV;
2732		if (intf->cur_altsetting->desc.bInterfaceNumber != 2)
2733			return -ENODEV;
2734	}
2735
2736	ifnum_base = intf->cur_altsetting->desc.bInterfaceNumber;
2737
2738	if (!id->driver_info) {
2739		const struct usb_device_id *match;
2740
2741		match = usb_match_id(intf, blacklist_table);
2742		if (match)
2743			id = match;
2744	}
2745
2746	if (id->driver_info == BTUSB_IGNORE)
2747		return -ENODEV;
2748
2749	if (id->driver_info & BTUSB_ATH3012) {
2750		struct usb_device *udev = interface_to_usbdev(intf);
2751
2752		/* Old firmware would otherwise let ath3k driver load
2753		 * patch and sysconfig files */
2754		if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001)
 
 
2755			return -ENODEV;
2756	}
2757
2758	data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
2759	if (!data)
2760		return -ENOMEM;
2761
2762	for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
2763		ep_desc = &intf->cur_altsetting->endpoint[i].desc;
2764
2765		if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
2766			data->intr_ep = ep_desc;
2767			continue;
2768		}
2769
2770		if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
2771			data->bulk_tx_ep = ep_desc;
2772			continue;
2773		}
2774
2775		if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
2776			data->bulk_rx_ep = ep_desc;
2777			continue;
2778		}
2779	}
2780
2781	if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep)
2782		return -ENODEV;
2783
2784	if (id->driver_info & BTUSB_AMP) {
2785		data->cmdreq_type = USB_TYPE_CLASS | 0x01;
2786		data->cmdreq = 0x2b;
2787	} else {
2788		data->cmdreq_type = USB_TYPE_CLASS;
2789		data->cmdreq = 0x00;
2790	}
2791
2792	data->udev = interface_to_usbdev(intf);
2793	data->intf = intf;
2794
2795	INIT_WORK(&data->work, btusb_work);
2796	INIT_WORK(&data->waker, btusb_waker);
2797	init_usb_anchor(&data->deferred);
2798	init_usb_anchor(&data->tx_anchor);
2799	spin_lock_init(&data->txlock);
2800
2801	init_usb_anchor(&data->intr_anchor);
2802	init_usb_anchor(&data->bulk_anchor);
2803	init_usb_anchor(&data->isoc_anchor);
2804	init_usb_anchor(&data->diag_anchor);
 
2805	spin_lock_init(&data->rxlock);
2806
2807	if (id->driver_info & BTUSB_INTEL_NEW) {
2808		data->recv_event = btusb_recv_event_intel;
2809		data->recv_bulk = btusb_recv_bulk_intel;
2810		set_bit(BTUSB_BOOTLOADER, &data->flags);
2811	} else {
2812		data->recv_event = hci_recv_frame;
2813		data->recv_bulk = btusb_recv_bulk;
2814	}
2815
2816	hdev = hci_alloc_dev();
2817	if (!hdev)
2818		return -ENOMEM;
2819
2820	hdev->bus = HCI_USB;
2821	hci_set_drvdata(hdev, data);
2822
2823	if (id->driver_info & BTUSB_AMP)
2824		hdev->dev_type = HCI_AMP;
2825	else
2826		hdev->dev_type = HCI_BREDR;
2827
2828	data->hdev = hdev;
2829
2830	SET_HCIDEV_DEV(hdev, &intf->dev);
2831
 
 
 
 
 
 
 
 
 
2832	hdev->open   = btusb_open;
2833	hdev->close  = btusb_close;
2834	hdev->flush  = btusb_flush;
2835	hdev->send   = btusb_send_frame;
2836	hdev->notify = btusb_notify;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2837
2838	if (id->driver_info & BTUSB_BCM2045)
2839		set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
2840
2841	if (id->driver_info & BTUSB_BCM92035)
2842		hdev->setup = btusb_setup_bcm92035;
2843
2844#ifdef CONFIG_BT_HCIBTUSB_BCM
2845	if (id->driver_info & BTUSB_BCM_PATCHRAM) {
2846		hdev->manufacturer = 15;
2847		hdev->setup = btbcm_setup_patchram;
2848		hdev->set_diag = btusb_bcm_set_diag;
2849		hdev->set_bdaddr = btbcm_set_bdaddr;
2850
2851		/* Broadcom LM_DIAG Interface numbers are hardcoded */
2852		data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2);
2853	}
2854
2855	if (id->driver_info & BTUSB_BCM_APPLE) {
 
2856		hdev->manufacturer = 15;
2857		hdev->setup = btbcm_setup_apple;
2858		hdev->set_diag = btusb_bcm_set_diag;
2859
2860		/* Broadcom LM_DIAG Interface numbers are hardcoded */
2861		data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2);
2862	}
2863#endif
2864
2865	if (id->driver_info & BTUSB_INTEL) {
2866		hdev->manufacturer = 2;
2867		hdev->setup = btusb_setup_intel;
2868		hdev->shutdown = btusb_shutdown_intel;
2869		hdev->set_diag = btintel_set_diag_mfg;
2870		hdev->set_bdaddr = btintel_set_bdaddr;
 
2871		set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
2872		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
2873		set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
2874	}
2875
2876	if (id->driver_info & BTUSB_INTEL_NEW) {
2877		hdev->manufacturer = 2;
2878		hdev->send = btusb_send_frame_intel;
2879		hdev->setup = btusb_setup_intel_new;
 
2880		hdev->hw_error = btintel_hw_error;
2881		hdev->set_diag = btintel_set_diag;
2882		hdev->set_bdaddr = btintel_set_bdaddr;
 
2883		set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
 
2884		set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
2885	}
2886
2887	if (id->driver_info & BTUSB_MARVELL)
2888		hdev->set_bdaddr = btusb_set_bdaddr_marvell;
2889
 
 
 
 
 
 
 
 
2890	if (id->driver_info & BTUSB_SWAVE) {
2891		set_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks);
2892		set_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks);
2893	}
2894
2895	if (id->driver_info & BTUSB_INTEL_BOOT) {
2896		hdev->manufacturer = 2;
2897		set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2898	}
2899
2900	if (id->driver_info & BTUSB_ATH3012) {
 
2901		hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
2902		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
2903		set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
2904	}
2905
2906	if (id->driver_info & BTUSB_QCA_ROME) {
2907		data->setup_on_usb = btusb_setup_qca;
2908		hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
 
 
 
2909	}
2910
2911#ifdef CONFIG_BT_HCIBTUSB_RTL
2912	if (id->driver_info & BTUSB_REALTEK) {
2913		hdev->setup = btrtl_setup_realtek;
2914
2915		/* Realtek devices lose their updated firmware over suspend,
2916		 * but the USB hub doesn't notice any status change.
2917		 * Explicitly request a device reset on resume.
2918		 */
2919		set_bit(BTUSB_RESET_RESUME, &data->flags);
2920	}
2921#endif
2922
2923	if (id->driver_info & BTUSB_AMP) {
2924		/* AMP controllers do not support SCO packets */
2925		data->isoc = NULL;
2926	} else {
2927		/* Interface orders are hardcoded in the specification */
2928		data->isoc = usb_ifnum_to_if(data->udev, ifnum_base + 1);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2929	}
2930
2931	if (!reset)
2932		set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2933
2934	if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
2935		if (!disable_scofix)
2936			set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
2937	}
2938
2939	if (id->driver_info & BTUSB_BROKEN_ISOC)
2940		data->isoc = NULL;
2941
 
 
 
 
 
 
2942	if (id->driver_info & BTUSB_DIGIANSWER) {
2943		data->cmdreq_type = USB_TYPE_VENDOR;
2944		set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2945	}
2946
2947	if (id->driver_info & BTUSB_CSR) {
2948		struct usb_device *udev = data->udev;
2949		u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice);
2950
2951		/* Old firmware would otherwise execute USB reset */
2952		if (bcdDevice < 0x117)
2953			set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2954
 
 
 
2955		/* Fake CSR devices with broken commands */
2956		if (bcdDevice <= 0x100 || bcdDevice == 0x134)
 
2957			hdev->setup = btusb_setup_csr;
2958
2959		set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
2960	}
2961
2962	if (id->driver_info & BTUSB_SNIFFER) {
2963		struct usb_device *udev = data->udev;
2964
2965		/* New sniffer firmware has crippled HCI interface */
2966		if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
2967			set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2968	}
2969
2970	if (id->driver_info & BTUSB_INTEL_BOOT) {
2971		/* A bug in the bootloader causes that interrupt interface is
2972		 * only enabled after receiving SetInterface(0, AltSetting=0).
2973		 */
2974		err = usb_set_interface(data->udev, 0, 0);
2975		if (err < 0) {
2976			BT_ERR("failed to set interface 0, alt 0 %d", err);
2977			hci_free_dev(hdev);
2978			return err;
2979		}
2980	}
2981
2982	if (data->isoc) {
2983		err = usb_driver_claim_interface(&btusb_driver,
2984						 data->isoc, data);
2985		if (err < 0) {
2986			hci_free_dev(hdev);
2987			return err;
2988		}
2989	}
2990
2991#ifdef CONFIG_BT_HCIBTUSB_BCM
2992	if (data->diag) {
2993		if (!usb_driver_claim_interface(&btusb_driver,
2994						data->diag, data))
2995			__set_diag_interface(hdev);
2996		else
2997			data->diag = NULL;
2998	}
2999#endif
 
 
3000
3001	err = hci_register_dev(hdev);
3002	if (err < 0) {
3003		hci_free_dev(hdev);
3004		return err;
3005	}
3006
3007	usb_set_intfdata(intf, data);
3008
3009	return 0;
 
 
 
 
 
 
3010}
3011
3012static void btusb_disconnect(struct usb_interface *intf)
3013{
3014	struct btusb_data *data = usb_get_intfdata(intf);
3015	struct hci_dev *hdev;
3016
3017	BT_DBG("intf %p", intf);
3018
3019	if (!data)
3020		return;
3021
3022	hdev = data->hdev;
3023	usb_set_intfdata(data->intf, NULL);
3024
3025	if (data->isoc)
3026		usb_set_intfdata(data->isoc, NULL);
3027
3028	if (data->diag)
3029		usb_set_intfdata(data->diag, NULL);
3030
3031	hci_unregister_dev(hdev);
3032
3033	if (intf == data->intf) {
3034		if (data->isoc)
3035			usb_driver_release_interface(&btusb_driver, data->isoc);
3036		if (data->diag)
3037			usb_driver_release_interface(&btusb_driver, data->diag);
3038	} else if (intf == data->isoc) {
3039		if (data->diag)
3040			usb_driver_release_interface(&btusb_driver, data->diag);
3041		usb_driver_release_interface(&btusb_driver, data->intf);
3042	} else if (intf == data->diag) {
3043		usb_driver_release_interface(&btusb_driver, data->intf);
3044		if (data->isoc)
3045			usb_driver_release_interface(&btusb_driver, data->isoc);
3046	}
3047
 
 
 
 
 
 
3048	hci_free_dev(hdev);
3049}
3050
3051#ifdef CONFIG_PM
3052static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
3053{
3054	struct btusb_data *data = usb_get_intfdata(intf);
3055
3056	BT_DBG("intf %p", intf);
3057
3058	if (data->suspend_count++)
3059		return 0;
3060
3061	spin_lock_irq(&data->txlock);
3062	if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) {
3063		set_bit(BTUSB_SUSPENDING, &data->flags);
3064		spin_unlock_irq(&data->txlock);
3065	} else {
3066		spin_unlock_irq(&data->txlock);
3067		data->suspend_count--;
3068		return -EBUSY;
3069	}
3070
3071	cancel_work_sync(&data->work);
3072
3073	btusb_stop_traffic(data);
3074	usb_kill_anchored_urbs(&data->tx_anchor);
3075
3076	/* Optionally request a device reset on resume, but only when
3077	 * wakeups are disabled. If wakeups are enabled we assume the
3078	 * device will stay powered up throughout suspend.
3079	 */
3080	if (test_bit(BTUSB_RESET_RESUME, &data->flags) &&
3081	    !device_may_wakeup(&data->udev->dev))
3082		data->udev->reset_resume = 1;
 
 
 
 
 
 
 
 
 
 
 
3083
3084	return 0;
3085}
3086
3087static void play_deferred(struct btusb_data *data)
3088{
3089	struct urb *urb;
3090	int err;
3091
3092	while ((urb = usb_get_from_anchor(&data->deferred))) {
 
 
3093		err = usb_submit_urb(urb, GFP_ATOMIC);
3094		if (err < 0)
 
 
 
 
 
 
3095			break;
 
3096
3097		data->tx_in_flight++;
 
 
 
 
 
 
 
3098	}
3099	usb_scuttle_anchored_urbs(&data->deferred);
3100}
3101
3102static int btusb_resume(struct usb_interface *intf)
3103{
3104	struct btusb_data *data = usb_get_intfdata(intf);
3105	struct hci_dev *hdev = data->hdev;
3106	int err = 0;
3107
3108	BT_DBG("intf %p", intf);
3109
3110	if (--data->suspend_count)
3111		return 0;
3112
 
 
 
 
 
 
3113	if (!test_bit(HCI_RUNNING, &hdev->flags))
3114		goto done;
3115
3116	if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
3117		err = btusb_submit_intr_urb(hdev, GFP_NOIO);
3118		if (err < 0) {
3119			clear_bit(BTUSB_INTR_RUNNING, &data->flags);
3120			goto failed;
3121		}
3122	}
3123
3124	if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
3125		err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
3126		if (err < 0) {
3127			clear_bit(BTUSB_BULK_RUNNING, &data->flags);
3128			goto failed;
3129		}
3130
3131		btusb_submit_bulk_urb(hdev, GFP_NOIO);
3132	}
3133
3134	if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
3135		if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
3136			clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
3137		else
3138			btusb_submit_isoc_urb(hdev, GFP_NOIO);
3139	}
3140
3141	spin_lock_irq(&data->txlock);
3142	play_deferred(data);
3143	clear_bit(BTUSB_SUSPENDING, &data->flags);
3144	spin_unlock_irq(&data->txlock);
3145	schedule_work(&data->work);
3146
3147	return 0;
3148
3149failed:
3150	usb_scuttle_anchored_urbs(&data->deferred);
3151done:
3152	spin_lock_irq(&data->txlock);
3153	clear_bit(BTUSB_SUSPENDING, &data->flags);
3154	spin_unlock_irq(&data->txlock);
3155
3156	return err;
3157}
3158#endif
3159
3160static struct usb_driver btusb_driver = {
3161	.name		= "btusb",
3162	.probe		= btusb_probe,
3163	.disconnect	= btusb_disconnect,
3164#ifdef CONFIG_PM
3165	.suspend	= btusb_suspend,
3166	.resume		= btusb_resume,
3167#endif
3168	.id_table	= btusb_table,
3169	.supports_autosuspend = 1,
3170	.disable_hub_initiated_lpm = 1,
3171};
3172
3173module_usb_driver(btusb_driver);
3174
3175module_param(disable_scofix, bool, 0644);
3176MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
3177
3178module_param(force_scofix, bool, 0644);
3179MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
 
 
 
3180
3181module_param(reset, bool, 0644);
3182MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
3183
3184MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
3185MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
3186MODULE_VERSION(VERSION);
3187MODULE_LICENSE("GPL");