]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/bluetooth/btusb.c
projects / mirror_ubuntu-bionic-kernel.git / blob
? search:


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