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