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