1
2
3
4
5
6
7
8
9#include <linux/dmi.h>
10#include <linux/module.h>
11#include <linux/usb.h>
12#include <linux/usb/quirks.h>
13#include <linux/firmware.h>
14#include <linux/iopoll.h>
15#include <linux/of_device.h>
16#include <linux/of_irq.h>
17#include <linux/suspend.h>
18#include <linux/gpio/consumer.h>
19#include <asm/unaligned.h>
20
21#include <net/bluetooth/bluetooth.h>
22#include <net/bluetooth/hci_core.h>
23
24#include "btintel.h"
25#include "btbcm.h"
26#include "btrtl.h"
27
28#define VERSION "0.8"
29
30static bool disable_scofix;
31static bool force_scofix;
32static bool enable_autosuspend = IS_ENABLED(CONFIG_BT_HCIBTUSB_AUTOSUSPEND);
33
34static bool reset = true;
35
36static struct usb_driver btusb_driver;
37
38#define BTUSB_IGNORE 0x01
39#define BTUSB_DIGIANSWER 0x02
40#define BTUSB_CSR 0x04
41#define BTUSB_SNIFFER 0x08
42#define BTUSB_BCM92035 0x10
43#define BTUSB_BROKEN_ISOC 0x20
44#define BTUSB_WRONG_SCO_MTU 0x40
45#define BTUSB_ATH3012 0x80
46#define BTUSB_INTEL 0x100
47#define BTUSB_INTEL_BOOT 0x200
48#define BTUSB_BCM_PATCHRAM 0x400
49#define BTUSB_MARVELL 0x800
50#define BTUSB_SWAVE 0x1000
51#define BTUSB_INTEL_NEW 0x2000
52#define BTUSB_AMP 0x4000
53#define BTUSB_QCA_ROME 0x8000
54#define BTUSB_BCM_APPLE 0x10000
55#define BTUSB_REALTEK 0x20000
56#define BTUSB_BCM2045 0x40000
57#define BTUSB_IFNUM_2 0x80000
58#define BTUSB_CW6622 0x100000
59#define BTUSB_MEDIATEK 0x200000
60#define BTUSB_WIDEBAND_SPEECH 0x400000
61#define BTUSB_VALID_LE_STATES 0x800000
62#define BTUSB_QCA_WCN6855 0x1000000
63#define BTUSB_INTEL_NEWGEN 0x2000000
64
65static const struct usb_device_id btusb_table[] = {
66
67 { USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
68
69
70 { USB_DEVICE_INFO(0xe0, 0x01, 0x04), .driver_info = BTUSB_AMP },
71
72
73 { USB_INTERFACE_INFO(0xe0, 0x01, 0x01) },
74
75
76 { USB_VENDOR_AND_INTERFACE_INFO(0x05ac, 0xff, 0x01, 0x01),
77 .driver_info = BTUSB_BCM_APPLE | BTUSB_IFNUM_2 },
78
79
80 { USB_DEVICE(0x0e8d, 0x763f) },
81
82
83 { USB_DEVICE(0x0a5c, 0x21e1) },
84
85
86 { USB_DEVICE(0x05ac, 0x8213) },
87
88
89 { USB_DEVICE(0x05ac, 0x8215) },
90
91
92 { USB_DEVICE(0x05ac, 0x8218) },
93
94
95 { USB_DEVICE(0x05ac, 0x821b) },
96
97
98 { USB_DEVICE(0x05ac, 0x821f) },
99
100
101 { USB_DEVICE(0x05ac, 0x821a) },
102
103
104 { USB_DEVICE(0x05ac, 0x8281) },
105
106
107 { USB_DEVICE(0x057c, 0x3800), .driver_info = BTUSB_SWAVE },
108
109
110 { USB_DEVICE(0x04bf, 0x030a) },
111
112
113 { USB_DEVICE(0x044e, 0x3001) },
114 { USB_DEVICE(0x044e, 0x3002) },
115
116
117 { USB_DEVICE(0x0bdb, 0x1002) },
118
119
120 { USB_DEVICE(0x0c10, 0x0000) },
121
122
123 { USB_DEVICE(0x413c, 0x8197) },
124
125
126 { USB_DEVICE(0x19ff, 0x0239), .driver_info = BTUSB_BCM_PATCHRAM },
127
128
129 { USB_VENDOR_AND_INTERFACE_INFO(0x105b, 0xff, 0x01, 0x01),
130 .driver_info = BTUSB_BCM_PATCHRAM },
131
132
133 { USB_VENDOR_AND_INTERFACE_INFO(0x0bb4, 0xff, 0x01, 0x01),
134 .driver_info = BTUSB_BCM_PATCHRAM },
135
136
137 { USB_VENDOR_AND_INTERFACE_INFO(0x0489, 0xff, 0x01, 0x01),
138 .driver_info = BTUSB_BCM_PATCHRAM },
139
140
141 { USB_VENDOR_AND_INTERFACE_INFO(0x04ca, 0xff, 0x01, 0x01),
142 .driver_info = BTUSB_BCM_PATCHRAM },
143
144
145 { USB_VENDOR_AND_INTERFACE_INFO(0x0a5c, 0xff, 0x01, 0x01),
146 .driver_info = BTUSB_BCM_PATCHRAM },
147
148
149 { USB_VENDOR_AND_INTERFACE_INFO(0x0b05, 0xff, 0x01, 0x01),
150 .driver_info = BTUSB_BCM_PATCHRAM },
151
152
153 { USB_VENDOR_AND_INTERFACE_INFO(0x050d, 0xff, 0x01, 0x01),
154 .driver_info = BTUSB_BCM_PATCHRAM },
155
156
157 { USB_VENDOR_AND_INTERFACE_INFO(0x13d3, 0xff, 0x01, 0x01),
158 .driver_info = BTUSB_BCM_PATCHRAM },
159
160
161 { USB_VENDOR_AND_INTERFACE_INFO(0x413c, 0xff, 0x01, 0x01),
162 .driver_info = BTUSB_BCM_PATCHRAM },
163
164
165 { USB_VENDOR_AND_INTERFACE_INFO(0x0930, 0xff, 0x01, 0x01),
166 .driver_info = BTUSB_BCM_PATCHRAM },
167
168
169 { USB_DEVICE(0x8087, 0x0a5a),
170 .driver_info = BTUSB_INTEL_BOOT | BTUSB_BROKEN_ISOC },
171
172 { }
173};
174
175MODULE_DEVICE_TABLE(usb, btusb_table);
176
177static const struct usb_device_id blacklist_table[] = {
178
179 { USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
180
181
182 { USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
183
184
185 { USB_DEVICE(0x0a5c, 0x2045), .driver_info = BTUSB_BCM2045 },
186
187
188 { USB_DEVICE(0x0489, 0xe027), .driver_info = BTUSB_IGNORE },
189 { USB_DEVICE(0x0489, 0xe03d), .driver_info = BTUSB_IGNORE },
190 { USB_DEVICE(0x04f2, 0xaff1), .driver_info = BTUSB_IGNORE },
191 { USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
192 { USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
193 { USB_DEVICE(0x0cf3, 0xe019), .driver_info = BTUSB_IGNORE },
194 { USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
195
196
197 { USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
198
199
200 { USB_DEVICE(0x0489, 0xe04d), .driver_info = BTUSB_ATH3012 },
201 { USB_DEVICE(0x0489, 0xe04e), .driver_info = BTUSB_ATH3012 },
202 { USB_DEVICE(0x0489, 0xe056), .driver_info = BTUSB_ATH3012 },
203 { USB_DEVICE(0x0489, 0xe057), .driver_info = BTUSB_ATH3012 },
204 { USB_DEVICE(0x0489, 0xe05f), .driver_info = BTUSB_ATH3012 },
205 { USB_DEVICE(0x0489, 0xe076), .driver_info = BTUSB_ATH3012 },
206 { USB_DEVICE(0x0489, 0xe078), .driver_info = BTUSB_ATH3012 },
207 { USB_DEVICE(0x0489, 0xe095), .driver_info = BTUSB_ATH3012 },
208 { USB_DEVICE(0x04c5, 0x1330), .driver_info = BTUSB_ATH3012 },
209 { USB_DEVICE(0x04ca, 0x3004), .driver_info = BTUSB_ATH3012 },
210 { USB_DEVICE(0x04ca, 0x3005), .driver_info = BTUSB_ATH3012 },
211 { USB_DEVICE(0x04ca, 0x3006), .driver_info = BTUSB_ATH3012 },
212 { USB_DEVICE(0x04ca, 0x3007), .driver_info = BTUSB_ATH3012 },
213 { USB_DEVICE(0x04ca, 0x3008), .driver_info = BTUSB_ATH3012 },
214 { USB_DEVICE(0x04ca, 0x300b), .driver_info = BTUSB_ATH3012 },
215 { USB_DEVICE(0x04ca, 0x300d), .driver_info = BTUSB_ATH3012 },
216 { USB_DEVICE(0x04ca, 0x300f), .driver_info = BTUSB_ATH3012 },
217 { USB_DEVICE(0x04ca, 0x3010), .driver_info = BTUSB_ATH3012 },
218 { USB_DEVICE(0x04ca, 0x3014), .driver_info = BTUSB_ATH3012 },
219 { USB_DEVICE(0x04ca, 0x3018), .driver_info = BTUSB_ATH3012 },
220 { USB_DEVICE(0x0930, 0x0219), .driver_info = BTUSB_ATH3012 },
221 { USB_DEVICE(0x0930, 0x021c), .driver_info = BTUSB_ATH3012 },
222 { USB_DEVICE(0x0930, 0x0220), .driver_info = BTUSB_ATH3012 },
223 { USB_DEVICE(0x0930, 0x0227), .driver_info = BTUSB_ATH3012 },
224 { USB_DEVICE(0x0b05, 0x17d0), .driver_info = BTUSB_ATH3012 },
225 { USB_DEVICE(0x0cf3, 0x0036), .driver_info = BTUSB_ATH3012 },
226 { USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
227 { USB_DEVICE(0x0cf3, 0x3008), .driver_info = BTUSB_ATH3012 },
228 { USB_DEVICE(0x0cf3, 0x311d), .driver_info = BTUSB_ATH3012 },
229 { USB_DEVICE(0x0cf3, 0x311e), .driver_info = BTUSB_ATH3012 },
230 { USB_DEVICE(0x0cf3, 0x311f), .driver_info = BTUSB_ATH3012 },
231 { USB_DEVICE(0x0cf3, 0x3121), .driver_info = BTUSB_ATH3012 },
232 { USB_DEVICE(0x0cf3, 0x817a), .driver_info = BTUSB_ATH3012 },
233 { USB_DEVICE(0x0cf3, 0x817b), .driver_info = BTUSB_ATH3012 },
234 { USB_DEVICE(0x0cf3, 0xe003), .driver_info = BTUSB_ATH3012 },
235 { USB_DEVICE(0x0cf3, 0xe004), .driver_info = BTUSB_ATH3012 },
236 { USB_DEVICE(0x0cf3, 0xe005), .driver_info = BTUSB_ATH3012 },
237 { USB_DEVICE(0x0cf3, 0xe006), .driver_info = BTUSB_ATH3012 },
238 { USB_DEVICE(0x13d3, 0x3362), .driver_info = BTUSB_ATH3012 },
239 { USB_DEVICE(0x13d3, 0x3375), .driver_info = BTUSB_ATH3012 },
240 { USB_DEVICE(0x13d3, 0x3393), .driver_info = BTUSB_ATH3012 },
241 { USB_DEVICE(0x13d3, 0x3395), .driver_info = BTUSB_ATH3012 },
242 { USB_DEVICE(0x13d3, 0x3402), .driver_info = BTUSB_ATH3012 },
243 { USB_DEVICE(0x13d3, 0x3408), .driver_info = BTUSB_ATH3012 },
244 { USB_DEVICE(0x13d3, 0x3423), .driver_info = BTUSB_ATH3012 },
245 { USB_DEVICE(0x13d3, 0x3432), .driver_info = BTUSB_ATH3012 },
246 { USB_DEVICE(0x13d3, 0x3472), .driver_info = BTUSB_ATH3012 },
247 { USB_DEVICE(0x13d3, 0x3474), .driver_info = BTUSB_ATH3012 },
248 { USB_DEVICE(0x13d3, 0x3487), .driver_info = BTUSB_ATH3012 },
249 { USB_DEVICE(0x13d3, 0x3490), .driver_info = BTUSB_ATH3012 },
250
251
252 { USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
253
254
255 { USB_DEVICE(0x0489, 0xe036), .driver_info = BTUSB_ATH3012 },
256 { USB_DEVICE(0x0489, 0xe03c), .driver_info = BTUSB_ATH3012 },
257
258
259 { USB_DEVICE(0x0cf3, 0x535b), .driver_info = BTUSB_QCA_ROME |
260 BTUSB_WIDEBAND_SPEECH },
261 { USB_DEVICE(0x0cf3, 0xe007), .driver_info = BTUSB_QCA_ROME |
262 BTUSB_WIDEBAND_SPEECH },
263 { USB_DEVICE(0x0cf3, 0xe009), .driver_info = BTUSB_QCA_ROME |
264 BTUSB_WIDEBAND_SPEECH },
265 { USB_DEVICE(0x0cf3, 0xe010), .driver_info = BTUSB_QCA_ROME |
266 BTUSB_WIDEBAND_SPEECH },
267 { USB_DEVICE(0x0cf3, 0xe300), .driver_info = BTUSB_QCA_ROME |
268 BTUSB_WIDEBAND_SPEECH },
269 { USB_DEVICE(0x0cf3, 0xe301), .driver_info = BTUSB_QCA_ROME |
270 BTUSB_WIDEBAND_SPEECH },
271 { USB_DEVICE(0x0cf3, 0xe360), .driver_info = BTUSB_QCA_ROME |
272 BTUSB_WIDEBAND_SPEECH },
273 { USB_DEVICE(0x0cf3, 0xe500), .driver_info = BTUSB_QCA_ROME |
274 BTUSB_WIDEBAND_SPEECH },
275 { USB_DEVICE(0x0489, 0xe092), .driver_info = BTUSB_QCA_ROME |
276 BTUSB_WIDEBAND_SPEECH },
277 { USB_DEVICE(0x0489, 0xe09f), .driver_info = BTUSB_QCA_ROME |
278 BTUSB_WIDEBAND_SPEECH },
279 { USB_DEVICE(0x0489, 0xe0a2), .driver_info = BTUSB_QCA_ROME |
280 BTUSB_WIDEBAND_SPEECH },
281 { USB_DEVICE(0x04ca, 0x3011), .driver_info = BTUSB_QCA_ROME |
282 BTUSB_WIDEBAND_SPEECH },
283 { USB_DEVICE(0x04ca, 0x3015), .driver_info = BTUSB_QCA_ROME |
284 BTUSB_WIDEBAND_SPEECH },
285 { USB_DEVICE(0x04ca, 0x3016), .driver_info = BTUSB_QCA_ROME |
286 BTUSB_WIDEBAND_SPEECH },
287 { USB_DEVICE(0x04ca, 0x301a), .driver_info = BTUSB_QCA_ROME |
288 BTUSB_WIDEBAND_SPEECH },
289 { USB_DEVICE(0x04ca, 0x3021), .driver_info = BTUSB_QCA_ROME |
290 BTUSB_WIDEBAND_SPEECH },
291 { USB_DEVICE(0x13d3, 0x3491), .driver_info = BTUSB_QCA_ROME |
292 BTUSB_WIDEBAND_SPEECH },
293 { USB_DEVICE(0x13d3, 0x3496), .driver_info = BTUSB_QCA_ROME |
294 BTUSB_WIDEBAND_SPEECH },
295 { USB_DEVICE(0x13d3, 0x3501), .driver_info = BTUSB_QCA_ROME |
296 BTUSB_WIDEBAND_SPEECH },
297
298
299 { USB_DEVICE(0x0cf3, 0xe600), .driver_info = BTUSB_QCA_WCN6855 |
300 BTUSB_WIDEBAND_SPEECH },
301
302
303 { USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
304 { USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
305 { USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
306
307
308 { USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
309 { USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
310
311
312 { USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
313 { USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
314
315
316 { USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
317
318
319 { USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
320
321
322 { USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
323 { USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
324
325
326 { USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
327 { USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
328
329
330 { USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
331
332
333 { USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
334
335
336 { USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
337 { USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
338
339
340 { USB_DEVICE(0x0e5e, 0x6622),
341 .driver_info = BTUSB_BROKEN_ISOC | BTUSB_CW6622},
342
343
344 { USB_DEVICE(0x1310, 0x0001), .driver_info = BTUSB_SWAVE },
345
346
347 { USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
348 { USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
349
350
351 { USB_DEVICE(0x0a12, 0x0002),
352 .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
353
354
355 { USB_DEVICE(0x16d3, 0x0002),
356 .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
357
358
359 { USB_DEVICE(0x1286, 0x2044), .driver_info = BTUSB_MARVELL },
360 { USB_DEVICE(0x1286, 0x2046), .driver_info = BTUSB_MARVELL },
361 { USB_DEVICE(0x1286, 0x204e), .driver_info = BTUSB_MARVELL },
362
363
364 { USB_DEVICE(0x8087, 0x0025), .driver_info = BTUSB_INTEL_NEW |
365 BTUSB_WIDEBAND_SPEECH |
366 BTUSB_VALID_LE_STATES },
367 { USB_DEVICE(0x8087, 0x0026), .driver_info = BTUSB_INTEL_NEW |
368 BTUSB_WIDEBAND_SPEECH },
369 { USB_DEVICE(0x8087, 0x0029), .driver_info = BTUSB_INTEL_NEW |
370 BTUSB_WIDEBAND_SPEECH },
371 { USB_DEVICE(0x8087, 0x0032), .driver_info = BTUSB_INTEL_NEWGEN |
372 BTUSB_WIDEBAND_SPEECH},
373 { USB_DEVICE(0x8087, 0x0033), .driver_info = BTUSB_INTEL_NEWGEN |
374 BTUSB_WIDEBAND_SPEECH},
375 { USB_DEVICE(0x8087, 0x07da), .driver_info = BTUSB_CSR },
376 { USB_DEVICE(0x8087, 0x07dc), .driver_info = BTUSB_INTEL },
377 { USB_DEVICE(0x8087, 0x0a2a), .driver_info = BTUSB_INTEL },
378 { USB_DEVICE(0x8087, 0x0a2b), .driver_info = BTUSB_INTEL_NEW |
379 BTUSB_WIDEBAND_SPEECH },
380 { USB_DEVICE(0x8087, 0x0aa7), .driver_info = BTUSB_INTEL |
381 BTUSB_WIDEBAND_SPEECH },
382 { USB_DEVICE(0x8087, 0x0aaa), .driver_info = BTUSB_INTEL_NEW |
383 BTUSB_WIDEBAND_SPEECH |
384 BTUSB_VALID_LE_STATES },
385
386
387 { USB_VENDOR_AND_INTERFACE_INFO(0x8087, 0xe0, 0x01, 0x01),
388 .driver_info = BTUSB_IGNORE },
389
390
391 { USB_DEVICE(0x0bda, 0xb00c), .driver_info = BTUSB_REALTEK |
392 BTUSB_WIDEBAND_SPEECH },
393 { USB_DEVICE(0x0bda, 0xc822), .driver_info = BTUSB_REALTEK |
394 BTUSB_WIDEBAND_SPEECH },
395
396
397 { USB_DEVICE(0x0bda, 0xc852), .driver_info = BTUSB_REALTEK |
398 BTUSB_WIDEBAND_SPEECH },
399
400
401 { USB_VENDOR_AND_INTERFACE_INFO(0x0bda, 0xe0, 0x01, 0x01),
402 .driver_info = BTUSB_REALTEK },
403
404
405 { USB_VENDOR_AND_INTERFACE_INFO(0x0e8d, 0xe0, 0x01, 0x01),
406 .driver_info = BTUSB_MEDIATEK |
407 BTUSB_WIDEBAND_SPEECH |
408 BTUSB_VALID_LE_STATES },
409
410
411 { USB_DEVICE(0x13d3, 0x3560), .driver_info = BTUSB_MEDIATEK},
412
413
414 { USB_DEVICE(0x04ca, 0x3802), .driver_info = BTUSB_MEDIATEK |
415 BTUSB_WIDEBAND_SPEECH |
416 BTUSB_VALID_LE_STATES },
417
418
419 { USB_DEVICE(0x0930, 0x021d), .driver_info = BTUSB_REALTEK },
420 { USB_DEVICE(0x13d3, 0x3394), .driver_info = BTUSB_REALTEK },
421
422
423 { USB_DEVICE(0x0489, 0xe085), .driver_info = BTUSB_REALTEK },
424 { USB_DEVICE(0x0489, 0xe08b), .driver_info = BTUSB_REALTEK },
425 { USB_DEVICE(0x13d3, 0x3410), .driver_info = BTUSB_REALTEK },
426 { USB_DEVICE(0x13d3, 0x3416), .driver_info = BTUSB_REALTEK },
427 { USB_DEVICE(0x13d3, 0x3459), .driver_info = BTUSB_REALTEK },
428 { USB_DEVICE(0x13d3, 0x3494), .driver_info = BTUSB_REALTEK },
429
430
431 { USB_DEVICE(0x7392, 0xa611), .driver_info = BTUSB_REALTEK },
432
433
434 { USB_DEVICE(0x0bda, 0xb009), .driver_info = BTUSB_REALTEK },
435 { USB_DEVICE(0x2ff8, 0xb011), .driver_info = BTUSB_REALTEK },
436
437
438 { USB_DEVICE(0x0b05, 0x190e), .driver_info = BTUSB_REALTEK |
439 BTUSB_WIDEBAND_SPEECH },
440
441
442 { USB_DEVICE(0x0b05, 0x17dc), .driver_info = BTUSB_REALTEK },
443 { USB_DEVICE(0x13d3, 0x3414), .driver_info = BTUSB_REALTEK },
444 { USB_DEVICE(0x13d3, 0x3458), .driver_info = BTUSB_REALTEK },
445 { USB_DEVICE(0x13d3, 0x3461), .driver_info = BTUSB_REALTEK },
446 { USB_DEVICE(0x13d3, 0x3462), .driver_info = BTUSB_REALTEK },
447
448
449 { USB_DEVICE(0x13d3, 0x3526), .driver_info = BTUSB_REALTEK },
450 { USB_DEVICE(0x0b05, 0x185c), .driver_info = BTUSB_REALTEK },
451
452
453 { USB_DEVICE(0x04ca, 0x4005), .driver_info = BTUSB_REALTEK |
454 BTUSB_WIDEBAND_SPEECH },
455 { USB_DEVICE(0x04c5, 0x161f), .driver_info = BTUSB_REALTEK |
456 BTUSB_WIDEBAND_SPEECH },
457 { USB_DEVICE(0x0b05, 0x18ef), .driver_info = BTUSB_REALTEK |
458 BTUSB_WIDEBAND_SPEECH },
459 { USB_DEVICE(0x13d3, 0x3548), .driver_info = BTUSB_REALTEK |
460 BTUSB_WIDEBAND_SPEECH },
461 { USB_DEVICE(0x13d3, 0x3549), .driver_info = BTUSB_REALTEK |
462 BTUSB_WIDEBAND_SPEECH },
463 { USB_DEVICE(0x13d3, 0x3553), .driver_info = BTUSB_REALTEK |
464 BTUSB_WIDEBAND_SPEECH },
465 { USB_DEVICE(0x13d3, 0x3555), .driver_info = BTUSB_REALTEK |
466 BTUSB_WIDEBAND_SPEECH },
467 { USB_DEVICE(0x2ff8, 0x3051), .driver_info = BTUSB_REALTEK |
468 BTUSB_WIDEBAND_SPEECH },
469 { USB_DEVICE(0x1358, 0xc123), .driver_info = BTUSB_REALTEK |
470 BTUSB_WIDEBAND_SPEECH },
471 { USB_DEVICE(0x0bda, 0xc123), .driver_info = BTUSB_REALTEK |
472 BTUSB_WIDEBAND_SPEECH },
473 { USB_DEVICE(0x0cb5, 0xc547), .driver_info = BTUSB_REALTEK |
474 BTUSB_WIDEBAND_SPEECH },
475
476
477 { USB_DEVICE(0x0c10, 0x0000), .driver_info = BTUSB_SWAVE },
478
479 { }
480};
481
482
483
484
485
486static const struct dmi_system_id btusb_needs_reset_resume_table[] = {
487 {
488
489 .matches = {
490 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
491 DMI_MATCH(DMI_PRODUCT_NAME, "OptiPlex 3060"),
492 },
493 },
494 {
495
496 .matches = {
497 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
498 DMI_MATCH(DMI_PRODUCT_NAME, "XPS 13 9360"),
499 },
500 },
501 {
502
503 .matches = {
504 DMI_MATCH(DMI_SYS_VENDOR, "Dell Inc."),
505 DMI_MATCH(DMI_PRODUCT_NAME, "Inspiron 5565"),
506 },
507 },
508 {}
509};
510
511#define BTUSB_MAX_ISOC_FRAMES 10
512
513#define BTUSB_INTR_RUNNING 0
514#define BTUSB_BULK_RUNNING 1
515#define BTUSB_ISOC_RUNNING 2
516#define BTUSB_SUSPENDING 3
517#define BTUSB_DID_ISO_RESUME 4
518#define BTUSB_BOOTLOADER 5
519#define BTUSB_DOWNLOADING 6
520#define BTUSB_FIRMWARE_LOADED 7
521#define BTUSB_FIRMWARE_FAILED 8
522#define BTUSB_BOOTING 9
523#define BTUSB_DIAG_RUNNING 10
524#define BTUSB_OOB_WAKE_ENABLED 11
525#define BTUSB_HW_RESET_ACTIVE 12
526#define BTUSB_TX_WAIT_VND_EVT 13
527#define BTUSB_WAKEUP_DISABLE 14
528
529struct btusb_data {
530 struct hci_dev *hdev;
531 struct usb_device *udev;
532 struct usb_interface *intf;
533 struct usb_interface *isoc;
534 struct usb_interface *diag;
535 unsigned isoc_ifnum;
536
537 unsigned long flags;
538
539 struct work_struct work;
540 struct work_struct waker;
541
542 struct usb_anchor deferred;
543 struct usb_anchor tx_anchor;
544 int tx_in_flight;
545 spinlock_t txlock;
546
547 struct usb_anchor intr_anchor;
548 struct usb_anchor bulk_anchor;
549 struct usb_anchor isoc_anchor;
550 struct usb_anchor diag_anchor;
551 struct usb_anchor ctrl_anchor;
552 spinlock_t rxlock;
553
554 struct sk_buff *evt_skb;
555 struct sk_buff *acl_skb;
556 struct sk_buff *sco_skb;
557
558 struct usb_endpoint_descriptor *intr_ep;
559 struct usb_endpoint_descriptor *bulk_tx_ep;
560 struct usb_endpoint_descriptor *bulk_rx_ep;
561 struct usb_endpoint_descriptor *isoc_tx_ep;
562 struct usb_endpoint_descriptor *isoc_rx_ep;
563 struct usb_endpoint_descriptor *diag_tx_ep;
564 struct usb_endpoint_descriptor *diag_rx_ep;
565
566 struct gpio_desc *reset_gpio;
567
568 __u8 cmdreq_type;
569 __u8 cmdreq;
570
571 unsigned int sco_num;
572 unsigned int air_mode;
573 bool usb_alt6_packet_flow;
574 int isoc_altsetting;
575 int suspend_count;
576
577 int (*recv_event)(struct hci_dev *hdev, struct sk_buff *skb);
578 int (*recv_bulk)(struct btusb_data *data, void *buffer, int count);
579
580 int (*setup_on_usb)(struct hci_dev *hdev);
581
582 int oob_wake_irq;
583 unsigned cmd_timeout_cnt;
584};
585
586static void btusb_intel_cmd_timeout(struct hci_dev *hdev)
587{
588 struct btusb_data *data = hci_get_drvdata(hdev);
589 struct gpio_desc *reset_gpio = data->reset_gpio;
590
591 if (++data->cmd_timeout_cnt < 5)
592 return;
593
594 if (!reset_gpio) {
595 bt_dev_err(hdev, "No way to reset. Ignoring and continuing");
596 return;
597 }
598
599
600
601
602
603
604
605
606 if (test_and_set_bit(BTUSB_HW_RESET_ACTIVE, &data->flags)) {
607 bt_dev_err(hdev, "last reset failed? Not resetting again");
608 return;
609 }
610
611 bt_dev_err(hdev, "Initiating HW reset via gpio");
612 gpiod_set_value_cansleep(reset_gpio, 1);
613 msleep(100);
614 gpiod_set_value_cansleep(reset_gpio, 0);
615}
616
617static void btusb_rtl_cmd_timeout(struct hci_dev *hdev)
618{
619 struct btusb_data *data = hci_get_drvdata(hdev);
620 struct gpio_desc *reset_gpio = data->reset_gpio;
621
622 if (++data->cmd_timeout_cnt < 5)
623 return;
624
625 if (!reset_gpio) {
626 bt_dev_err(hdev, "No gpio to reset Realtek device, ignoring");
627 return;
628 }
629
630
631
632
633
634
635
636 if (test_and_set_bit(BTUSB_HW_RESET_ACTIVE, &data->flags)) {
637 bt_dev_err(hdev, "last reset failed? Not resetting again");
638 return;
639 }
640
641 bt_dev_err(hdev, "Reset Realtek device via gpio");
642 gpiod_set_value_cansleep(reset_gpio, 1);
643 msleep(200);
644 gpiod_set_value_cansleep(reset_gpio, 0);
645}
646
647static void btusb_qca_cmd_timeout(struct hci_dev *hdev)
648{
649 struct btusb_data *data = hci_get_drvdata(hdev);
650 int err;
651
652 if (++data->cmd_timeout_cnt < 5)
653 return;
654
655 bt_dev_err(hdev, "Multiple cmd timeouts seen. Resetting usb device.");
656
657 err = usb_autopm_get_interface(data->intf);
658 if (!err)
659 usb_queue_reset_device(data->intf);
660 else
661 bt_dev_err(hdev, "Failed usb_autopm_get_interface with %d", err);
662}
663
664static inline void btusb_free_frags(struct btusb_data *data)
665{
666 unsigned long flags;
667
668 spin_lock_irqsave(&data->rxlock, flags);
669
670 kfree_skb(data->evt_skb);
671 data->evt_skb = NULL;
672
673 kfree_skb(data->acl_skb);
674 data->acl_skb = NULL;
675
676 kfree_skb(data->sco_skb);
677 data->sco_skb = NULL;
678
679 spin_unlock_irqrestore(&data->rxlock, flags);
680}
681
682static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count)
683{
684 struct sk_buff *skb;
685 unsigned long flags;
686 int err = 0;
687
688 spin_lock_irqsave(&data->rxlock, flags);
689 skb = data->evt_skb;
690
691 while (count) {
692 int len;
693
694 if (!skb) {
695 skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC);
696 if (!skb) {
697 err = -ENOMEM;
698 break;
699 }
700
701 hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
702 hci_skb_expect(skb) = HCI_EVENT_HDR_SIZE;
703 }
704
705 len = min_t(uint, hci_skb_expect(skb), count);
706 skb_put_data(skb, buffer, len);
707
708 count -= len;
709 buffer += len;
710 hci_skb_expect(skb) -= len;
711
712 if (skb->len == HCI_EVENT_HDR_SIZE) {
713
714 hci_skb_expect(skb) = hci_event_hdr(skb)->plen;
715
716 if (skb_tailroom(skb) < hci_skb_expect(skb)) {
717 kfree_skb(skb);
718 skb = NULL;
719
720 err = -EILSEQ;
721 break;
722 }
723 }
724
725 if (!hci_skb_expect(skb)) {
726
727 data->recv_event(data->hdev, skb);
728 skb = NULL;
729 }
730 }
731
732 data->evt_skb = skb;
733 spin_unlock_irqrestore(&data->rxlock, flags);
734
735 return err;
736}
737
738static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count)
739{
740 struct sk_buff *skb;
741 unsigned long flags;
742 int err = 0;
743
744 spin_lock_irqsave(&data->rxlock, flags);
745 skb = data->acl_skb;
746
747 while (count) {
748 int len;
749
750 if (!skb) {
751 skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
752 if (!skb) {
753 err = -ENOMEM;
754 break;
755 }
756
757 hci_skb_pkt_type(skb) = HCI_ACLDATA_PKT;
758 hci_skb_expect(skb) = HCI_ACL_HDR_SIZE;
759 }
760
761 len = min_t(uint, hci_skb_expect(skb), count);
762 skb_put_data(skb, buffer, len);
763
764 count -= len;
765 buffer += len;
766 hci_skb_expect(skb) -= len;
767
768 if (skb->len == HCI_ACL_HDR_SIZE) {
769 __le16 dlen = hci_acl_hdr(skb)->dlen;
770
771
772 hci_skb_expect(skb) = __le16_to_cpu(dlen);
773
774 if (skb_tailroom(skb) < hci_skb_expect(skb)) {
775 kfree_skb(skb);
776 skb = NULL;
777
778 err = -EILSEQ;
779 break;
780 }
781 }
782
783 if (!hci_skb_expect(skb)) {
784
785 hci_recv_frame(data->hdev, skb);
786 skb = NULL;
787 }
788 }
789
790 data->acl_skb = skb;
791 spin_unlock_irqrestore(&data->rxlock, flags);
792
793 return err;
794}
795
796static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count)
797{
798 struct sk_buff *skb;
799 unsigned long flags;
800 int err = 0;
801
802 spin_lock_irqsave(&data->rxlock, flags);
803 skb = data->sco_skb;
804
805 while (count) {
806 int len;
807
808 if (!skb) {
809 skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC);
810 if (!skb) {
811 err = -ENOMEM;
812 break;
813 }
814
815 hci_skb_pkt_type(skb) = HCI_SCODATA_PKT;
816 hci_skb_expect(skb) = HCI_SCO_HDR_SIZE;
817 }
818
819 len = min_t(uint, hci_skb_expect(skb), count);
820 skb_put_data(skb, buffer, len);
821
822 count -= len;
823 buffer += len;
824 hci_skb_expect(skb) -= len;
825
826 if (skb->len == HCI_SCO_HDR_SIZE) {
827
828 hci_skb_expect(skb) = hci_sco_hdr(skb)->dlen;
829
830 if (skb_tailroom(skb) < hci_skb_expect(skb)) {
831 kfree_skb(skb);
832 skb = NULL;
833
834 err = -EILSEQ;
835 break;
836 }
837 }
838
839 if (!hci_skb_expect(skb)) {
840
841 hci_recv_frame(data->hdev, skb);
842 skb = NULL;
843 }
844 }
845
846 data->sco_skb = skb;
847 spin_unlock_irqrestore(&data->rxlock, flags);
848
849 return err;
850}
851
852static void btusb_intr_complete(struct urb *urb)
853{
854 struct hci_dev *hdev = urb->context;
855 struct btusb_data *data = hci_get_drvdata(hdev);
856 int err;
857
858 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
859 urb->actual_length);
860
861 if (!test_bit(HCI_RUNNING, &hdev->flags))
862 return;
863
864 if (urb->status == 0) {
865 hdev->stat.byte_rx += urb->actual_length;
866
867 if (btusb_recv_intr(data, urb->transfer_buffer,
868 urb->actual_length) < 0) {
869 bt_dev_err(hdev, "corrupted event packet");
870 hdev->stat.err_rx++;
871 }
872 } else if (urb->status == -ENOENT) {
873
874 return;
875 }
876
877 if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
878 return;
879
880 usb_mark_last_busy(data->udev);
881 usb_anchor_urb(urb, &data->intr_anchor);
882
883 err = usb_submit_urb(urb, GFP_ATOMIC);
884 if (err < 0) {
885
886
887
888 if (err != -EPERM && err != -ENODEV)
889 bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
890 urb, -err);
891 usb_unanchor_urb(urb);
892 }
893}
894
895static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
896{
897 struct btusb_data *data = hci_get_drvdata(hdev);
898 struct urb *urb;
899 unsigned char *buf;
900 unsigned int pipe;
901 int err, size;
902
903 BT_DBG("%s", hdev->name);
904
905 if (!data->intr_ep)
906 return -ENODEV;
907
908 urb = usb_alloc_urb(0, mem_flags);
909 if (!urb)
910 return -ENOMEM;
911
912 size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
913
914 buf = kmalloc(size, mem_flags);
915 if (!buf) {
916 usb_free_urb(urb);
917 return -ENOMEM;
918 }
919
920 pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
921
922 usb_fill_int_urb(urb, data->udev, pipe, buf, size,
923 btusb_intr_complete, hdev, data->intr_ep->bInterval);
924
925 urb->transfer_flags |= URB_FREE_BUFFER;
926
927 usb_anchor_urb(urb, &data->intr_anchor);
928
929 err = usb_submit_urb(urb, mem_flags);
930 if (err < 0) {
931 if (err != -EPERM && err != -ENODEV)
932 bt_dev_err(hdev, "urb %p submission failed (%d)",
933 urb, -err);
934 usb_unanchor_urb(urb);
935 }
936
937 usb_free_urb(urb);
938
939 return err;
940}
941
942static void btusb_bulk_complete(struct urb *urb)
943{
944 struct hci_dev *hdev = urb->context;
945 struct btusb_data *data = hci_get_drvdata(hdev);
946 int err;
947
948 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
949 urb->actual_length);
950
951 if (!test_bit(HCI_RUNNING, &hdev->flags))
952 return;
953
954 if (urb->status == 0) {
955 hdev->stat.byte_rx += urb->actual_length;
956
957 if (data->recv_bulk(data, urb->transfer_buffer,
958 urb->actual_length) < 0) {
959 bt_dev_err(hdev, "corrupted ACL packet");
960 hdev->stat.err_rx++;
961 }
962 } else if (urb->status == -ENOENT) {
963
964 return;
965 }
966
967 if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
968 return;
969
970 usb_anchor_urb(urb, &data->bulk_anchor);
971 usb_mark_last_busy(data->udev);
972
973 err = usb_submit_urb(urb, GFP_ATOMIC);
974 if (err < 0) {
975
976
977
978 if (err != -EPERM && err != -ENODEV)
979 bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
980 urb, -err);
981 usb_unanchor_urb(urb);
982 }
983}
984
985static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
986{
987 struct btusb_data *data = hci_get_drvdata(hdev);
988 struct urb *urb;
989 unsigned char *buf;
990 unsigned int pipe;
991 int err, size = HCI_MAX_FRAME_SIZE;
992
993 BT_DBG("%s", hdev->name);
994
995 if (!data->bulk_rx_ep)
996 return -ENODEV;
997
998 urb = usb_alloc_urb(0, mem_flags);
999 if (!urb)
1000 return -ENOMEM;
1001
1002 buf = kmalloc(size, mem_flags);
1003 if (!buf) {
1004 usb_free_urb(urb);
1005 return -ENOMEM;
1006 }
1007
1008 pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
1009
1010 usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
1011 btusb_bulk_complete, hdev);
1012
1013 urb->transfer_flags |= URB_FREE_BUFFER;
1014
1015 usb_mark_last_busy(data->udev);
1016 usb_anchor_urb(urb, &data->bulk_anchor);
1017
1018 err = usb_submit_urb(urb, mem_flags);
1019 if (err < 0) {
1020 if (err != -EPERM && err != -ENODEV)
1021 bt_dev_err(hdev, "urb %p submission failed (%d)",
1022 urb, -err);
1023 usb_unanchor_urb(urb);
1024 }
1025
1026 usb_free_urb(urb);
1027
1028 return err;
1029}
1030
1031static void btusb_isoc_complete(struct urb *urb)
1032{
1033 struct hci_dev *hdev = urb->context;
1034 struct btusb_data *data = hci_get_drvdata(hdev);
1035 int i, err;
1036
1037 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1038 urb->actual_length);
1039
1040 if (!test_bit(HCI_RUNNING, &hdev->flags))
1041 return;
1042
1043 if (urb->status == 0) {
1044 for (i = 0; i < urb->number_of_packets; i++) {
1045 unsigned int offset = urb->iso_frame_desc[i].offset;
1046 unsigned int length = urb->iso_frame_desc[i].actual_length;
1047
1048 if (urb->iso_frame_desc[i].status)
1049 continue;
1050
1051 hdev->stat.byte_rx += length;
1052
1053 if (btusb_recv_isoc(data, urb->transfer_buffer + offset,
1054 length) < 0) {
1055 bt_dev_err(hdev, "corrupted SCO packet");
1056 hdev->stat.err_rx++;
1057 }
1058 }
1059 } else if (urb->status == -ENOENT) {
1060
1061 return;
1062 }
1063
1064 if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
1065 return;
1066
1067 usb_anchor_urb(urb, &data->isoc_anchor);
1068
1069 err = usb_submit_urb(urb, GFP_ATOMIC);
1070 if (err < 0) {
1071
1072
1073
1074 if (err != -EPERM && err != -ENODEV)
1075 bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
1076 urb, -err);
1077 usb_unanchor_urb(urb);
1078 }
1079}
1080
1081static inline void __fill_isoc_descriptor_msbc(struct urb *urb, int len,
1082 int mtu, struct btusb_data *data)
1083{
1084 int i, offset = 0;
1085 unsigned int interval;
1086
1087 BT_DBG("len %d mtu %d", len, mtu);
1088
1089
1090
1091
1092
1093
1094
1095 if (data->usb_alt6_packet_flow) {
1096 interval = 7;
1097 data->usb_alt6_packet_flow = false;
1098 } else {
1099 interval = 6;
1100 data->usb_alt6_packet_flow = true;
1101 }
1102
1103 for (i = 0; i < interval; i++) {
1104 urb->iso_frame_desc[i].offset = offset;
1105 urb->iso_frame_desc[i].length = offset;
1106 }
1107
1108 if (len && i < BTUSB_MAX_ISOC_FRAMES) {
1109 urb->iso_frame_desc[i].offset = offset;
1110 urb->iso_frame_desc[i].length = len;
1111 i++;
1112 }
1113
1114 urb->number_of_packets = i;
1115}
1116
1117static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
1118{
1119 int i, offset = 0;
1120
1121 BT_DBG("len %d mtu %d", len, mtu);
1122
1123 for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
1124 i++, offset += mtu, len -= mtu) {
1125 urb->iso_frame_desc[i].offset = offset;
1126 urb->iso_frame_desc[i].length = mtu;
1127 }
1128
1129 if (len && i < BTUSB_MAX_ISOC_FRAMES) {
1130 urb->iso_frame_desc[i].offset = offset;
1131 urb->iso_frame_desc[i].length = len;
1132 i++;
1133 }
1134
1135 urb->number_of_packets = i;
1136}
1137
1138static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
1139{
1140 struct btusb_data *data = hci_get_drvdata(hdev);
1141 struct urb *urb;
1142 unsigned char *buf;
1143 unsigned int pipe;
1144 int err, size;
1145
1146 BT_DBG("%s", hdev->name);
1147
1148 if (!data->isoc_rx_ep)
1149 return -ENODEV;
1150
1151 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
1152 if (!urb)
1153 return -ENOMEM;
1154
1155 size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
1156 BTUSB_MAX_ISOC_FRAMES;
1157
1158 buf = kmalloc(size, mem_flags);
1159 if (!buf) {
1160 usb_free_urb(urb);
1161 return -ENOMEM;
1162 }
1163
1164 pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
1165
1166 usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_isoc_complete,
1167 hdev, data->isoc_rx_ep->bInterval);
1168
1169 urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
1170
1171 __fill_isoc_descriptor(urb, size,
1172 le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
1173
1174 usb_anchor_urb(urb, &data->isoc_anchor);
1175
1176 err = usb_submit_urb(urb, mem_flags);
1177 if (err < 0) {
1178 if (err != -EPERM && err != -ENODEV)
1179 bt_dev_err(hdev, "urb %p submission failed (%d)",
1180 urb, -err);
1181 usb_unanchor_urb(urb);
1182 }
1183
1184 usb_free_urb(urb);
1185
1186 return err;
1187}
1188
1189static void btusb_diag_complete(struct urb *urb)
1190{
1191 struct hci_dev *hdev = urb->context;
1192 struct btusb_data *data = hci_get_drvdata(hdev);
1193 int err;
1194
1195 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1196 urb->actual_length);
1197
1198 if (urb->status == 0) {
1199 struct sk_buff *skb;
1200
1201 skb = bt_skb_alloc(urb->actual_length, GFP_ATOMIC);
1202 if (skb) {
1203 skb_put_data(skb, urb->transfer_buffer,
1204 urb->actual_length);
1205 hci_recv_diag(hdev, skb);
1206 }
1207 } else if (urb->status == -ENOENT) {
1208
1209 return;
1210 }
1211
1212 if (!test_bit(BTUSB_DIAG_RUNNING, &data->flags))
1213 return;
1214
1215 usb_anchor_urb(urb, &data->diag_anchor);
1216 usb_mark_last_busy(data->udev);
1217
1218 err = usb_submit_urb(urb, GFP_ATOMIC);
1219 if (err < 0) {
1220
1221
1222
1223 if (err != -EPERM && err != -ENODEV)
1224 bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
1225 urb, -err);
1226 usb_unanchor_urb(urb);
1227 }
1228}
1229
1230static int btusb_submit_diag_urb(struct hci_dev *hdev, gfp_t mem_flags)
1231{
1232 struct btusb_data *data = hci_get_drvdata(hdev);
1233 struct urb *urb;
1234 unsigned char *buf;
1235 unsigned int pipe;
1236 int err, size = HCI_MAX_FRAME_SIZE;
1237
1238 BT_DBG("%s", hdev->name);
1239
1240 if (!data->diag_rx_ep)
1241 return -ENODEV;
1242
1243 urb = usb_alloc_urb(0, mem_flags);
1244 if (!urb)
1245 return -ENOMEM;
1246
1247 buf = kmalloc(size, mem_flags);
1248 if (!buf) {
1249 usb_free_urb(urb);
1250 return -ENOMEM;
1251 }
1252
1253 pipe = usb_rcvbulkpipe(data->udev, data->diag_rx_ep->bEndpointAddress);
1254
1255 usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
1256 btusb_diag_complete, hdev);
1257
1258 urb->transfer_flags |= URB_FREE_BUFFER;
1259
1260 usb_mark_last_busy(data->udev);
1261 usb_anchor_urb(urb, &data->diag_anchor);
1262
1263 err = usb_submit_urb(urb, mem_flags);
1264 if (err < 0) {
1265 if (err != -EPERM && err != -ENODEV)
1266 bt_dev_err(hdev, "urb %p submission failed (%d)",
1267 urb, -err);
1268 usb_unanchor_urb(urb);
1269 }
1270
1271 usb_free_urb(urb);
1272
1273 return err;
1274}
1275
1276static void btusb_tx_complete(struct urb *urb)
1277{
1278 struct sk_buff *skb = urb->context;
1279 struct hci_dev *hdev = (struct hci_dev *)skb->dev;
1280 struct btusb_data *data = hci_get_drvdata(hdev);
1281 unsigned long flags;
1282
1283 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1284 urb->actual_length);
1285
1286 if (!test_bit(HCI_RUNNING, &hdev->flags))
1287 goto done;
1288
1289 if (!urb->status)
1290 hdev->stat.byte_tx += urb->transfer_buffer_length;
1291 else
1292 hdev->stat.err_tx++;
1293
1294done:
1295 spin_lock_irqsave(&data->txlock, flags);
1296 data->tx_in_flight--;
1297 spin_unlock_irqrestore(&data->txlock, flags);
1298
1299 kfree(urb->setup_packet);
1300
1301 kfree_skb(skb);
1302}
1303
1304static void btusb_isoc_tx_complete(struct urb *urb)
1305{
1306 struct sk_buff *skb = urb->context;
1307 struct hci_dev *hdev = (struct hci_dev *)skb->dev;
1308
1309 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
1310 urb->actual_length);
1311
1312 if (!test_bit(HCI_RUNNING, &hdev->flags))
1313 goto done;
1314
1315 if (!urb->status)
1316 hdev->stat.byte_tx += urb->transfer_buffer_length;
1317 else
1318 hdev->stat.err_tx++;
1319
1320done:
1321 kfree(urb->setup_packet);
1322
1323 kfree_skb(skb);
1324}
1325
1326static int btusb_open(struct hci_dev *hdev)
1327{
1328 struct btusb_data *data = hci_get_drvdata(hdev);
1329 int err;
1330
1331 BT_DBG("%s", hdev->name);
1332
1333 err = usb_autopm_get_interface(data->intf);
1334 if (err < 0)
1335 return err;
1336
1337
1338
1339
1340 if (data->setup_on_usb) {
1341 err = data->setup_on_usb(hdev);
1342 if (err < 0)
1343 goto setup_fail;
1344 }
1345
1346 data->intf->needs_remote_wakeup = 1;
1347
1348
1349
1350
1351
1352 if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags))
1353 device_wakeup_disable(&data->udev->dev);
1354
1355 if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
1356 goto done;
1357
1358 err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
1359 if (err < 0)
1360 goto failed;
1361
1362 err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1363 if (err < 0) {
1364 usb_kill_anchored_urbs(&data->intr_anchor);
1365 goto failed;
1366 }
1367
1368 set_bit(BTUSB_BULK_RUNNING, &data->flags);
1369 btusb_submit_bulk_urb(hdev, GFP_KERNEL);
1370
1371 if (data->diag) {
1372 if (!btusb_submit_diag_urb(hdev, GFP_KERNEL))
1373 set_bit(BTUSB_DIAG_RUNNING, &data->flags);
1374 }
1375
1376done:
1377 usb_autopm_put_interface(data->intf);
1378 return 0;
1379
1380failed:
1381 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1382setup_fail:
1383 usb_autopm_put_interface(data->intf);
1384 return err;
1385}
1386
1387static void btusb_stop_traffic(struct btusb_data *data)
1388{
1389 usb_kill_anchored_urbs(&data->intr_anchor);
1390 usb_kill_anchored_urbs(&data->bulk_anchor);
1391 usb_kill_anchored_urbs(&data->isoc_anchor);
1392 usb_kill_anchored_urbs(&data->diag_anchor);
1393 usb_kill_anchored_urbs(&data->ctrl_anchor);
1394}
1395
1396static int btusb_close(struct hci_dev *hdev)
1397{
1398 struct btusb_data *data = hci_get_drvdata(hdev);
1399 int err;
1400
1401 BT_DBG("%s", hdev->name);
1402
1403 cancel_work_sync(&data->work);
1404 cancel_work_sync(&data->waker);
1405
1406 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1407 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
1408 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
1409 clear_bit(BTUSB_DIAG_RUNNING, &data->flags);
1410
1411 btusb_stop_traffic(data);
1412 btusb_free_frags(data);
1413
1414 err = usb_autopm_get_interface(data->intf);
1415 if (err < 0)
1416 goto failed;
1417
1418 data->intf->needs_remote_wakeup = 0;
1419
1420
1421 if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags))
1422 data->intf->needs_remote_wakeup = 1;
1423
1424 usb_autopm_put_interface(data->intf);
1425
1426failed:
1427 usb_scuttle_anchored_urbs(&data->deferred);
1428 return 0;
1429}
1430
1431static int btusb_flush(struct hci_dev *hdev)
1432{
1433 struct btusb_data *data = hci_get_drvdata(hdev);
1434
1435 BT_DBG("%s", hdev->name);
1436
1437 usb_kill_anchored_urbs(&data->tx_anchor);
1438 btusb_free_frags(data);
1439
1440 return 0;
1441}
1442
1443static struct urb *alloc_ctrl_urb(struct hci_dev *hdev, struct sk_buff *skb)
1444{
1445 struct btusb_data *data = hci_get_drvdata(hdev);
1446 struct usb_ctrlrequest *dr;
1447 struct urb *urb;
1448 unsigned int pipe;
1449
1450 urb = usb_alloc_urb(0, GFP_KERNEL);
1451 if (!urb)
1452 return ERR_PTR(-ENOMEM);
1453
1454 dr = kmalloc(sizeof(*dr), GFP_KERNEL);
1455 if (!dr) {
1456 usb_free_urb(urb);
1457 return ERR_PTR(-ENOMEM);
1458 }
1459
1460 dr->bRequestType = data->cmdreq_type;
1461 dr->bRequest = data->cmdreq;
1462 dr->wIndex = 0;
1463 dr->wValue = 0;
1464 dr->wLength = __cpu_to_le16(skb->len);
1465
1466 pipe = usb_sndctrlpipe(data->udev, 0x00);
1467
1468 usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
1469 skb->data, skb->len, btusb_tx_complete, skb);
1470
1471 skb->dev = (void *)hdev;
1472
1473 return urb;
1474}
1475
1476static struct urb *alloc_bulk_urb(struct hci_dev *hdev, struct sk_buff *skb)
1477{
1478 struct btusb_data *data = hci_get_drvdata(hdev);
1479 struct urb *urb;
1480 unsigned int pipe;
1481
1482 if (!data->bulk_tx_ep)
1483 return ERR_PTR(-ENODEV);
1484
1485 urb = usb_alloc_urb(0, GFP_KERNEL);
1486 if (!urb)
1487 return ERR_PTR(-ENOMEM);
1488
1489 pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress);
1490
1491 usb_fill_bulk_urb(urb, data->udev, pipe,
1492 skb->data, skb->len, btusb_tx_complete, skb);
1493
1494 skb->dev = (void *)hdev;
1495
1496 return urb;
1497}
1498
1499static struct urb *alloc_isoc_urb(struct hci_dev *hdev, struct sk_buff *skb)
1500{
1501 struct btusb_data *data = hci_get_drvdata(hdev);
1502 struct urb *urb;
1503 unsigned int pipe;
1504
1505 if (!data->isoc_tx_ep)
1506 return ERR_PTR(-ENODEV);
1507
1508 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_KERNEL);
1509 if (!urb)
1510 return ERR_PTR(-ENOMEM);
1511
1512 pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress);
1513
1514 usb_fill_int_urb(urb, data->udev, pipe,
1515 skb->data, skb->len, btusb_isoc_tx_complete,
1516 skb, data->isoc_tx_ep->bInterval);
1517
1518 urb->transfer_flags = URB_ISO_ASAP;
1519
1520 if (data->isoc_altsetting == 6)
1521 __fill_isoc_descriptor_msbc(urb, skb->len,
1522 le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize),
1523 data);
1524 else
1525 __fill_isoc_descriptor(urb, skb->len,
1526 le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
1527 skb->dev = (void *)hdev;
1528
1529 return urb;
1530}
1531
1532static int submit_tx_urb(struct hci_dev *hdev, struct urb *urb)
1533{
1534 struct btusb_data *data = hci_get_drvdata(hdev);
1535 int err;
1536
1537 usb_anchor_urb(urb, &data->tx_anchor);
1538
1539 err = usb_submit_urb(urb, GFP_KERNEL);
1540 if (err < 0) {
1541 if (err != -EPERM && err != -ENODEV)
1542 bt_dev_err(hdev, "urb %p submission failed (%d)",
1543 urb, -err);
1544 kfree(urb->setup_packet);
1545 usb_unanchor_urb(urb);
1546 } else {
1547 usb_mark_last_busy(data->udev);
1548 }
1549
1550 usb_free_urb(urb);
1551 return err;
1552}
1553
1554static int submit_or_queue_tx_urb(struct hci_dev *hdev, struct urb *urb)
1555{
1556 struct btusb_data *data = hci_get_drvdata(hdev);
1557 unsigned long flags;
1558 bool suspending;
1559
1560 spin_lock_irqsave(&data->txlock, flags);
1561 suspending = test_bit(BTUSB_SUSPENDING, &data->flags);
1562 if (!suspending)
1563 data->tx_in_flight++;
1564 spin_unlock_irqrestore(&data->txlock, flags);
1565
1566 if (!suspending)
1567 return submit_tx_urb(hdev, urb);
1568
1569 usb_anchor_urb(urb, &data->deferred);
1570 schedule_work(&data->waker);
1571
1572 usb_free_urb(urb);
1573 return 0;
1574}
1575
1576static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
1577{
1578 struct urb *urb;
1579
1580 BT_DBG("%s", hdev->name);
1581
1582 switch (hci_skb_pkt_type(skb)) {
1583 case HCI_COMMAND_PKT:
1584 urb = alloc_ctrl_urb(hdev, skb);
1585 if (IS_ERR(urb))
1586 return PTR_ERR(urb);
1587
1588 hdev->stat.cmd_tx++;
1589 return submit_or_queue_tx_urb(hdev, urb);
1590
1591 case HCI_ACLDATA_PKT:
1592 urb = alloc_bulk_urb(hdev, skb);
1593 if (IS_ERR(urb))
1594 return PTR_ERR(urb);
1595
1596 hdev->stat.acl_tx++;
1597 return submit_or_queue_tx_urb(hdev, urb);
1598
1599 case HCI_SCODATA_PKT:
1600 if (hci_conn_num(hdev, SCO_LINK) < 1)
1601 return -ENODEV;
1602
1603 urb = alloc_isoc_urb(hdev, skb);
1604 if (IS_ERR(urb))
1605 return PTR_ERR(urb);
1606
1607 hdev->stat.sco_tx++;
1608 return submit_tx_urb(hdev, urb);
1609 }
1610
1611 return -EILSEQ;
1612}
1613
1614static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
1615{
1616 struct btusb_data *data = hci_get_drvdata(hdev);
1617
1618 BT_DBG("%s evt %d", hdev->name, evt);
1619
1620 if (hci_conn_num(hdev, SCO_LINK) != data->sco_num) {
1621 data->sco_num = hci_conn_num(hdev, SCO_LINK);
1622 data->air_mode = evt;
1623 schedule_work(&data->work);
1624 }
1625}
1626
1627static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
1628{
1629 struct btusb_data *data = hci_get_drvdata(hdev);
1630 struct usb_interface *intf = data->isoc;
1631 struct usb_endpoint_descriptor *ep_desc;
1632 int i, err;
1633
1634 if (!data->isoc)
1635 return -ENODEV;
1636
1637 err = usb_set_interface(data->udev, data->isoc_ifnum, altsetting);
1638 if (err < 0) {
1639 bt_dev_err(hdev, "setting interface failed (%d)", -err);
1640 return err;
1641 }
1642
1643 data->isoc_altsetting = altsetting;
1644
1645 data->isoc_tx_ep = NULL;
1646 data->isoc_rx_ep = NULL;
1647
1648 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1649 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1650
1651 if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
1652 data->isoc_tx_ep = ep_desc;
1653 continue;
1654 }
1655
1656 if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
1657 data->isoc_rx_ep = ep_desc;
1658 continue;
1659 }
1660 }
1661
1662 if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
1663 bt_dev_err(hdev, "invalid SCO descriptors");
1664 return -ENODEV;
1665 }
1666
1667 return 0;
1668}
1669
1670static int btusb_switch_alt_setting(struct hci_dev *hdev, int new_alts)
1671{
1672 struct btusb_data *data = hci_get_drvdata(hdev);
1673 int err;
1674
1675 if (data->isoc_altsetting != new_alts) {
1676 unsigned long flags;
1677
1678 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1679 usb_kill_anchored_urbs(&data->isoc_anchor);
1680
1681
1682
1683
1684
1685
1686
1687
1688
1689
1690 spin_lock_irqsave(&data->rxlock, flags);
1691 kfree_skb(data->sco_skb);
1692 data->sco_skb = NULL;
1693 spin_unlock_irqrestore(&data->rxlock, flags);
1694
1695 err = __set_isoc_interface(hdev, new_alts);
1696 if (err < 0)
1697 return err;
1698 }
1699
1700 if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
1701 if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
1702 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1703 else
1704 btusb_submit_isoc_urb(hdev, GFP_KERNEL);
1705 }
1706
1707 return 0;
1708}
1709
1710static struct usb_host_interface *btusb_find_altsetting(struct btusb_data *data,
1711 int alt)
1712{
1713 struct usb_interface *intf = data->isoc;
1714 int i;
1715
1716 BT_DBG("Looking for Alt no :%d", alt);
1717
1718 if (!intf)
1719 return NULL;
1720
1721 for (i = 0; i < intf->num_altsetting; i++) {
1722 if (intf->altsetting[i].desc.bAlternateSetting == alt)
1723 return &intf->altsetting[i];
1724 }
1725
1726 return NULL;
1727}
1728
1729static void btusb_work(struct work_struct *work)
1730{
1731 struct btusb_data *data = container_of(work, struct btusb_data, work);
1732 struct hci_dev *hdev = data->hdev;
1733 int new_alts = 0;
1734 int err;
1735
1736 if (data->sco_num > 0) {
1737 if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
1738 err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
1739 if (err < 0) {
1740 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1741 usb_kill_anchored_urbs(&data->isoc_anchor);
1742 return;
1743 }
1744
1745 set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
1746 }
1747
1748 if (data->air_mode == HCI_NOTIFY_ENABLE_SCO_CVSD) {
1749 if (hdev->voice_setting & 0x0020) {
1750 static const int alts[3] = { 2, 4, 5 };
1751
1752 new_alts = alts[data->sco_num - 1];
1753 } else {
1754 new_alts = data->sco_num;
1755 }
1756 } else if (data->air_mode == HCI_NOTIFY_ENABLE_SCO_TRANSP) {
1757
1758
1759
1760
1761
1762 new_alts = btusb_find_altsetting(data, 6) ? 6 : 1;
1763
1764
1765
1766
1767
1768 if (new_alts == 1 && btusb_find_altsetting(data, 3))
1769 new_alts = 3;
1770 }
1771
1772 if (btusb_switch_alt_setting(hdev, new_alts) < 0)
1773 bt_dev_err(hdev, "set USB alt:(%d) failed!", new_alts);
1774 } else {
1775 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1776 usb_kill_anchored_urbs(&data->isoc_anchor);
1777
1778 __set_isoc_interface(hdev, 0);
1779 if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
1780 usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
1781 }
1782}
1783
1784static void btusb_waker(struct work_struct *work)
1785{
1786 struct btusb_data *data = container_of(work, struct btusb_data, waker);
1787 int err;
1788
1789 err = usb_autopm_get_interface(data->intf);
1790 if (err < 0)
1791 return;
1792
1793 usb_autopm_put_interface(data->intf);
1794}
1795
1796static int btusb_setup_bcm92035(struct hci_dev *hdev)
1797{
1798 struct sk_buff *skb;
1799 u8 val = 0x00;
1800
1801 BT_DBG("%s", hdev->name);
1802
1803 skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);
1804 if (IS_ERR(skb))
1805 bt_dev_err(hdev, "BCM92035 command failed (%ld)", PTR_ERR(skb));
1806 else
1807 kfree_skb(skb);
1808
1809 return 0;
1810}
1811
1812static int btusb_setup_csr(struct hci_dev *hdev)
1813{
1814 struct btusb_data *data = hci_get_drvdata(hdev);
1815 u16 bcdDevice = le16_to_cpu(data->udev->descriptor.bcdDevice);
1816 struct hci_rp_read_local_version *rp;
1817 struct sk_buff *skb;
1818 bool is_fake = false;
1819 int ret;
1820
1821 BT_DBG("%s", hdev->name);
1822
1823 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1824 HCI_INIT_TIMEOUT);
1825 if (IS_ERR(skb)) {
1826 int err = PTR_ERR(skb);
1827 bt_dev_err(hdev, "CSR: Local version failed (%d)", err);
1828 return err;
1829 }
1830
1831 if (skb->len != sizeof(struct hci_rp_read_local_version)) {
1832 bt_dev_err(hdev, "CSR: Local version length mismatch");
1833 kfree_skb(skb);
1834 return -EIO;
1835 }
1836
1837 rp = (struct hci_rp_read_local_version *)skb->data;
1838
1839
1840
1841
1842
1843
1844
1845
1846
1847
1848
1849
1850
1851 if (le16_to_cpu(rp->manufacturer) != 10 ||
1852 le16_to_cpu(rp->hci_rev) != le16_to_cpu(rp->lmp_subver))
1853 is_fake = true;
1854
1855
1856
1857
1858
1859
1860
1861
1862
1863
1864
1865
1866 else if (le16_to_cpu(rp->lmp_subver) <= 0x034e &&
1867 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_1_1)
1868 is_fake = true;
1869
1870 else if (le16_to_cpu(rp->lmp_subver) <= 0x0529 &&
1871 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_1_2)
1872 is_fake = true;
1873
1874 else if (le16_to_cpu(rp->lmp_subver) <= 0x0c5c &&
1875 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_2_0)
1876 is_fake = true;
1877
1878 else if (le16_to_cpu(rp->lmp_subver) <= 0x1899 &&
1879 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_2_1)
1880 is_fake = true;
1881
1882 else if (le16_to_cpu(rp->lmp_subver) <= 0x22bb &&
1883 le16_to_cpu(rp->hci_ver) > BLUETOOTH_VER_4_0)
1884 is_fake = true;
1885
1886
1887 else if (bcdDevice == 0x0134 &&
1888 le16_to_cpu(rp->lmp_subver) == 0x0c5c &&
1889 le16_to_cpu(rp->hci_ver) == BLUETOOTH_VER_2_0)
1890 is_fake = true;
1891
1892 if (is_fake) {
1893 bt_dev_warn(hdev, "CSR: Unbranded CSR clone detected; adding workarounds...");
1894
1895
1896
1897
1898
1899
1900 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
1901 set_bit(HCI_QUIRK_BROKEN_ERR_DATA_REPORTING, &hdev->quirks);
1902
1903
1904
1905
1906 clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
1907 clear_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
1908
1909
1910
1911
1912
1913
1914
1915
1916
1917
1918
1919
1920
1921
1922
1923
1924 if (bcdDevice == 0x8891 &&
1925 le16_to_cpu(rp->lmp_subver) == 0x1012 &&
1926 le16_to_cpu(rp->hci_rev) == 0x0810 &&
1927 le16_to_cpu(rp->hci_ver) == BLUETOOTH_VER_4_0) {
1928 bt_dev_warn(hdev, "CSR: detected a fake CSR dongle using a Barrot 8041a02 chip, this chip is very buggy and may have issues");
1929
1930 pm_runtime_allow(&data->udev->dev);
1931
1932 ret = pm_runtime_suspend(&data->udev->dev);
1933 if (ret >= 0)
1934 msleep(200);
1935 else
1936 bt_dev_err(hdev, "Failed to suspend the device for Barrot 8041a02 receive-issue workaround");
1937
1938 pm_runtime_forbid(&data->udev->dev);
1939
1940 device_set_wakeup_capable(&data->udev->dev, false);
1941
1942 if (enable_autosuspend)
1943 usb_enable_autosuspend(data->udev);
1944 }
1945 }
1946
1947 kfree_skb(skb);
1948
1949 return 0;
1950}
1951
1952static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev,
1953 struct intel_version *ver)
1954{
1955 const struct firmware *fw;
1956 char fwname[64];
1957 int ret;
1958
1959 snprintf(fwname, sizeof(fwname),
1960 "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq",
1961 ver->hw_platform, ver->hw_variant, ver->hw_revision,
1962 ver->fw_variant, ver->fw_revision, ver->fw_build_num,
1963 ver->fw_build_ww, ver->fw_build_yy);
1964
1965 ret = request_firmware(&fw, fwname, &hdev->dev);
1966 if (ret < 0) {
1967 if (ret == -EINVAL) {
1968 bt_dev_err(hdev, "Intel firmware file request failed (%d)",
1969 ret);
1970 return NULL;
1971 }
1972
1973 bt_dev_err(hdev, "failed to open Intel firmware file: %s (%d)",
1974 fwname, ret);
1975
1976
1977
1978
1979 snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq",
1980 ver->hw_platform, ver->hw_variant);
1981 if (request_firmware(&fw, fwname, &hdev->dev) < 0) {
1982 bt_dev_err(hdev, "failed to open default fw file: %s",
1983 fwname);
1984 return NULL;
1985 }
1986 }
1987
1988 bt_dev_info(hdev, "Intel Bluetooth firmware file: %s", fwname);
1989
1990 return fw;
1991}
1992
1993static int btusb_setup_intel_patching(struct hci_dev *hdev,
1994 const struct firmware *fw,
1995 const u8 **fw_ptr, int *disable_patch)
1996{
1997 struct sk_buff *skb;
1998 struct hci_command_hdr *cmd;
1999 const u8 *cmd_param;
2000 struct hci_event_hdr *evt = NULL;
2001 const u8 *evt_param = NULL;
2002 int remain = fw->size - (*fw_ptr - fw->data);
2003
2004
2005
2006
2007
2008
2009
2010
2011 if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) {
2012 bt_dev_err(hdev, "Intel fw corrupted: invalid cmd read");
2013 return -EINVAL;
2014 }
2015 (*fw_ptr)++;
2016 remain--;
2017
2018 cmd = (struct hci_command_hdr *)(*fw_ptr);
2019 *fw_ptr += sizeof(*cmd);
2020 remain -= sizeof(*cmd);
2021
2022
2023
2024
2025 if (remain < cmd->plen) {
2026 bt_dev_err(hdev, "Intel fw corrupted: invalid cmd len");
2027 return -EFAULT;
2028 }
2029
2030
2031
2032
2033
2034
2035
2036 if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e)
2037 *disable_patch = 0;
2038
2039 cmd_param = *fw_ptr;
2040 *fw_ptr += cmd->plen;
2041 remain -= cmd->plen;
2042
2043
2044
2045
2046
2047
2048
2049
2050 while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) {
2051 (*fw_ptr)++;
2052 remain--;
2053
2054 evt = (struct hci_event_hdr *)(*fw_ptr);
2055 *fw_ptr += sizeof(*evt);
2056 remain -= sizeof(*evt);
2057
2058 if (remain < evt->plen) {
2059 bt_dev_err(hdev, "Intel fw corrupted: invalid evt len");
2060 return -EFAULT;
2061 }
2062
2063 evt_param = *fw_ptr;
2064 *fw_ptr += evt->plen;
2065 remain -= evt->plen;
2066 }
2067
2068
2069
2070
2071
2072 if (!evt || !evt_param || remain < 0) {
2073 bt_dev_err(hdev, "Intel fw corrupted: invalid evt read");
2074 return -EFAULT;
2075 }
2076
2077 skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen,
2078 cmd_param, evt->evt, HCI_INIT_TIMEOUT);
2079 if (IS_ERR(skb)) {
2080 bt_dev_err(hdev, "sending Intel patch command (0x%4.4x) failed (%ld)",
2081 cmd->opcode, PTR_ERR(skb));
2082 return PTR_ERR(skb);
2083 }
2084
2085
2086
2087
2088
2089 if (skb->len != evt->plen) {
2090 bt_dev_err(hdev, "mismatch event length (opcode 0x%4.4x)",
2091 le16_to_cpu(cmd->opcode));
2092 kfree_skb(skb);
2093 return -EFAULT;
2094 }
2095
2096 if (memcmp(skb->data, evt_param, evt->plen)) {
2097 bt_dev_err(hdev, "mismatch event parameter (opcode 0x%4.4x)",
2098 le16_to_cpu(cmd->opcode));
2099 kfree_skb(skb);
2100 return -EFAULT;
2101 }
2102 kfree_skb(skb);
2103
2104 return 0;
2105}
2106
2107static int btusb_setup_intel(struct hci_dev *hdev)
2108{
2109 struct sk_buff *skb;
2110 const struct firmware *fw;
2111 const u8 *fw_ptr;
2112 int disable_patch, err;
2113 struct intel_version ver;
2114
2115 BT_DBG("%s", hdev->name);
2116
2117
2118
2119
2120
2121
2122
2123
2124
2125 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
2126 if (IS_ERR(skb)) {
2127 bt_dev_err(hdev, "sending initial HCI reset command failed (%ld)",
2128 PTR_ERR(skb));
2129 return PTR_ERR(skb);
2130 }
2131 kfree_skb(skb);
2132
2133
2134
2135
2136
2137
2138
2139 err = btintel_read_version(hdev, &ver);
2140 if (err)
2141 return err;
2142
2143 bt_dev_info(hdev, "read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x",
2144 ver.hw_platform, ver.hw_variant, ver.hw_revision,
2145 ver.fw_variant, ver.fw_revision, ver.fw_build_num,
2146 ver.fw_build_ww, ver.fw_build_yy, ver.fw_patch_num);
2147
2148
2149
2150
2151
2152 if (ver.fw_patch_num) {
2153 bt_dev_info(hdev, "Intel device is already patched. "
2154 "patch num: %02x", ver.fw_patch_num);
2155 goto complete;
2156 }
2157
2158
2159
2160
2161
2162
2163
2164 fw = btusb_setup_intel_get_fw(hdev, &ver);
2165 if (!fw)
2166 goto complete;
2167 fw_ptr = fw->data;
2168
2169
2170
2171
2172
2173 err = btintel_enter_mfg(hdev);
2174 if (err) {
2175 release_firmware(fw);
2176 return err;
2177 }
2178
2179 disable_patch = 1;
2180
2181
2182
2183
2184
2185
2186
2187
2188
2189
2190
2191
2192
2193
2194
2195
2196
2197
2198
2199
2200
2201 while (fw->size > fw_ptr - fw->data) {
2202 int ret;
2203
2204 ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr,
2205 &disable_patch);
2206 if (ret < 0)
2207 goto exit_mfg_deactivate;
2208 }
2209
2210 release_firmware(fw);
2211
2212 if (disable_patch)
2213 goto exit_mfg_disable;
2214
2215
2216
2217
2218 err = btintel_exit_mfg(hdev, true, true);
2219 if (err)
2220 return err;
2221
2222
2223
2224
2225 err = btintel_read_version(hdev, &ver);
2226 if (err)
2227 return err;
2228 bt_dev_info(hdev, "Intel BT fw patch 0x%02x completed & activated",
2229 ver.fw_patch_num);
2230
2231 goto complete;
2232
2233exit_mfg_disable:
2234
2235 err = btintel_exit_mfg(hdev, false, false);
2236 if (err)
2237 return err;
2238
2239 bt_dev_info(hdev, "Intel firmware patch completed");
2240
2241 goto complete;
2242
2243exit_mfg_deactivate:
2244 release_firmware(fw);
2245
2246
2247
2248
2249 err = btintel_exit_mfg(hdev, true, false);
2250 if (err)
2251 return err;
2252
2253 bt_dev_info(hdev, "Intel firmware patch completed and deactivated");
2254
2255complete:
2256
2257
2258
2259 btintel_set_event_mask_mfg(hdev, false);
2260
2261 btintel_check_bdaddr(hdev);
2262 return 0;
2263}
2264
2265static int inject_cmd_complete(struct hci_dev *hdev, __u16 opcode)
2266{
2267 struct sk_buff *skb;
2268 struct hci_event_hdr *hdr;
2269 struct hci_ev_cmd_complete *evt;
2270
2271 skb = bt_skb_alloc(sizeof(*hdr) + sizeof(*evt) + 1, GFP_KERNEL);
2272 if (!skb)
2273 return -ENOMEM;
2274
2275 hdr = skb_put(skb, sizeof(*hdr));
2276 hdr->evt = HCI_EV_CMD_COMPLETE;
2277 hdr->plen = sizeof(*evt) + 1;
2278
2279 evt = skb_put(skb, sizeof(*evt));
2280 evt->ncmd = 0x01;
2281 evt->opcode = cpu_to_le16(opcode);
2282
2283 skb_put_u8(skb, 0x00);
2284
2285 hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
2286
2287 return hci_recv_frame(hdev, skb);
2288}
2289
2290static int btusb_recv_bulk_intel(struct btusb_data *data, void *buffer,
2291 int count)
2292{
2293
2294
2295
2296
2297 if (test_bit(BTUSB_BOOTLOADER, &data->flags))
2298 return btusb_recv_intr(data, buffer, count);
2299
2300 return btusb_recv_bulk(data, buffer, count);
2301}
2302
2303static void btusb_intel_bootup(struct btusb_data *data, const void *ptr,
2304 unsigned int len)
2305{
2306 const struct intel_bootup *evt = ptr;
2307
2308 if (len != sizeof(*evt))
2309 return;
2310
2311 if (test_and_clear_bit(BTUSB_BOOTING, &data->flags))
2312 wake_up_bit(&data->flags, BTUSB_BOOTING);
2313}
2314
2315static void btusb_intel_secure_send_result(struct btusb_data *data,
2316 const void *ptr, unsigned int len)
2317{
2318 const struct intel_secure_send_result *evt = ptr;
2319
2320 if (len != sizeof(*evt))
2321 return;
2322
2323 if (evt->result)
2324 set_bit(BTUSB_FIRMWARE_FAILED, &data->flags);
2325
2326 if (test_and_clear_bit(BTUSB_DOWNLOADING, &data->flags) &&
2327 test_bit(BTUSB_FIRMWARE_LOADED, &data->flags))
2328 wake_up_bit(&data->flags, BTUSB_DOWNLOADING);
2329}
2330
2331static int btusb_recv_event_intel(struct hci_dev *hdev, struct sk_buff *skb)
2332{
2333 struct btusb_data *data = hci_get_drvdata(hdev);
2334
2335 if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2336 struct hci_event_hdr *hdr = (void *)skb->data;
2337
2338 if (skb->len > HCI_EVENT_HDR_SIZE && hdr->evt == 0xff &&
2339 hdr->plen > 0) {
2340 const void *ptr = skb->data + HCI_EVENT_HDR_SIZE + 1;
2341 unsigned int len = skb->len - HCI_EVENT_HDR_SIZE - 1;
2342
2343 switch (skb->data[2]) {
2344 case 0x02:
2345
2346
2347
2348
2349 btusb_intel_bootup(data, ptr, len);
2350 break;
2351 case 0x06:
2352
2353
2354
2355
2356
2357 btusb_intel_secure_send_result(data, ptr, len);
2358 break;
2359 }
2360 }
2361 }
2362
2363 return hci_recv_frame(hdev, skb);
2364}
2365
2366static int btusb_send_frame_intel(struct hci_dev *hdev, struct sk_buff *skb)
2367{
2368 struct btusb_data *data = hci_get_drvdata(hdev);
2369 struct urb *urb;
2370
2371 BT_DBG("%s", hdev->name);
2372
2373 switch (hci_skb_pkt_type(skb)) {
2374 case HCI_COMMAND_PKT:
2375 if (test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2376 struct hci_command_hdr *cmd = (void *)skb->data;
2377 __u16 opcode = le16_to_cpu(cmd->opcode);
2378
2379
2380
2381
2382
2383 if (opcode == 0xfc09)
2384 urb = alloc_bulk_urb(hdev, skb);
2385 else
2386 urb = alloc_ctrl_urb(hdev, skb);
2387
2388
2389
2390
2391
2392
2393 if (opcode == 0xfc01)
2394 inject_cmd_complete(hdev, opcode);
2395 } else {
2396 urb = alloc_ctrl_urb(hdev, skb);
2397 }
2398 if (IS_ERR(urb))
2399 return PTR_ERR(urb);
2400
2401 hdev->stat.cmd_tx++;
2402 return submit_or_queue_tx_urb(hdev, urb);
2403
2404 case HCI_ACLDATA_PKT:
2405 urb = alloc_bulk_urb(hdev, skb);
2406 if (IS_ERR(urb))
2407 return PTR_ERR(urb);
2408
2409 hdev->stat.acl_tx++;
2410 return submit_or_queue_tx_urb(hdev, urb);
2411
2412 case HCI_SCODATA_PKT:
2413 if (hci_conn_num(hdev, SCO_LINK) < 1)
2414 return -ENODEV;
2415
2416 urb = alloc_isoc_urb(hdev, skb);
2417 if (IS_ERR(urb))
2418 return PTR_ERR(urb);
2419
2420 hdev->stat.sco_tx++;
2421 return submit_tx_urb(hdev, urb);
2422 }
2423
2424 return -EILSEQ;
2425}
2426
2427static int btusb_setup_intel_new_get_fw_name(struct intel_version *ver,
2428 struct intel_boot_params *params,
2429 char *fw_name, size_t len,
2430 const char *suffix)
2431{
2432 switch (ver->hw_variant) {
2433 case 0x0b:
2434 case 0x0c:
2435 snprintf(fw_name, len, "intel/ibt-%u-%u.%s",
2436 le16_to_cpu(ver->hw_variant),
2437 le16_to_cpu(params->dev_revid),
2438 suffix);
2439 break;
2440 case 0x11:
2441 case 0x12:
2442 case 0x13:
2443 case 0x14:
2444 snprintf(fw_name, len, "intel/ibt-%u-%u-%u.%s",
2445 le16_to_cpu(ver->hw_variant),
2446 le16_to_cpu(ver->hw_revision),
2447 le16_to_cpu(ver->fw_revision),
2448 suffix);
2449 break;
2450 default:
2451 return -EINVAL;
2452 }
2453
2454 return 0;
2455}
2456
2457static void btusb_setup_intel_newgen_get_fw_name(const struct intel_version_tlv *ver_tlv,
2458 char *fw_name, size_t len,
2459 const char *suffix)
2460{
2461
2462
2463
2464 snprintf(fw_name, len, "intel/ibt-%04x-%04x.%s",
2465 INTEL_CNVX_TOP_PACK_SWAB(INTEL_CNVX_TOP_TYPE(ver_tlv->cnvi_top),
2466 INTEL_CNVX_TOP_STEP(ver_tlv->cnvi_top)),
2467 INTEL_CNVX_TOP_PACK_SWAB(INTEL_CNVX_TOP_TYPE(ver_tlv->cnvr_top),
2468 INTEL_CNVX_TOP_STEP(ver_tlv->cnvr_top)),
2469 suffix);
2470}
2471
2472static int btusb_download_wait(struct hci_dev *hdev, ktime_t calltime, int msec)
2473{
2474 struct btusb_data *data = hci_get_drvdata(hdev);
2475 ktime_t delta, rettime;
2476 unsigned long long duration;
2477 int err;
2478
2479 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2480
2481 bt_dev_info(hdev, "Waiting for firmware download to complete");
2482
2483 err = wait_on_bit_timeout(&data->flags, BTUSB_DOWNLOADING,
2484 TASK_INTERRUPTIBLE,
2485 msecs_to_jiffies(msec));
2486 if (err == -EINTR) {
2487 bt_dev_err(hdev, "Firmware loading interrupted");
2488 return err;
2489 }
2490
2491 if (err) {
2492 bt_dev_err(hdev, "Firmware loading timeout");
2493 return -ETIMEDOUT;
2494 }
2495
2496 if (test_bit(BTUSB_FIRMWARE_FAILED, &data->flags)) {
2497 bt_dev_err(hdev, "Firmware loading failed");
2498 return -ENOEXEC;
2499 }
2500
2501 rettime = ktime_get();
2502 delta = ktime_sub(rettime, calltime);
2503 duration = (unsigned long long)ktime_to_ns(delta) >> 10;
2504
2505 bt_dev_info(hdev, "Firmware loaded in %llu usecs", duration);
2506
2507 return 0;
2508}
2509
2510static int btusb_intel_download_firmware_newgen(struct hci_dev *hdev,
2511 struct intel_version_tlv *ver,
2512 u32 *boot_param)
2513{
2514 const struct firmware *fw;
2515 char fwname[64];
2516 int err;
2517 struct btusb_data *data = hci_get_drvdata(hdev);
2518 ktime_t calltime;
2519
2520 if (!ver || !boot_param)
2521 return -EINVAL;
2522
2523
2524
2525
2526
2527
2528
2529
2530
2531
2532
2533
2534
2535
2536 if (ver->img_type == 0x03) {
2537 clear_bit(BTUSB_BOOTLOADER, &data->flags);
2538 btintel_check_bdaddr(hdev);
2539 }
2540
2541
2542
2543
2544 if (!bacmp(&ver->otp_bd_addr, BDADDR_ANY)) {
2545 bt_dev_info(hdev, "No device address configured");
2546 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
2547 }
2548
2549 btusb_setup_intel_newgen_get_fw_name(ver, fwname, sizeof(fwname), "sfi");
2550 err = firmware_request_nowarn(&fw, fwname, &hdev->dev);
2551 if (err < 0) {
2552 if (!test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2553
2554 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2555 return 0;
2556 }
2557
2558 bt_dev_err(hdev, "Failed to load Intel firmware file %s (%d)",
2559 fwname, err);
2560
2561 return err;
2562 }
2563
2564 bt_dev_info(hdev, "Found device firmware: %s", fwname);
2565
2566 if (fw->size < 644) {
2567 bt_dev_err(hdev, "Invalid size of firmware file (%zu)",
2568 fw->size);
2569 err = -EBADF;
2570 goto done;
2571 }
2572
2573 calltime = ktime_get();
2574
2575 set_bit(BTUSB_DOWNLOADING, &data->flags);
2576
2577
2578 err = btintel_download_firmware_newgen(hdev, ver, fw, boot_param,
2579 INTEL_HW_VARIANT(ver->cnvi_bt),
2580 ver->sbe_type);
2581 if (err < 0) {
2582 if (err == -EALREADY) {
2583
2584 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2585 err = 0;
2586 goto done;
2587 }
2588
2589
2590
2591
2592 btintel_reset_to_bootloader(hdev);
2593 goto done;
2594 }
2595
2596
2597
2598
2599
2600
2601
2602
2603
2604
2605
2606
2607 err = btusb_download_wait(hdev, calltime, 5000);
2608 if (err == -ETIMEDOUT)
2609 btintel_reset_to_bootloader(hdev);
2610
2611done:
2612 release_firmware(fw);
2613 return err;
2614}
2615
2616static int btusb_intel_download_firmware(struct hci_dev *hdev,
2617 struct intel_version *ver,
2618 struct intel_boot_params *params,
2619 u32 *boot_param)
2620{
2621 const struct firmware *fw;
2622 char fwname[64];
2623 int err;
2624 struct btusb_data *data = hci_get_drvdata(hdev);
2625 ktime_t calltime;
2626
2627 if (!ver || !params)
2628 return -EINVAL;
2629
2630
2631
2632
2633
2634
2635
2636
2637
2638
2639
2640
2641
2642
2643 if (ver->fw_variant == 0x23) {
2644 clear_bit(BTUSB_BOOTLOADER, &data->flags);
2645 btintel_check_bdaddr(hdev);
2646
2647
2648
2649
2650 switch (ver->hw_variant) {
2651 case 0x0b:
2652 case 0x0c:
2653 return 0;
2654 }
2655
2656
2657 goto download;
2658 }
2659
2660
2661
2662
2663 err = btintel_read_boot_params(hdev, params);
2664 if (err)
2665 return err;
2666
2667
2668
2669
2670
2671 if (params->limited_cce != 0x00) {
2672 bt_dev_err(hdev, "Unsupported Intel firmware loading method (%u)",
2673 params->limited_cce);
2674 return -EINVAL;
2675 }
2676
2677
2678
2679
2680 if (!bacmp(¶ms->otp_bdaddr, BDADDR_ANY)) {
2681 bt_dev_info(hdev, "No device address configured");
2682 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
2683 }
2684
2685download:
2686
2687
2688
2689
2690
2691
2692
2693
2694
2695
2696
2697
2698
2699
2700
2701
2702
2703
2704
2705
2706
2707 err = btusb_setup_intel_new_get_fw_name(ver, params, fwname,
2708 sizeof(fwname), "sfi");
2709 if (err < 0) {
2710 if (!test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2711
2712 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2713 return 0;
2714 }
2715
2716 bt_dev_err(hdev, "Unsupported Intel firmware naming");
2717 return -EINVAL;
2718 }
2719
2720 err = firmware_request_nowarn(&fw, fwname, &hdev->dev);
2721 if (err < 0) {
2722 if (!test_bit(BTUSB_BOOTLOADER, &data->flags)) {
2723
2724 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2725 return 0;
2726 }
2727
2728 bt_dev_err(hdev, "Failed to load Intel firmware file %s (%d)",
2729 fwname, err);
2730 return err;
2731 }
2732
2733 bt_dev_info(hdev, "Found device firmware: %s", fwname);
2734
2735 if (fw->size < 644) {
2736 bt_dev_err(hdev, "Invalid size of firmware file (%zu)",
2737 fw->size);
2738 err = -EBADF;
2739 goto done;
2740 }
2741
2742 calltime = ktime_get();
2743
2744 set_bit(BTUSB_DOWNLOADING, &data->flags);
2745
2746
2747 err = btintel_download_firmware(hdev, ver, fw, boot_param);
2748 if (err < 0) {
2749 if (err == -EALREADY) {
2750
2751 set_bit(BTUSB_FIRMWARE_LOADED, &data->flags);
2752 err = 0;
2753 goto done;
2754 }
2755
2756
2757
2758
2759 btintel_reset_to_bootloader(hdev);
2760 goto done;
2761 }
2762
2763
2764
2765
2766
2767
2768
2769
2770
2771
2772
2773
2774 err = btusb_download_wait(hdev, calltime, 5000);
2775 if (err == -ETIMEDOUT)
2776 btintel_reset_to_bootloader(hdev);
2777
2778done:
2779 release_firmware(fw);
2780 return err;
2781}
2782
2783static int btusb_boot_wait(struct hci_dev *hdev, ktime_t calltime, int msec)
2784{
2785 struct btusb_data *data = hci_get_drvdata(hdev);
2786 ktime_t delta, rettime;
2787 unsigned long long duration;
2788 int err;
2789
2790 bt_dev_info(hdev, "Waiting for device to boot");
2791
2792 err = wait_on_bit_timeout(&data->flags, BTUSB_BOOTING,
2793 TASK_INTERRUPTIBLE,
2794 msecs_to_jiffies(msec));
2795 if (err == -EINTR) {
2796 bt_dev_err(hdev, "Device boot interrupted");
2797 return -EINTR;
2798 }
2799
2800 if (err) {
2801 bt_dev_err(hdev, "Device boot timeout");
2802 return -ETIMEDOUT;
2803 }
2804
2805 rettime = ktime_get();
2806 delta = ktime_sub(rettime, calltime);
2807 duration = (unsigned long long) ktime_to_ns(delta) >> 10;
2808
2809 bt_dev_info(hdev, "Device booted in %llu usecs", duration);
2810
2811 return 0;
2812}
2813
2814static int btusb_intel_boot(struct hci_dev *hdev, u32 boot_addr)
2815{
2816 struct btusb_data *data = hci_get_drvdata(hdev);
2817 ktime_t calltime;
2818 int err;
2819
2820 calltime = ktime_get();
2821
2822 set_bit(BTUSB_BOOTING, &data->flags);
2823
2824 err = btintel_send_intel_reset(hdev, boot_addr);
2825 if (err) {
2826 bt_dev_err(hdev, "Intel Soft Reset failed (%d)", err);
2827 btintel_reset_to_bootloader(hdev);
2828 return err;
2829 }
2830
2831
2832
2833
2834
2835
2836
2837
2838 err = btusb_boot_wait(hdev, calltime, 1000);
2839 if (err == -ETIMEDOUT)
2840 btintel_reset_to_bootloader(hdev);
2841
2842 return err;
2843}
2844
2845static int btusb_setup_intel_new(struct hci_dev *hdev)
2846{
2847 struct btusb_data *data = hci_get_drvdata(hdev);
2848 struct intel_version ver;
2849 struct intel_boot_params params;
2850 u32 boot_param;
2851 char ddcname[64];
2852 int err;
2853 struct intel_debug_features features;
2854
2855 BT_DBG("%s", hdev->name);
2856
2857
2858
2859
2860
2861 boot_param = 0x00000000;
2862
2863
2864
2865
2866
2867 err = btintel_read_version(hdev, &ver);
2868 if (err) {
2869 bt_dev_err(hdev, "Intel Read version failed (%d)", err);
2870 btintel_reset_to_bootloader(hdev);
2871 return err;
2872 }
2873
2874 err = btintel_version_info(hdev, &ver);
2875 if (err)
2876 return err;
2877
2878 err = btusb_intel_download_firmware(hdev, &ver, ¶ms, &boot_param);
2879 if (err)
2880 return err;
2881
2882
2883 if (ver.fw_variant == 0x23)
2884 goto finish;
2885
2886 err = btusb_intel_boot(hdev, boot_param);
2887 if (err)
2888 return err;
2889
2890 clear_bit(BTUSB_BOOTLOADER, &data->flags);
2891
2892 err = btusb_setup_intel_new_get_fw_name(&ver, ¶ms, ddcname,
2893 sizeof(ddcname), "ddc");
2894
2895 if (err < 0) {
2896 bt_dev_err(hdev, "Unsupported Intel firmware naming");
2897 } else {
2898
2899
2900
2901
2902
2903
2904 btintel_load_ddc_config(hdev, ddcname);
2905 }
2906
2907
2908
2909
2910 btintel_read_debug_features(hdev, &features);
2911
2912
2913 btintel_set_debug_features(hdev, &features);
2914
2915
2916 err = btintel_read_version(hdev, &ver);
2917 if (err)
2918 return err;
2919
2920 btintel_version_info(hdev, &ver);
2921
2922finish:
2923
2924
2925
2926 switch (ver.hw_variant) {
2927 case 0x11:
2928 case 0x12:
2929 case 0x13:
2930 case 0x14:
2931 hci_set_msft_opcode(hdev, 0xFC1E);
2932 break;
2933 }
2934
2935
2936
2937
2938
2939
2940
2941
2942 btintel_set_event_mask(hdev, false);
2943
2944 return 0;
2945}
2946
2947static int btusb_setup_intel_newgen(struct hci_dev *hdev)
2948{
2949 struct btusb_data *data = hci_get_drvdata(hdev);
2950 u32 boot_param;
2951 char ddcname[64];
2952 int err;
2953 struct intel_debug_features features;
2954 struct intel_version_tlv version;
2955
2956 bt_dev_dbg(hdev, "");
2957
2958
2959
2960
2961
2962 boot_param = 0x00000000;
2963
2964
2965
2966
2967
2968 err = btintel_read_version_tlv(hdev, &version);
2969 if (err) {
2970 bt_dev_err(hdev, "Intel Read version failed (%d)", err);
2971 btintel_reset_to_bootloader(hdev);
2972 return err;
2973 }
2974
2975 err = btintel_version_info_tlv(hdev, &version);
2976 if (err)
2977 return err;
2978
2979 err = btusb_intel_download_firmware_newgen(hdev, &version, &boot_param);
2980 if (err)
2981 return err;
2982
2983
2984 if (version.img_type == 0x03)
2985 goto finish;
2986
2987 err = btusb_intel_boot(hdev, boot_param);
2988 if (err)
2989 return err;
2990
2991 clear_bit(BTUSB_BOOTLOADER, &data->flags);
2992
2993 btusb_setup_intel_newgen_get_fw_name(&version, ddcname, sizeof(ddcname),
2994 "ddc");
2995
2996
2997
2998
2999
3000
3001 btintel_load_ddc_config(hdev, ddcname);
3002
3003
3004
3005
3006 btintel_read_debug_features(hdev, &features);
3007
3008
3009 btintel_set_debug_features(hdev, &features);
3010
3011
3012 err = btintel_read_version_tlv(hdev, &version);
3013 if (err)
3014 return err;
3015
3016 btintel_version_info_tlv(hdev, &version);
3017
3018finish:
3019
3020
3021
3022
3023
3024
3025
3026 btintel_set_event_mask(hdev, false);
3027
3028 return 0;
3029}
3030static int btusb_shutdown_intel(struct hci_dev *hdev)
3031{
3032 struct sk_buff *skb;
3033 long ret;
3034
3035
3036
3037
3038
3039
3040
3041
3042
3043 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
3044 if (IS_ERR(skb)) {
3045 ret = PTR_ERR(skb);
3046 bt_dev_err(hdev, "HCI reset during shutdown failed");
3047 return ret;
3048 }
3049 kfree_skb(skb);
3050
3051
3052
3053
3054
3055 skb = __hci_cmd_sync(hdev, 0xfc3f, 0, NULL, HCI_INIT_TIMEOUT);
3056 if (IS_ERR(skb)) {
3057 ret = PTR_ERR(skb);
3058 bt_dev_err(hdev, "turning off Intel device LED failed");
3059 return ret;
3060 }
3061 kfree_skb(skb);
3062
3063 return 0;
3064}
3065
3066static int btusb_shutdown_intel_new(struct hci_dev *hdev)
3067{
3068 struct sk_buff *skb;
3069
3070
3071
3072
3073
3074 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
3075 if (IS_ERR(skb)) {
3076 bt_dev_err(hdev, "HCI reset during shutdown failed");
3077 return PTR_ERR(skb);
3078 }
3079 kfree_skb(skb);
3080
3081 return 0;
3082}
3083
3084#define FIRMWARE_MT7663 "mediatek/mt7663pr2h.bin"
3085#define FIRMWARE_MT7668 "mediatek/mt7668pr2h.bin"
3086
3087#define HCI_WMT_MAX_EVENT_SIZE 64
3088
3089#define MTK_FW_ROM_PATCH_HEADER_SIZE 32
3090#define MTK_FW_ROM_PATCH_GD_SIZE 64
3091#define MTK_FW_ROM_PATCH_SEC_MAP_SIZE 64
3092#define MTK_SEC_MAP_COMMON_SIZE 12
3093#define MTK_SEC_MAP_NEED_SEND_SIZE 52
3094
3095enum {
3096 BTMTK_WMT_PATCH_DWNLD = 0x1,
3097 BTMTK_WMT_FUNC_CTRL = 0x6,
3098 BTMTK_WMT_RST = 0x7,
3099 BTMTK_WMT_SEMAPHORE = 0x17,
3100};
3101
3102enum {
3103 BTMTK_WMT_INVALID,
3104 BTMTK_WMT_PATCH_UNDONE,
3105 BTMTK_WMT_PATCH_PROGRESS,
3106 BTMTK_WMT_PATCH_DONE,
3107 BTMTK_WMT_ON_UNDONE,
3108 BTMTK_WMT_ON_DONE,
3109 BTMTK_WMT_ON_PROGRESS,
3110};
3111
3112struct btmtk_wmt_hdr {
3113 u8 dir;
3114 u8 op;
3115 __le16 dlen;
3116 u8 flag;
3117} __packed;
3118
3119struct btmtk_hci_wmt_cmd {
3120 struct btmtk_wmt_hdr hdr;
3121 u8 data[];
3122} __packed;
3123
3124struct btmtk_hci_wmt_evt {
3125 struct hci_event_hdr hhdr;
3126 struct btmtk_wmt_hdr whdr;
3127} __packed;
3128
3129struct btmtk_hci_wmt_evt_funcc {
3130 struct btmtk_hci_wmt_evt hwhdr;
3131 __be16 status;
3132} __packed;
3133
3134struct btmtk_tci_sleep {
3135 u8 mode;
3136 __le16 duration;
3137 __le16 host_duration;
3138 u8 host_wakeup_pin;
3139 u8 time_compensation;
3140} __packed;
3141
3142struct btmtk_hci_wmt_params {
3143 u8 op;
3144 u8 flag;
3145 u16 dlen;
3146 const void *data;
3147 u32 *status;
3148};
3149
3150struct btmtk_patch_header {
3151 u8 datetime[16];
3152 u8 platform[4];
3153 __le16 hwver;
3154 __le16 swver;
3155 __le32 magicnum;
3156} __packed;
3157
3158struct btmtk_global_desc {
3159 __le32 patch_ver;
3160 __le32 sub_sys;
3161 __le32 feature_opt;
3162 __le32 section_num;
3163} __packed;
3164
3165struct btmtk_section_map {
3166 __le32 sectype;
3167 __le32 secoffset;
3168 __le32 secsize;
3169 union {
3170 __le32 u4SecSpec[13];
3171 struct {
3172 __le32 dlAddr;
3173 __le32 dlsize;
3174 __le32 seckeyidx;
3175 __le32 alignlen;
3176 __le32 sectype;
3177 __le32 dlmodecrctype;
3178 __le32 crc;
3179 __le32 reserved[6];
3180 } bin_info_spec;
3181 };
3182} __packed;
3183
3184static void btusb_mtk_wmt_recv(struct urb *urb)
3185{
3186 struct hci_dev *hdev = urb->context;
3187 struct btusb_data *data = hci_get_drvdata(hdev);
3188 struct hci_event_hdr *hdr;
3189 struct sk_buff *skb;
3190 int err;
3191
3192 if (urb->status == 0 && urb->actual_length > 0) {
3193 hdev->stat.byte_rx += urb->actual_length;
3194
3195
3196
3197
3198 skb = bt_skb_alloc(HCI_WMT_MAX_EVENT_SIZE, GFP_ATOMIC);
3199 if (!skb) {
3200 hdev->stat.err_rx++;
3201 return;
3202 }
3203
3204 hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
3205 skb_put_data(skb, urb->transfer_buffer, urb->actual_length);
3206
3207 hdr = (void *)skb->data;
3208
3209
3210
3211
3212 hdr->evt = 0xff;
3213
3214
3215
3216
3217 if (test_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags)) {
3218 data->evt_skb = skb_clone(skb, GFP_ATOMIC);
3219 if (!data->evt_skb) {
3220 kfree_skb(skb);
3221 return;
3222 }
3223 }
3224
3225 err = hci_recv_frame(hdev, skb);
3226 if (err < 0) {
3227 kfree_skb(data->evt_skb);
3228 data->evt_skb = NULL;
3229 return;
3230 }
3231
3232 if (test_and_clear_bit(BTUSB_TX_WAIT_VND_EVT,
3233 &data->flags)) {
3234
3235 smp_mb__after_atomic();
3236 wake_up_bit(&data->flags,
3237 BTUSB_TX_WAIT_VND_EVT);
3238 }
3239 return;
3240 } else if (urb->status == -ENOENT) {
3241
3242 return;
3243 }
3244
3245 usb_mark_last_busy(data->udev);
3246
3247
3248
3249
3250
3251
3252
3253
3254 udelay(500);
3255
3256 usb_anchor_urb(urb, &data->ctrl_anchor);
3257 err = usb_submit_urb(urb, GFP_ATOMIC);
3258 if (err < 0) {
3259
3260
3261
3262 if (err != -EPERM && err != -ENODEV)
3263 bt_dev_err(hdev, "urb %p failed to resubmit (%d)",
3264 urb, -err);
3265 usb_unanchor_urb(urb);
3266 }
3267}
3268
3269static int btusb_mtk_submit_wmt_recv_urb(struct hci_dev *hdev)
3270{
3271 struct btusb_data *data = hci_get_drvdata(hdev);
3272 struct usb_ctrlrequest *dr;
3273 unsigned char *buf;
3274 int err, size = 64;
3275 unsigned int pipe;
3276 struct urb *urb;
3277
3278 urb = usb_alloc_urb(0, GFP_KERNEL);
3279 if (!urb)
3280 return -ENOMEM;
3281
3282 dr = kmalloc(sizeof(*dr), GFP_KERNEL);
3283 if (!dr) {
3284 usb_free_urb(urb);
3285 return -ENOMEM;
3286 }
3287
3288 dr->bRequestType = USB_TYPE_VENDOR | USB_DIR_IN;
3289 dr->bRequest = 1;
3290 dr->wIndex = cpu_to_le16(0);
3291 dr->wValue = cpu_to_le16(48);
3292 dr->wLength = cpu_to_le16(size);
3293
3294 buf = kmalloc(size, GFP_KERNEL);
3295 if (!buf) {
3296 kfree(dr);
3297 usb_free_urb(urb);
3298 return -ENOMEM;
3299 }
3300
3301 pipe = usb_rcvctrlpipe(data->udev, 0);
3302
3303 usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
3304 buf, size, btusb_mtk_wmt_recv, hdev);
3305
3306 urb->transfer_flags |= URB_FREE_BUFFER;
3307
3308 usb_anchor_urb(urb, &data->ctrl_anchor);
3309 err = usb_submit_urb(urb, GFP_KERNEL);
3310 if (err < 0) {
3311 if (err != -EPERM && err != -ENODEV)
3312 bt_dev_err(hdev, "urb %p submission failed (%d)",
3313 urb, -err);
3314 usb_unanchor_urb(urb);
3315 }
3316
3317 usb_free_urb(urb);
3318
3319 return err;
3320}
3321
3322static int btusb_mtk_hci_wmt_sync(struct hci_dev *hdev,
3323 struct btmtk_hci_wmt_params *wmt_params)
3324{
3325 struct btusb_data *data = hci_get_drvdata(hdev);
3326 struct btmtk_hci_wmt_evt_funcc *wmt_evt_funcc;
3327 u32 hlen, status = BTMTK_WMT_INVALID;
3328 struct btmtk_hci_wmt_evt *wmt_evt;
3329 struct btmtk_hci_wmt_cmd *wc;
3330 struct btmtk_wmt_hdr *hdr;
3331 int err;
3332
3333
3334 hlen = sizeof(*hdr) + wmt_params->dlen;
3335 if (hlen > 255)
3336 return -EINVAL;
3337
3338 wc = kzalloc(hlen, GFP_KERNEL);
3339 if (!wc)
3340 return -ENOMEM;
3341
3342 hdr = &wc->hdr;
3343 hdr->dir = 1;
3344 hdr->op = wmt_params->op;
3345 hdr->dlen = cpu_to_le16(wmt_params->dlen + 1);
3346 hdr->flag = wmt_params->flag;
3347 memcpy(wc->data, wmt_params->data, wmt_params->dlen);
3348
3349 set_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
3350
3351 err = __hci_cmd_send(hdev, 0xfc6f, hlen, wc);
3352
3353 if (err < 0) {
3354 clear_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
3355 goto err_free_wc;
3356 }
3357
3358
3359 err = btusb_mtk_submit_wmt_recv_urb(hdev);
3360 if (err < 0)
3361 goto err_free_wc;
3362
3363
3364
3365
3366
3367
3368
3369
3370
3371
3372 err = wait_on_bit_timeout(&data->flags, BTUSB_TX_WAIT_VND_EVT,
3373 TASK_INTERRUPTIBLE, HCI_INIT_TIMEOUT);
3374 if (err == -EINTR) {
3375 bt_dev_err(hdev, "Execution of wmt command interrupted");
3376 clear_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
3377 goto err_free_wc;
3378 }
3379
3380 if (err) {
3381 bt_dev_err(hdev, "Execution of wmt command timed out");
3382 clear_bit(BTUSB_TX_WAIT_VND_EVT, &data->flags);
3383 err = -ETIMEDOUT;
3384 goto err_free_wc;
3385 }
3386
3387
3388 wmt_evt = (struct btmtk_hci_wmt_evt *)data->evt_skb->data;
3389 if (wmt_evt->whdr.op != hdr->op) {
3390 bt_dev_err(hdev, "Wrong op received %d expected %d",
3391 wmt_evt->whdr.op, hdr->op);
3392 err = -EIO;
3393 goto err_free_skb;
3394 }
3395
3396 switch (wmt_evt->whdr.op) {
3397 case BTMTK_WMT_SEMAPHORE:
3398 if (wmt_evt->whdr.flag == 2)
3399 status = BTMTK_WMT_PATCH_UNDONE;
3400 else
3401 status = BTMTK_WMT_PATCH_DONE;
3402 break;
3403 case BTMTK_WMT_FUNC_CTRL:
3404 wmt_evt_funcc = (struct btmtk_hci_wmt_evt_funcc *)wmt_evt;
3405 if (be16_to_cpu(wmt_evt_funcc->status) == 0x404)
3406 status = BTMTK_WMT_ON_DONE;
3407 else if (be16_to_cpu(wmt_evt_funcc->status) == 0x420)
3408 status = BTMTK_WMT_ON_PROGRESS;
3409 else
3410 status = BTMTK_WMT_ON_UNDONE;
3411 break;
3412 case BTMTK_WMT_PATCH_DWNLD:
3413 if (wmt_evt->whdr.flag == 2)
3414 status = BTMTK_WMT_PATCH_DONE;
3415 else if (wmt_evt->whdr.flag == 1)
3416 status = BTMTK_WMT_PATCH_PROGRESS;
3417 else
3418 status = BTMTK_WMT_PATCH_UNDONE;
3419 break;
3420 }
3421
3422 if (wmt_params->status)
3423 *wmt_params->status = status;
3424
3425err_free_skb:
3426 kfree_skb(data->evt_skb);
3427 data->evt_skb = NULL;
3428err_free_wc:
3429 kfree(wc);
3430 return err;
3431}
3432
3433static int btusb_mtk_setup_firmware_79xx(struct hci_dev *hdev, const char *fwname)
3434{
3435 struct btmtk_hci_wmt_params wmt_params;
3436 struct btmtk_global_desc *globaldesc = NULL;
3437 struct btmtk_section_map *sectionmap;
3438 const struct firmware *fw;
3439 const u8 *fw_ptr;
3440 const u8 *fw_bin_ptr;
3441 int err, dlen, i, status;
3442 u8 flag, first_block, retry;
3443 u32 section_num, dl_size, section_offset;
3444 u8 cmd[64];
3445
3446 err = request_firmware(&fw, fwname, &hdev->dev);
3447 if (err < 0) {
3448 bt_dev_err(hdev, "Failed to load firmware file (%d)", err);
3449 return err;
3450 }
3451
3452 fw_ptr = fw->data;
3453 fw_bin_ptr = fw_ptr;
3454 globaldesc = (struct btmtk_global_desc *)(fw_ptr + MTK_FW_ROM_PATCH_HEADER_SIZE);
3455 section_num = le32_to_cpu(globaldesc->section_num);
3456
3457 for (i = 0; i < section_num; i++) {
3458 first_block = 1;
3459 fw_ptr = fw_bin_ptr;
3460 sectionmap = (struct btmtk_section_map *)(fw_ptr + MTK_FW_ROM_PATCH_HEADER_SIZE +
3461 MTK_FW_ROM_PATCH_GD_SIZE + MTK_FW_ROM_PATCH_SEC_MAP_SIZE * i);
3462
3463 section_offset = le32_to_cpu(sectionmap->secoffset);
3464 dl_size = le32_to_cpu(sectionmap->bin_info_spec.dlsize);
3465
3466 if (dl_size > 0) {
3467 retry = 20;
3468 while (retry > 0) {
3469 cmd[0] = 0;
3470 memcpy(cmd + 1,
3471 fw_ptr + MTK_FW_ROM_PATCH_HEADER_SIZE +
3472 MTK_FW_ROM_PATCH_GD_SIZE + MTK_FW_ROM_PATCH_SEC_MAP_SIZE * i +
3473 MTK_SEC_MAP_COMMON_SIZE,
3474 MTK_SEC_MAP_NEED_SEND_SIZE + 1);
3475
3476 wmt_params.op = BTMTK_WMT_PATCH_DWNLD;
3477 wmt_params.status = &status;
3478 wmt_params.flag = 0;
3479 wmt_params.dlen = MTK_SEC_MAP_NEED_SEND_SIZE + 1;
3480 wmt_params.data = &cmd;
3481
3482 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3483 if (err < 0) {
3484 bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)",
3485 err);
3486 goto err_release_fw;
3487 }
3488
3489 if (status == BTMTK_WMT_PATCH_UNDONE) {
3490 break;
3491 } else if (status == BTMTK_WMT_PATCH_PROGRESS) {
3492 msleep(100);
3493 retry--;
3494 } else if (status == BTMTK_WMT_PATCH_DONE) {
3495 goto next_section;
3496 } else {
3497 bt_dev_err(hdev, "Failed wmt patch dwnld status (%d)",
3498 status);
3499 goto err_release_fw;
3500 }
3501 }
3502
3503 fw_ptr += section_offset;
3504 wmt_params.op = BTMTK_WMT_PATCH_DWNLD;
3505 wmt_params.status = NULL;
3506
3507 while (dl_size > 0) {
3508 dlen = min_t(int, 250, dl_size);
3509 if (first_block == 1) {
3510 flag = 1;
3511 first_block = 0;
3512 } else if (dl_size - dlen <= 0) {
3513 flag = 3;
3514 } else {
3515 flag = 2;
3516 }
3517
3518 wmt_params.flag = flag;
3519 wmt_params.dlen = dlen;
3520 wmt_params.data = fw_ptr;
3521
3522 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3523 if (err < 0) {
3524 bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)",
3525 err);
3526 goto err_release_fw;
3527 }
3528
3529 dl_size -= dlen;
3530 fw_ptr += dlen;
3531 }
3532 }
3533next_section:
3534 continue;
3535 }
3536
3537 usleep_range(100000, 120000);
3538
3539err_release_fw:
3540 release_firmware(fw);
3541
3542 return err;
3543}
3544
3545static int btusb_mtk_setup_firmware(struct hci_dev *hdev, const char *fwname)
3546{
3547 struct btmtk_hci_wmt_params wmt_params;
3548 const struct firmware *fw;
3549 const u8 *fw_ptr;
3550 size_t fw_size;
3551 int err, dlen;
3552 u8 flag, param;
3553
3554 err = request_firmware(&fw, fwname, &hdev->dev);
3555 if (err < 0) {
3556 bt_dev_err(hdev, "Failed to load firmware file (%d)", err);
3557 return err;
3558 }
3559
3560
3561 param = 1;
3562 wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3563 wmt_params.flag = 3;
3564 wmt_params.dlen = sizeof(param);
3565 wmt_params.data = ¶m;
3566 wmt_params.status = NULL;
3567
3568 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3569 if (err < 0) {
3570 bt_dev_err(hdev, "Failed to power on data RAM (%d)", err);
3571 goto err_release_fw;
3572 }
3573
3574 fw_ptr = fw->data;
3575 fw_size = fw->size;
3576
3577
3578 if (fw_size < 30) {
3579 err = -EINVAL;
3580 goto err_release_fw;
3581 }
3582
3583 fw_size -= 30;
3584 fw_ptr += 30;
3585 flag = 1;
3586
3587 wmt_params.op = BTMTK_WMT_PATCH_DWNLD;
3588 wmt_params.status = NULL;
3589
3590 while (fw_size > 0) {
3591 dlen = min_t(int, 250, fw_size);
3592
3593
3594 if (fw_size - dlen <= 0)
3595 flag = 3;
3596 else if (fw_size < fw->size - 30)
3597 flag = 2;
3598
3599 wmt_params.flag = flag;
3600 wmt_params.dlen = dlen;
3601 wmt_params.data = fw_ptr;
3602
3603 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3604 if (err < 0) {
3605 bt_dev_err(hdev, "Failed to send wmt patch dwnld (%d)",
3606 err);
3607 goto err_release_fw;
3608 }
3609
3610 fw_size -= dlen;
3611 fw_ptr += dlen;
3612 }
3613
3614 wmt_params.op = BTMTK_WMT_RST;
3615 wmt_params.flag = 4;
3616 wmt_params.dlen = 0;
3617 wmt_params.data = NULL;
3618 wmt_params.status = NULL;
3619
3620
3621 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3622 if (err < 0) {
3623 bt_dev_err(hdev, "Failed to send wmt rst (%d)", err);
3624 goto err_release_fw;
3625 }
3626
3627
3628 usleep_range(10000, 12000);
3629
3630err_release_fw:
3631 release_firmware(fw);
3632
3633 return err;
3634}
3635
3636static int btusb_mtk_func_query(struct hci_dev *hdev)
3637{
3638 struct btmtk_hci_wmt_params wmt_params;
3639 int status, err;
3640 u8 param = 0;
3641
3642
3643 wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3644 wmt_params.flag = 4;
3645 wmt_params.dlen = sizeof(param);
3646 wmt_params.data = ¶m;
3647 wmt_params.status = &status;
3648
3649 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3650 if (err < 0) {
3651 bt_dev_err(hdev, "Failed to query function status (%d)", err);
3652 return err;
3653 }
3654
3655 return status;
3656}
3657
3658static int btusb_mtk_reg_read(struct btusb_data *data, u32 reg, u32 *val)
3659{
3660 int pipe, err, size = sizeof(u32);
3661 void *buf;
3662
3663 buf = kzalloc(size, GFP_KERNEL);
3664 if (!buf)
3665 return -ENOMEM;
3666
3667 pipe = usb_rcvctrlpipe(data->udev, 0);
3668 err = usb_control_msg(data->udev, pipe, 0x63,
3669 USB_TYPE_VENDOR | USB_DIR_IN,
3670 reg >> 16, reg & 0xffff,
3671 buf, size, USB_CTRL_SET_TIMEOUT);
3672 if (err < 0)
3673 goto err_free_buf;
3674
3675 *val = get_unaligned_le32(buf);
3676
3677err_free_buf:
3678 kfree(buf);
3679
3680 return err;
3681}
3682
3683static int btusb_mtk_id_get(struct btusb_data *data, u32 reg, u32 *id)
3684{
3685 return btusb_mtk_reg_read(data, reg, id);
3686}
3687
3688static int btusb_mtk_setup(struct hci_dev *hdev)
3689{
3690 struct btusb_data *data = hci_get_drvdata(hdev);
3691 struct btmtk_hci_wmt_params wmt_params;
3692 ktime_t calltime, delta, rettime;
3693 struct btmtk_tci_sleep tci_sleep;
3694 unsigned long long duration;
3695 struct sk_buff *skb;
3696 const char *fwname;
3697 int err, status;
3698 u32 dev_id;
3699 char fw_bin_name[64];
3700 u32 fw_version = 0;
3701 u8 param;
3702
3703 calltime = ktime_get();
3704
3705 err = btusb_mtk_id_get(data, 0x80000008, &dev_id);
3706 if (err < 0) {
3707 bt_dev_err(hdev, "Failed to get device id (%d)", err);
3708 return err;
3709 }
3710
3711 if (!dev_id) {
3712 err = btusb_mtk_id_get(data, 0x70010200, &dev_id);
3713 if (err < 0) {
3714 bt_dev_err(hdev, "Failed to get device id (%d)", err);
3715 return err;
3716 }
3717 err = btusb_mtk_id_get(data, 0x80021004, &fw_version);
3718 if (err < 0) {
3719 bt_dev_err(hdev, "Failed to get fw version (%d)", err);
3720 return err;
3721 }
3722 }
3723
3724 switch (dev_id) {
3725 case 0x7663:
3726 fwname = FIRMWARE_MT7663;
3727 break;
3728 case 0x7668:
3729 fwname = FIRMWARE_MT7668;
3730 break;
3731 case 0x7961:
3732 snprintf(fw_bin_name, sizeof(fw_bin_name),
3733 "mediatek/BT_RAM_CODE_MT%04x_1_%x_hdr.bin",
3734 dev_id & 0xffff, (fw_version & 0xff) + 1);
3735 err = btusb_mtk_setup_firmware_79xx(hdev, fw_bin_name);
3736
3737
3738 param = 1;
3739 wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3740 wmt_params.flag = 0;
3741 wmt_params.dlen = sizeof(param);
3742 wmt_params.data = ¶m;
3743 wmt_params.status = NULL;
3744
3745 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3746 if (err < 0) {
3747 bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);
3748 return err;
3749 }
3750 goto done;
3751 default:
3752 bt_dev_err(hdev, "Unsupported hardware variant (%08x)",
3753 dev_id);
3754 return -ENODEV;
3755 }
3756
3757
3758 wmt_params.op = BTMTK_WMT_SEMAPHORE;
3759 wmt_params.flag = 1;
3760 wmt_params.dlen = 0;
3761 wmt_params.data = NULL;
3762 wmt_params.status = &status;
3763
3764 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3765 if (err < 0) {
3766 bt_dev_err(hdev, "Failed to query firmware status (%d)", err);
3767 return err;
3768 }
3769
3770 if (status == BTMTK_WMT_PATCH_DONE) {
3771 bt_dev_info(hdev, "firmware already downloaded");
3772 goto ignore_setup_fw;
3773 }
3774
3775
3776 err = btusb_mtk_setup_firmware(hdev, fwname);
3777 if (err < 0)
3778 return err;
3779
3780ignore_setup_fw:
3781 err = readx_poll_timeout(btusb_mtk_func_query, hdev, status,
3782 status < 0 || status != BTMTK_WMT_ON_PROGRESS,
3783 2000, 5000000);
3784
3785 if (err < 0)
3786 return err;
3787
3788
3789 if (status < 0)
3790 return status;
3791
3792 if (status == BTMTK_WMT_ON_DONE) {
3793 bt_dev_info(hdev, "function already on");
3794 goto ignore_func_on;
3795 }
3796
3797
3798 param = 1;
3799 wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3800 wmt_params.flag = 0;
3801 wmt_params.dlen = sizeof(param);
3802 wmt_params.data = ¶m;
3803 wmt_params.status = NULL;
3804
3805 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3806 if (err < 0) {
3807 bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);
3808 return err;
3809 }
3810
3811ignore_func_on:
3812
3813 tci_sleep.mode = 0x5;
3814 tci_sleep.duration = cpu_to_le16(0x640);
3815 tci_sleep.host_duration = cpu_to_le16(0x640);
3816 tci_sleep.host_wakeup_pin = 0;
3817 tci_sleep.time_compensation = 0;
3818
3819 skb = __hci_cmd_sync(hdev, 0xfc7a, sizeof(tci_sleep), &tci_sleep,
3820 HCI_INIT_TIMEOUT);
3821 if (IS_ERR(skb)) {
3822 err = PTR_ERR(skb);
3823 bt_dev_err(hdev, "Failed to apply low power setting (%d)", err);
3824 return err;
3825 }
3826 kfree_skb(skb);
3827
3828done:
3829 rettime = ktime_get();
3830 delta = ktime_sub(rettime, calltime);
3831 duration = (unsigned long long)ktime_to_ns(delta) >> 10;
3832
3833 bt_dev_info(hdev, "Device setup in %llu usecs", duration);
3834
3835 return 0;
3836}
3837
3838static int btusb_mtk_shutdown(struct hci_dev *hdev)
3839{
3840 struct btmtk_hci_wmt_params wmt_params;
3841 u8 param = 0;
3842 int err;
3843
3844
3845 wmt_params.op = BTMTK_WMT_FUNC_CTRL;
3846 wmt_params.flag = 0;
3847 wmt_params.dlen = sizeof(param);
3848 wmt_params.data = ¶m;
3849 wmt_params.status = NULL;
3850
3851 err = btusb_mtk_hci_wmt_sync(hdev, &wmt_params);
3852 if (err < 0) {
3853 bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);
3854 return err;
3855 }
3856
3857 return 0;
3858}
3859
3860MODULE_FIRMWARE(FIRMWARE_MT7663);
3861MODULE_FIRMWARE(FIRMWARE_MT7668);
3862
3863#ifdef CONFIG_PM
3864
3865static int marvell_config_oob_wake(struct hci_dev *hdev)
3866{
3867 struct sk_buff *skb;
3868 struct btusb_data *data = hci_get_drvdata(hdev);
3869 struct device *dev = &data->udev->dev;
3870 u16 pin, gap, opcode;
3871 int ret;
3872 u8 cmd[5];
3873
3874
3875 if (of_property_read_u16(dev->of_node, "marvell,wakeup-pin", &pin) ||
3876 of_property_read_u16(dev->of_node, "marvell,wakeup-gap-ms", &gap))
3877 return 0;
3878
3879
3880 opcode = hci_opcode_pack(0x3F, 0x59);
3881 cmd[0] = opcode & 0xFF;
3882 cmd[1] = opcode >> 8;
3883 cmd[2] = 2;
3884 cmd[3] = pin;
3885 cmd[4] = gap;
3886
3887 skb = bt_skb_alloc(sizeof(cmd), GFP_KERNEL);
3888 if (!skb) {
3889 bt_dev_err(hdev, "%s: No memory", __func__);
3890 return -ENOMEM;
3891 }
3892
3893 skb_put_data(skb, cmd, sizeof(cmd));
3894 hci_skb_pkt_type(skb) = HCI_COMMAND_PKT;
3895
3896 ret = btusb_send_frame(hdev, skb);
3897 if (ret) {
3898 bt_dev_err(hdev, "%s: configuration failed", __func__);
3899 kfree_skb(skb);
3900 return ret;
3901 }
3902
3903 return 0;
3904}
3905#endif
3906
3907static int btusb_set_bdaddr_marvell(struct hci_dev *hdev,
3908 const bdaddr_t *bdaddr)
3909{
3910 struct sk_buff *skb;
3911 u8 buf[8];
3912 long ret;
3913
3914 buf[0] = 0xfe;
3915 buf[1] = sizeof(bdaddr_t);
3916 memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
3917
3918 skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT);
3919 if (IS_ERR(skb)) {
3920 ret = PTR_ERR(skb);
3921 bt_dev_err(hdev, "changing Marvell device address failed (%ld)",
3922 ret);
3923 return ret;
3924 }
3925 kfree_skb(skb);
3926
3927 return 0;
3928}
3929
3930static int btusb_set_bdaddr_ath3012(struct hci_dev *hdev,
3931 const bdaddr_t *bdaddr)
3932{
3933 struct sk_buff *skb;
3934 u8 buf[10];
3935 long ret;
3936
3937 buf[0] = 0x01;
3938 buf[1] = 0x01;
3939 buf[2] = 0x00;
3940 buf[3] = sizeof(bdaddr_t);
3941 memcpy(buf + 4, bdaddr, sizeof(bdaddr_t));
3942
3943 skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT);
3944 if (IS_ERR(skb)) {
3945 ret = PTR_ERR(skb);
3946 bt_dev_err(hdev, "Change address command failed (%ld)", ret);
3947 return ret;
3948 }
3949 kfree_skb(skb);
3950
3951 return 0;
3952}
3953
3954static int btusb_set_bdaddr_wcn6855(struct hci_dev *hdev,
3955 const bdaddr_t *bdaddr)
3956{
3957 struct sk_buff *skb;
3958 u8 buf[6];
3959 long ret;
3960
3961 memcpy(buf, bdaddr, sizeof(bdaddr_t));
3962
3963 skb = __hci_cmd_sync_ev(hdev, 0xfc14, sizeof(buf), buf,
3964 HCI_EV_CMD_COMPLETE, HCI_INIT_TIMEOUT);
3965 if (IS_ERR(skb)) {
3966 ret = PTR_ERR(skb);
3967 bt_dev_err(hdev, "Change address command failed (%ld)", ret);
3968 return ret;
3969 }
3970 kfree_skb(skb);
3971
3972 return 0;
3973}
3974
3975#define QCA_DFU_PACKET_LEN 4096
3976
3977#define QCA_GET_TARGET_VERSION 0x09
3978#define QCA_CHECK_STATUS 0x05
3979#define QCA_DFU_DOWNLOAD 0x01
3980
3981#define QCA_SYSCFG_UPDATED 0x40
3982#define QCA_PATCH_UPDATED 0x80
3983#define QCA_DFU_TIMEOUT 3000
3984#define QCA_FLAG_MULTI_NVM 0x80
3985
3986struct qca_version {
3987 __le32 rom_version;
3988 __le32 patch_version;
3989 __le32 ram_version;
3990 __le16 board_id;
3991 __le16 flag;
3992 __u8 reserved[4];
3993} __packed;
3994
3995struct qca_rampatch_version {
3996 __le16 rom_version_high;
3997 __le16 rom_version_low;
3998 __le16 patch_version;
3999} __packed;
4000
4001struct qca_device_info {
4002 u32 rom_version;
4003 u8 rampatch_hdr;
4004 u8 nvm_hdr;
4005 u8 ver_offset;
4006};
4007
4008static const struct qca_device_info qca_devices_table[] = {
4009 { 0x00000100, 20, 4, 8 },
4010 { 0x00000101, 20, 4, 8 },
4011 { 0x00000200, 28, 4, 16 },
4012 { 0x00000201, 28, 4, 16 },
4013 { 0x00000300, 28, 4, 16 },
4014 { 0x00000302, 28, 4, 16 },
4015 { 0x00130100, 40, 4, 16 },
4016 { 0x00130200, 40, 4, 16 },
4017};
4018
4019static int btusb_qca_send_vendor_req(struct usb_device *udev, u8 request,
4020 void *data, u16 size)
4021{
4022 int pipe, err;
4023 u8 *buf;
4024
4025 buf = kmalloc(size, GFP_KERNEL);
4026 if (!buf)
4027 return -ENOMEM;
4028
4029
4030
4031
4032 pipe = usb_rcvctrlpipe(udev, 0);
4033 err = usb_control_msg(udev, pipe, request, USB_TYPE_VENDOR | USB_DIR_IN,
4034 0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
4035 if (err < 0) {
4036 dev_err(&udev->dev, "Failed to access otp area (%d)", err);
4037 goto done;
4038 }
4039
4040 memcpy(data, buf, size);
4041
4042done:
4043 kfree(buf);
4044
4045 return err;
4046}
4047
4048static int btusb_setup_qca_download_fw(struct hci_dev *hdev,
4049 const struct firmware *firmware,
4050 size_t hdr_size)
4051{
4052 struct btusb_data *btdata = hci_get_drvdata(hdev);
4053 struct usb_device *udev = btdata->udev;
4054 size_t count, size, sent = 0;
4055 int pipe, len, err;
4056 u8 *buf;
4057
4058 buf = kmalloc(QCA_DFU_PACKET_LEN, GFP_KERNEL);
4059 if (!buf)
4060 return -ENOMEM;
4061
4062 count = firmware->size;
4063
4064 size = min_t(size_t, count, hdr_size);
4065 memcpy(buf, firmware->data, size);
4066
4067
4068
4069
4070
4071
4072 pipe = usb_sndctrlpipe(udev, 0);
4073 err = usb_control_msg(udev, pipe, QCA_DFU_DOWNLOAD, USB_TYPE_VENDOR,
4074 0, 0, buf, size, USB_CTRL_SET_TIMEOUT);
4075 if (err < 0) {
4076 bt_dev_err(hdev, "Failed to send headers (%d)", err);
4077 goto done;
4078 }
4079
4080 sent += size;
4081 count -= size;
4082
4083
4084
4085
4086 msleep(20);
4087
4088 while (count) {
4089 size = min_t(size_t, count, QCA_DFU_PACKET_LEN);
4090
4091 memcpy(buf, firmware->data + sent, size);
4092
4093 pipe = usb_sndbulkpipe(udev, 0x02);
4094 err = usb_bulk_msg(udev, pipe, buf, size, &len,
4095 QCA_DFU_TIMEOUT);
4096 if (err < 0) {
4097 bt_dev_err(hdev, "Failed to send body at %zd of %zd (%d)",
4098 sent, firmware->size, err);
4099 break;
4100 }
4101
4102 if (size != len) {
4103 bt_dev_err(hdev, "Failed to get bulk buffer");
4104 err = -EILSEQ;
4105 break;
4106 }
4107
4108 sent += size;
4109 count -= size;
4110 }
4111
4112done:
4113 kfree(buf);
4114 return err;
4115}
4116
4117static int btusb_setup_qca_load_rampatch(struct hci_dev *hdev,
4118 struct qca_version *ver,
4119 const struct qca_device_info *info)
4120{
4121 struct qca_rampatch_version *rver;
4122 const struct firmware *fw;
4123 u32 ver_rom, ver_patch, rver_rom;
4124 u16 rver_rom_low, rver_rom_high, rver_patch;
4125 char fwname[64];
4126 int err;
4127
4128 ver_rom = le32_to_cpu(ver->rom_version);
4129 ver_patch = le32_to_cpu(ver->patch_version);
4130
4131 snprintf(fwname, sizeof(fwname), "qca/rampatch_usb_%08x.bin", ver_rom);
4132
4133 err = request_firmware(&fw, fwname, &hdev->dev);
4134 if (err) {
4135 bt_dev_err(hdev, "failed to request rampatch file: %s (%d)",
4136 fwname, err);
4137 return err;
4138 }
4139
4140 bt_dev_info(hdev, "using rampatch file: %s", fwname);
4141
4142 rver = (struct qca_rampatch_version *)(fw->data + info->ver_offset);
4143 rver_rom_low = le16_to_cpu(rver->rom_version_low);
4144 rver_patch = le16_to_cpu(rver->patch_version);
4145
4146 if (ver_rom & ~0xffffU) {
4147 rver_rom_high = le16_to_cpu(rver->rom_version_high);
4148 rver_rom = le32_to_cpu(rver_rom_high << 16 | rver_rom_low);
4149 } else {
4150 rver_rom = rver_rom_low;
4151 }
4152
4153 bt_dev_info(hdev, "QCA: patch rome 0x%x build 0x%x, "
4154 "firmware rome 0x%x build 0x%x",
4155 rver_rom, rver_patch, ver_rom, ver_patch);
4156
4157 if (rver_rom != ver_rom || rver_patch <= ver_patch) {
4158 bt_dev_err(hdev, "rampatch file version did not match with firmware");
4159 err = -EINVAL;
4160 goto done;
4161 }
4162
4163 err = btusb_setup_qca_download_fw(hdev, fw, info->rampatch_hdr);
4164
4165done:
4166 release_firmware(fw);
4167
4168 return err;
4169}
4170
4171static int btusb_setup_qca_load_nvm(struct hci_dev *hdev,
4172 struct qca_version *ver,
4173 const struct qca_device_info *info)
4174{
4175 const struct firmware *fw;
4176 char fwname[64];
4177 int err;
4178
4179 if (((ver->flag >> 8) & 0xff) == QCA_FLAG_MULTI_NVM) {
4180
4181 if (le16_to_cpu(ver->board_id) == 0x0) {
4182 snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x.bin",
4183 le32_to_cpu(ver->rom_version));
4184 } else {
4185 snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x_%04x.bin",
4186 le32_to_cpu(ver->rom_version),
4187 le16_to_cpu(ver->board_id));
4188 }
4189 } else {
4190 snprintf(fwname, sizeof(fwname), "qca/nvm_usb_%08x.bin",
4191 le32_to_cpu(ver->rom_version));
4192 }
4193
4194 err = request_firmware(&fw, fwname, &hdev->dev);
4195 if (err) {
4196 bt_dev_err(hdev, "failed to request NVM file: %s (%d)",
4197 fwname, err);
4198 return err;
4199 }
4200
4201 bt_dev_info(hdev, "using NVM file: %s", fwname);
4202
4203 err = btusb_setup_qca_download_fw(hdev, fw, info->nvm_hdr);
4204
4205 release_firmware(fw);
4206
4207 return err;
4208}
4209
4210
4211static bool btusb_qca_need_patch(struct usb_device *udev)
4212{
4213 struct qca_version ver;
4214
4215 if (btusb_qca_send_vendor_req(udev, QCA_GET_TARGET_VERSION, &ver,
4216 sizeof(ver)) < 0)
4217 return false;
4218
4219 return !(le32_to_cpu(ver.rom_version) & ~0xffffU);
4220}
4221
4222static int btusb_setup_qca(struct hci_dev *hdev)
4223{
4224 struct btusb_data *btdata = hci_get_drvdata(hdev);
4225 struct usb_device *udev = btdata->udev;
4226 const struct qca_device_info *info = NULL;
4227 struct qca_version ver;
4228 u32 ver_rom;
4229 u8 status;
4230 int i, err;
4231
4232 err = btusb_qca_send_vendor_req(udev, QCA_GET_TARGET_VERSION, &ver,
4233 sizeof(ver));
4234 if (err < 0)
4235 return err;
4236
4237 ver_rom = le32_to_cpu(ver.rom_version);
4238
4239 for (i = 0; i < ARRAY_SIZE(qca_devices_table); i++) {
4240 if (ver_rom == qca_devices_table[i].rom_version)
4241 info = &qca_devices_table[i];
4242 }
4243 if (!info) {
4244
4245
4246
4247
4248 if (ver_rom & ~0xffffU)
4249 return 0;
4250
4251 bt_dev_err(hdev, "don't support firmware rome 0x%x", ver_rom);
4252 return -ENODEV;
4253 }
4254
4255 err = btusb_qca_send_vendor_req(udev, QCA_CHECK_STATUS, &status,
4256 sizeof(status));
4257 if (err < 0)
4258 return err;
4259
4260 if (!(status & QCA_PATCH_UPDATED)) {
4261 err = btusb_setup_qca_load_rampatch(hdev, &ver, info);
4262 if (err < 0)
4263 return err;
4264 }
4265
4266 err = btusb_qca_send_vendor_req(udev, QCA_GET_TARGET_VERSION, &ver,
4267 sizeof(ver));
4268 if (err < 0)
4269 return err;
4270
4271 if (!(status & QCA_SYSCFG_UPDATED)) {
4272 err = btusb_setup_qca_load_nvm(hdev, &ver, info);
4273 if (err < 0)
4274 return err;
4275 }
4276
4277 return 0;
4278}
4279
4280static inline int __set_diag_interface(struct hci_dev *hdev)
4281{
4282 struct btusb_data *data = hci_get_drvdata(hdev);
4283 struct usb_interface *intf = data->diag;
4284 int i;
4285
4286 if (!data->diag)
4287 return -ENODEV;
4288
4289 data->diag_tx_ep = NULL;
4290 data->diag_rx_ep = NULL;
4291
4292 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
4293 struct usb_endpoint_descriptor *ep_desc;
4294
4295 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
4296
4297 if (!data->diag_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
4298 data->diag_tx_ep = ep_desc;
4299 continue;
4300 }
4301
4302 if (!data->diag_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
4303 data->diag_rx_ep = ep_desc;
4304 continue;
4305 }
4306 }
4307
4308 if (!data->diag_tx_ep || !data->diag_rx_ep) {
4309 bt_dev_err(hdev, "invalid diagnostic descriptors");
4310 return -ENODEV;
4311 }
4312
4313 return 0;
4314}
4315
4316static struct urb *alloc_diag_urb(struct hci_dev *hdev, bool enable)
4317{
4318 struct btusb_data *data = hci_get_drvdata(hdev);
4319 struct sk_buff *skb;
4320 struct urb *urb;
4321 unsigned int pipe;
4322
4323 if (!data->diag_tx_ep)
4324 return ERR_PTR(-ENODEV);
4325
4326 urb = usb_alloc_urb(0, GFP_KERNEL);
4327 if (!urb)
4328 return ERR_PTR(-ENOMEM);
4329
4330 skb = bt_skb_alloc(2, GFP_KERNEL);
4331 if (!skb) {
4332 usb_free_urb(urb);
4333 return ERR_PTR(-ENOMEM);
4334 }
4335
4336 skb_put_u8(skb, 0xf0);
4337 skb_put_u8(skb, enable);
4338
4339 pipe = usb_sndbulkpipe(data->udev, data->diag_tx_ep->bEndpointAddress);
4340
4341 usb_fill_bulk_urb(urb, data->udev, pipe,
4342 skb->data, skb->len, btusb_tx_complete, skb);
4343
4344 skb->dev = (void *)hdev;
4345
4346 return urb;
4347}
4348
4349static int btusb_bcm_set_diag(struct hci_dev *hdev, bool enable)
4350{
4351 struct btusb_data *data = hci_get_drvdata(hdev);
4352 struct urb *urb;
4353
4354 if (!data->diag)
4355 return -ENODEV;
4356
4357 if (!test_bit(HCI_RUNNING, &hdev->flags))
4358 return -ENETDOWN;
4359
4360 urb = alloc_diag_urb(hdev, enable);
4361 if (IS_ERR(urb))
4362 return PTR_ERR(urb);
4363
4364 return submit_or_queue_tx_urb(hdev, urb);
4365}
4366
4367#ifdef CONFIG_PM
4368static irqreturn_t btusb_oob_wake_handler(int irq, void *priv)
4369{
4370 struct btusb_data *data = priv;
4371
4372 pm_wakeup_event(&data->udev->dev, 0);
4373 pm_system_wakeup();
4374
4375
4376 if (test_and_clear_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags)) {
4377 disable_irq_nosync(irq);
4378 disable_irq_wake(irq);
4379 }
4380 return IRQ_HANDLED;
4381}
4382
4383static const struct of_device_id btusb_match_table[] = {
4384 { .compatible = "usb1286,204e" },
4385 { .compatible = "usbcf3,e300" },
4386 { .compatible = "usb4ca,301a" },
4387 { }
4388};
4389MODULE_DEVICE_TABLE(of, btusb_match_table);
4390
4391
4392static int btusb_config_oob_wake(struct hci_dev *hdev)
4393{
4394 struct btusb_data *data = hci_get_drvdata(hdev);
4395 struct device *dev = &data->udev->dev;
4396 int irq, ret;
4397
4398 clear_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags);
4399
4400 if (!of_match_device(btusb_match_table, dev))
4401 return 0;
4402
4403
4404 irq = of_irq_get_byname(dev->of_node, "wakeup");
4405 if (irq <= 0) {
4406 bt_dev_dbg(hdev, "%s: no OOB Wakeup IRQ in DT", __func__);
4407 return 0;
4408 }
4409
4410 irq_set_status_flags(irq, IRQ_NOAUTOEN);
4411 ret = devm_request_irq(&hdev->dev, irq, btusb_oob_wake_handler,
4412 0, "OOB Wake-on-BT", data);
4413 if (ret) {
4414 bt_dev_err(hdev, "%s: IRQ request failed", __func__);
4415 return ret;
4416 }
4417
4418 ret = device_init_wakeup(dev, true);
4419 if (ret) {
4420 bt_dev_err(hdev, "%s: failed to init_wakeup", __func__);
4421 return ret;
4422 }
4423
4424 data->oob_wake_irq = irq;
4425 bt_dev_info(hdev, "OOB Wake-on-BT configured at IRQ %u", irq);
4426 return 0;
4427}
4428#endif
4429
4430static void btusb_check_needs_reset_resume(struct usb_interface *intf)
4431{
4432 if (dmi_check_system(btusb_needs_reset_resume_table))
4433 interface_to_usbdev(intf)->quirks |= USB_QUIRK_RESET_RESUME;
4434}
4435
4436static bool btusb_prevent_wake(struct hci_dev *hdev)
4437{
4438 struct btusb_data *data = hci_get_drvdata(hdev);
4439
4440 if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags))
4441 return true;
4442
4443 return !device_may_wakeup(&data->udev->dev);
4444}
4445
4446static int btusb_shutdown_qca(struct hci_dev *hdev)
4447{
4448 struct sk_buff *skb;
4449
4450 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
4451 if (IS_ERR(skb)) {
4452 bt_dev_err(hdev, "HCI reset during shutdown failed");
4453 return PTR_ERR(skb);
4454 }
4455 kfree_skb(skb);
4456
4457 return 0;
4458}
4459
4460static int btusb_probe(struct usb_interface *intf,
4461 const struct usb_device_id *id)
4462{
4463 struct usb_endpoint_descriptor *ep_desc;
4464 struct gpio_desc *reset_gpio;
4465 struct btusb_data *data;
4466 struct hci_dev *hdev;
4467 unsigned ifnum_base;
4468 int i, err;
4469
4470 BT_DBG("intf %p id %p", intf, id);
4471
4472
4473 if (intf->cur_altsetting->desc.bInterfaceNumber != 0) {
4474 if (!(id->driver_info & BTUSB_IFNUM_2))
4475 return -ENODEV;
4476 if (intf->cur_altsetting->desc.bInterfaceNumber != 2)
4477 return -ENODEV;
4478 }
4479
4480 ifnum_base = intf->cur_altsetting->desc.bInterfaceNumber;
4481
4482 if (!id->driver_info) {
4483 const struct usb_device_id *match;
4484
4485 match = usb_match_id(intf, blacklist_table);
4486 if (match)
4487 id = match;
4488 }
4489
4490 if (id->driver_info == BTUSB_IGNORE)
4491 return -ENODEV;
4492
4493 if (id->driver_info & BTUSB_ATH3012) {
4494 struct usb_device *udev = interface_to_usbdev(intf);
4495
4496
4497
4498
4499 if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001 &&
4500 !btusb_qca_need_patch(udev))
4501 return -ENODEV;
4502 }
4503
4504 data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
4505 if (!data)
4506 return -ENOMEM;
4507
4508 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
4509 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
4510
4511 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
4512 data->intr_ep = ep_desc;
4513 continue;
4514 }
4515
4516 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
4517 data->bulk_tx_ep = ep_desc;
4518 continue;
4519 }
4520
4521 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
4522 data->bulk_rx_ep = ep_desc;
4523 continue;
4524 }
4525 }
4526
4527 if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep)
4528 return -ENODEV;
4529
4530 if (id->driver_info & BTUSB_AMP) {
4531 data->cmdreq_type = USB_TYPE_CLASS | 0x01;
4532 data->cmdreq = 0x2b;
4533 } else {
4534 data->cmdreq_type = USB_TYPE_CLASS;
4535 data->cmdreq = 0x00;
4536 }
4537
4538 data->udev = interface_to_usbdev(intf);
4539 data->intf = intf;
4540
4541 INIT_WORK(&data->work, btusb_work);
4542 INIT_WORK(&data->waker, btusb_waker);
4543 init_usb_anchor(&data->deferred);
4544 init_usb_anchor(&data->tx_anchor);
4545 spin_lock_init(&data->txlock);
4546
4547 init_usb_anchor(&data->intr_anchor);
4548 init_usb_anchor(&data->bulk_anchor);
4549 init_usb_anchor(&data->isoc_anchor);
4550 init_usb_anchor(&data->diag_anchor);
4551 init_usb_anchor(&data->ctrl_anchor);
4552 spin_lock_init(&data->rxlock);
4553
4554 if (id->driver_info & BTUSB_INTEL_NEW) {
4555 data->recv_event = btusb_recv_event_intel;
4556 data->recv_bulk = btusb_recv_bulk_intel;
4557 set_bit(BTUSB_BOOTLOADER, &data->flags);
4558 } else {
4559 data->recv_event = hci_recv_frame;
4560 data->recv_bulk = btusb_recv_bulk;
4561 }
4562
4563 hdev = hci_alloc_dev();
4564 if (!hdev)
4565 return -ENOMEM;
4566
4567 hdev->bus = HCI_USB;
4568 hci_set_drvdata(hdev, data);
4569
4570 if (id->driver_info & BTUSB_AMP)
4571 hdev->dev_type = HCI_AMP;
4572 else
4573 hdev->dev_type = HCI_PRIMARY;
4574
4575 data->hdev = hdev;
4576
4577 SET_HCIDEV_DEV(hdev, &intf->dev);
4578
4579 reset_gpio = gpiod_get_optional(&data->udev->dev, "reset",
4580 GPIOD_OUT_LOW);
4581 if (IS_ERR(reset_gpio)) {
4582 err = PTR_ERR(reset_gpio);
4583 goto out_free_dev;
4584 } else if (reset_gpio) {
4585 data->reset_gpio = reset_gpio;
4586 }
4587
4588 hdev->open = btusb_open;
4589 hdev->close = btusb_close;
4590 hdev->flush = btusb_flush;
4591 hdev->send = btusb_send_frame;
4592 hdev->notify = btusb_notify;
4593 hdev->prevent_wake = btusb_prevent_wake;
4594
4595#ifdef CONFIG_PM
4596 err = btusb_config_oob_wake(hdev);
4597 if (err)
4598 goto out_free_dev;
4599
4600
4601 if (id->driver_info & BTUSB_MARVELL && data->oob_wake_irq) {
4602 err = marvell_config_oob_wake(hdev);
4603 if (err)
4604 goto out_free_dev;
4605 }
4606#endif
4607 if (id->driver_info & BTUSB_CW6622)
4608 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
4609
4610 if (id->driver_info & BTUSB_BCM2045)
4611 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks);
4612
4613 if (id->driver_info & BTUSB_BCM92035)
4614 hdev->setup = btusb_setup_bcm92035;
4615
4616 if (IS_ENABLED(CONFIG_BT_HCIBTUSB_BCM) &&
4617 (id->driver_info & BTUSB_BCM_PATCHRAM)) {
4618 hdev->manufacturer = 15;
4619 hdev->setup = btbcm_setup_patchram;
4620 hdev->set_diag = btusb_bcm_set_diag;
4621 hdev->set_bdaddr = btbcm_set_bdaddr;
4622
4623
4624 data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2);
4625 }
4626
4627 if (IS_ENABLED(CONFIG_BT_HCIBTUSB_BCM) &&
4628 (id->driver_info & BTUSB_BCM_APPLE)) {
4629 hdev->manufacturer = 15;
4630 hdev->setup = btbcm_setup_apple;
4631 hdev->set_diag = btusb_bcm_set_diag;
4632
4633
4634 data->diag = usb_ifnum_to_if(data->udev, ifnum_base + 2);
4635 }
4636
4637 if (id->driver_info & BTUSB_INTEL) {
4638 hdev->manufacturer = 2;
4639 hdev->setup = btusb_setup_intel;
4640 hdev->shutdown = btusb_shutdown_intel;
4641 hdev->set_diag = btintel_set_diag_mfg;
4642 hdev->set_bdaddr = btintel_set_bdaddr;
4643 hdev->cmd_timeout = btusb_intel_cmd_timeout;
4644 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4645 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4646 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
4647 }
4648
4649 if (id->driver_info & BTUSB_INTEL_NEW) {
4650 hdev->manufacturer = 2;
4651 hdev->send = btusb_send_frame_intel;
4652 hdev->setup = btusb_setup_intel_new;
4653 hdev->shutdown = btusb_shutdown_intel_new;
4654 hdev->hw_error = btintel_hw_error;
4655 hdev->set_diag = btintel_set_diag;
4656 hdev->set_bdaddr = btintel_set_bdaddr;
4657 hdev->cmd_timeout = btusb_intel_cmd_timeout;
4658 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4659 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4660 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
4661 }
4662
4663 if (id->driver_info & BTUSB_INTEL_NEWGEN) {
4664 hdev->manufacturer = 2;
4665 hdev->send = btusb_send_frame_intel;
4666 hdev->setup = btusb_setup_intel_newgen;
4667 hdev->shutdown = btusb_shutdown_intel_new;
4668 hdev->hw_error = btintel_hw_error;
4669 hdev->set_diag = btintel_set_diag;
4670 hdev->set_bdaddr = btintel_set_bdaddr;
4671 hdev->cmd_timeout = btusb_intel_cmd_timeout;
4672 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4673 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4674 set_bit(HCI_QUIRK_NON_PERSISTENT_DIAG, &hdev->quirks);
4675
4676 data->recv_event = btusb_recv_event_intel;
4677 data->recv_bulk = btusb_recv_bulk_intel;
4678 set_bit(BTUSB_BOOTLOADER, &data->flags);
4679 }
4680
4681 if (id->driver_info & BTUSB_MARVELL)
4682 hdev->set_bdaddr = btusb_set_bdaddr_marvell;
4683
4684 if (IS_ENABLED(CONFIG_BT_HCIBTUSB_MTK) &&
4685 (id->driver_info & BTUSB_MEDIATEK)) {
4686 hdev->setup = btusb_mtk_setup;
4687 hdev->shutdown = btusb_mtk_shutdown;
4688 hdev->manufacturer = 70;
4689 set_bit(HCI_QUIRK_NON_PERSISTENT_SETUP, &hdev->quirks);
4690 }
4691
4692 if (id->driver_info & BTUSB_SWAVE) {
4693 set_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks);
4694 set_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks);
4695 }
4696
4697 if (id->driver_info & BTUSB_INTEL_BOOT) {
4698 hdev->manufacturer = 2;
4699 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
4700 }
4701
4702 if (id->driver_info & BTUSB_ATH3012) {
4703 data->setup_on_usb = btusb_setup_qca;
4704 hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
4705 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4706 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
4707 }
4708
4709 if (id->driver_info & BTUSB_QCA_ROME) {
4710 data->setup_on_usb = btusb_setup_qca;
4711 hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
4712 hdev->cmd_timeout = btusb_qca_cmd_timeout;
4713 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4714 btusb_check_needs_reset_resume(intf);
4715 }
4716
4717 if (id->driver_info & BTUSB_QCA_WCN6855) {
4718 data->setup_on_usb = btusb_setup_qca;
4719 hdev->shutdown = btusb_shutdown_qca;
4720 hdev->set_bdaddr = btusb_set_bdaddr_wcn6855;
4721 hdev->cmd_timeout = btusb_qca_cmd_timeout;
4722 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4723 }
4724
4725 if (id->driver_info & BTUSB_AMP) {
4726
4727 data->isoc = NULL;
4728 } else {
4729
4730 data->isoc = usb_ifnum_to_if(data->udev, ifnum_base + 1);
4731 data->isoc_ifnum = ifnum_base + 1;
4732 }
4733
4734 if (IS_ENABLED(CONFIG_BT_HCIBTUSB_RTL) &&
4735 (id->driver_info & BTUSB_REALTEK)) {
4736 hdev->setup = btrtl_setup_realtek;
4737 hdev->shutdown = btrtl_shutdown_realtek;
4738 hdev->cmd_timeout = btusb_rtl_cmd_timeout;
4739
4740
4741
4742
4743
4744 set_bit(BTUSB_WAKEUP_DISABLE, &data->flags);
4745 }
4746
4747 if (!reset)
4748 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
4749
4750 if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
4751 if (!disable_scofix)
4752 set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
4753 }
4754
4755 if (id->driver_info & BTUSB_BROKEN_ISOC)
4756 data->isoc = NULL;
4757
4758 if (id->driver_info & BTUSB_WIDEBAND_SPEECH)
4759 set_bit(HCI_QUIRK_WIDEBAND_SPEECH_SUPPORTED, &hdev->quirks);
4760
4761 if (id->driver_info & BTUSB_VALID_LE_STATES)
4762 set_bit(HCI_QUIRK_VALID_LE_STATES, &hdev->quirks);
4763
4764 if (id->driver_info & BTUSB_DIGIANSWER) {
4765 data->cmdreq_type = USB_TYPE_VENDOR;
4766 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
4767 }
4768
4769 if (id->driver_info & BTUSB_CSR) {
4770 struct usb_device *udev = data->udev;
4771 u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice);
4772
4773
4774 if (bcdDevice < 0x117)
4775 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
4776
4777
4778 set_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks);
4779
4780
4781 if (le16_to_cpu(udev->descriptor.idVendor) == 0x0a12 &&
4782 le16_to_cpu(udev->descriptor.idProduct) == 0x0001)
4783 hdev->setup = btusb_setup_csr;
4784 }
4785
4786 if (id->driver_info & BTUSB_SNIFFER) {
4787 struct usb_device *udev = data->udev;
4788
4789
4790 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
4791 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
4792 }
4793
4794 if (id->driver_info & BTUSB_INTEL_BOOT) {
4795
4796
4797
4798 err = usb_set_interface(data->udev, 0, 0);
4799 if (err < 0) {
4800 BT_ERR("failed to set interface 0, alt 0 %d", err);
4801 goto out_free_dev;
4802 }
4803 }
4804
4805 if (data->isoc) {
4806 err = usb_driver_claim_interface(&btusb_driver,
4807 data->isoc, data);
4808 if (err < 0)
4809 goto out_free_dev;
4810 }
4811
4812 if (IS_ENABLED(CONFIG_BT_HCIBTUSB_BCM) && data->diag) {
4813 if (!usb_driver_claim_interface(&btusb_driver,
4814 data->diag, data))
4815 __set_diag_interface(hdev);
4816 else
4817 data->diag = NULL;
4818 }
4819
4820 if (enable_autosuspend)
4821 usb_enable_autosuspend(data->udev);
4822
4823 err = hci_register_dev(hdev);
4824 if (err < 0)
4825 goto out_free_dev;
4826
4827 usb_set_intfdata(intf, data);
4828
4829 return 0;
4830
4831out_free_dev:
4832 if (data->reset_gpio)
4833 gpiod_put(data->reset_gpio);
4834 hci_free_dev(hdev);
4835 return err;
4836}
4837
4838static void btusb_disconnect(struct usb_interface *intf)
4839{
4840 struct btusb_data *data = usb_get_intfdata(intf);
4841 struct hci_dev *hdev;
4842
4843 BT_DBG("intf %p", intf);
4844
4845 if (!data)
4846 return;
4847
4848 hdev = data->hdev;
4849 usb_set_intfdata(data->intf, NULL);
4850
4851 if (data->isoc)
4852 usb_set_intfdata(data->isoc, NULL);
4853
4854 if (data->diag)
4855 usb_set_intfdata(data->diag, NULL);
4856
4857 hci_unregister_dev(hdev);
4858
4859 if (intf == data->intf) {
4860 if (data->isoc)
4861 usb_driver_release_interface(&btusb_driver, data->isoc);
4862 if (data->diag)
4863 usb_driver_release_interface(&btusb_driver, data->diag);
4864 } else if (intf == data->isoc) {
4865 if (data->diag)
4866 usb_driver_release_interface(&btusb_driver, data->diag);
4867 usb_driver_release_interface(&btusb_driver, data->intf);
4868 } else if (intf == data->diag) {
4869 usb_driver_release_interface(&btusb_driver, data->intf);
4870 if (data->isoc)
4871 usb_driver_release_interface(&btusb_driver, data->isoc);
4872 }
4873
4874 if (data->oob_wake_irq)
4875 device_init_wakeup(&data->udev->dev, false);
4876
4877 if (data->reset_gpio)
4878 gpiod_put(data->reset_gpio);
4879
4880 hci_free_dev(hdev);
4881}
4882
4883#ifdef CONFIG_PM
4884static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
4885{
4886 struct btusb_data *data = usb_get_intfdata(intf);
4887
4888 BT_DBG("intf %p", intf);
4889
4890 if (data->suspend_count++)
4891 return 0;
4892
4893 spin_lock_irq(&data->txlock);
4894 if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) {
4895 set_bit(BTUSB_SUSPENDING, &data->flags);
4896 spin_unlock_irq(&data->txlock);
4897 } else {
4898 spin_unlock_irq(&data->txlock);
4899 data->suspend_count--;
4900 return -EBUSY;
4901 }
4902
4903 cancel_work_sync(&data->work);
4904
4905 btusb_stop_traffic(data);
4906 usb_kill_anchored_urbs(&data->tx_anchor);
4907
4908 if (data->oob_wake_irq && device_may_wakeup(&data->udev->dev)) {
4909 set_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags);
4910 enable_irq_wake(data->oob_wake_irq);
4911 enable_irq(data->oob_wake_irq);
4912 }
4913
4914
4915
4916
4917
4918
4919 if (test_bit(BTUSB_WAKEUP_DISABLE, &data->flags)) {
4920 if (PMSG_IS_AUTO(message) &&
4921 device_can_wakeup(&data->udev->dev))
4922 data->udev->do_remote_wakeup = 1;
4923 else if (!PMSG_IS_AUTO(message))
4924 data->udev->reset_resume = 1;
4925 }
4926
4927 return 0;
4928}
4929
4930static void play_deferred(struct btusb_data *data)
4931{
4932 struct urb *urb;
4933 int err;
4934
4935 while ((urb = usb_get_from_anchor(&data->deferred))) {
4936 usb_anchor_urb(urb, &data->tx_anchor);
4937
4938 err = usb_submit_urb(urb, GFP_ATOMIC);
4939 if (err < 0) {
4940 if (err != -EPERM && err != -ENODEV)
4941 BT_ERR("%s urb %p submission failed (%d)",
4942 data->hdev->name, urb, -err);
4943 kfree(urb->setup_packet);
4944 usb_unanchor_urb(urb);
4945 usb_free_urb(urb);
4946 break;
4947 }
4948
4949 data->tx_in_flight++;
4950 usb_free_urb(urb);
4951 }
4952
4953
4954 while ((urb = usb_get_from_anchor(&data->deferred))) {
4955 kfree(urb->setup_packet);
4956 usb_free_urb(urb);
4957 }
4958}
4959
4960static int btusb_resume(struct usb_interface *intf)
4961{
4962 struct btusb_data *data = usb_get_intfdata(intf);
4963 struct hci_dev *hdev = data->hdev;
4964 int err = 0;
4965
4966 BT_DBG("intf %p", intf);
4967
4968 if (--data->suspend_count)
4969 return 0;
4970
4971
4972 if (test_and_clear_bit(BTUSB_OOB_WAKE_ENABLED, &data->flags)) {
4973 disable_irq(data->oob_wake_irq);
4974 disable_irq_wake(data->oob_wake_irq);
4975 }
4976
4977 if (!test_bit(HCI_RUNNING, &hdev->flags))
4978 goto done;
4979
4980 if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
4981 err = btusb_submit_intr_urb(hdev, GFP_NOIO);
4982 if (err < 0) {
4983 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
4984 goto failed;
4985 }
4986 }
4987
4988 if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
4989 err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
4990 if (err < 0) {
4991 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
4992 goto failed;
4993 }
4994
4995 btusb_submit_bulk_urb(hdev, GFP_NOIO);
4996 }
4997
4998 if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
4999 if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
5000 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
5001 else
5002 btusb_submit_isoc_urb(hdev, GFP_NOIO);
5003 }
5004
5005 spin_lock_irq(&data->txlock);
5006 play_deferred(data);
5007 clear_bit(BTUSB_SUSPENDING, &data->flags);
5008 spin_unlock_irq(&data->txlock);
5009 schedule_work(&data->work);
5010
5011 return 0;
5012
5013failed:
5014 usb_scuttle_anchored_urbs(&data->deferred);
5015done:
5016 spin_lock_irq(&data->txlock);
5017 clear_bit(BTUSB_SUSPENDING, &data->flags);
5018 spin_unlock_irq(&data->txlock);
5019
5020 return err;
5021}
5022#endif
5023
5024static struct usb_driver btusb_driver = {
5025 .name = "btusb",
5026 .probe = btusb_probe,
5027 .disconnect = btusb_disconnect,
5028#ifdef CONFIG_PM
5029 .suspend = btusb_suspend,
5030 .resume = btusb_resume,
5031#endif
5032 .id_table = btusb_table,
5033 .supports_autosuspend = 1,
5034 .disable_hub_initiated_lpm = 1,
5035};
5036
5037module_usb_driver(btusb_driver);
5038
5039module_param(disable_scofix, bool, 0644);
5040MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
5041
5042module_param(force_scofix, bool, 0644);
5043MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
5044
5045module_param(enable_autosuspend, bool, 0644);
5046MODULE_PARM_DESC(enable_autosuspend, "Enable USB autosuspend by default");
5047
5048module_param(reset, bool, 0644);
5049MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
5050
5051MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
5052MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
5053MODULE_VERSION(VERSION);
5054MODULE_LICENSE("GPL");
5055