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