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