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