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