projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Bluetooth: Consolidate whitelist debugfs entry into device_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
28 #include <net/bluetooth/bluetooth.h>
29 #include <net/bluetooth/hci_core.h>
30
31 #define VERSION "0.6"
32
33 static bool disable_scofix;
34 static bool force_scofix;
35
36 static bool reset = 1;
37
38 static struct usb_driver btusb_driver;
39
40 #define BTUSB_IGNORE 0x01
41 #define BTUSB_DIGIANSWER 0x02
42 #define BTUSB_CSR 0x04
43 #define BTUSB_SNIFFER 0x08
44 #define BTUSB_BCM92035 0x10
45 #define BTUSB_BROKEN_ISOC 0x20
46 #define BTUSB_WRONG_SCO_MTU 0x40
47 #define BTUSB_ATH3012 0x80
48 #define BTUSB_INTEL 0x100
49 #define BTUSB_INTEL_BOOT 0x200
50 #define BTUSB_BCM_PATCHRAM 0x400
51 #define BTUSB_MARVELL 0x800
52
53 static const struct usb_device_id btusb_table[] = {
54 /* Generic Bluetooth USB device */
55 { USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
56
57 /* Apple-specific (Broadcom) devices */
58 { USB_VENDOR_AND_INTERFACE_INFO(0x05ac, 0xff, 0x01, 0x01) },
59
60 /* MediaTek MT76x0E */
61 { USB_DEVICE(0x0e8d, 0x763f) },
62
63 /* Broadcom SoftSailing reporting vendor specific */
64 { USB_DEVICE(0x0a5c, 0x21e1) },
65
66 /* Apple MacBookPro 7,1 */
67 { USB_DEVICE(0x05ac, 0x8213) },
68
69 /* Apple iMac11,1 */
70 { USB_DEVICE(0x05ac, 0x8215) },
71
72 /* Apple MacBookPro6,2 */
73 { USB_DEVICE(0x05ac, 0x8218) },
74
75 /* Apple MacBookAir3,1, MacBookAir3,2 */
76 { USB_DEVICE(0x05ac, 0x821b) },
77
78 /* Apple MacBookAir4,1 */
79 { USB_DEVICE(0x05ac, 0x821f) },
80
81 /* Apple MacBookPro8,2 */
82 { USB_DEVICE(0x05ac, 0x821a) },
83
84 /* Apple MacMini5,1 */
85 { USB_DEVICE(0x05ac, 0x8281) },
86
87 /* AVM BlueFRITZ! USB v2.0 */
88 { USB_DEVICE(0x057c, 0x3800) },
89
90 /* Bluetooth Ultraport Module from IBM */
91 { USB_DEVICE(0x04bf, 0x030a) },
92
93 /* ALPS Modules with non-standard id */
94 { USB_DEVICE(0x044e, 0x3001) },
95 { USB_DEVICE(0x044e, 0x3002) },
96
97 /* Ericsson with non-standard id */
98 { USB_DEVICE(0x0bdb, 0x1002) },
99
100 /* Canyon CN-BTU1 with HID interfaces */
101 { USB_DEVICE(0x0c10, 0x0000) },
102
103 /* Broadcom BCM20702A0 */
104 { USB_DEVICE(0x0489, 0xe042) },
105 { USB_DEVICE(0x04ca, 0x2003) },
106 { USB_DEVICE(0x0b05, 0x17b5) },
107 { USB_DEVICE(0x0b05, 0x17cb) },
108 { USB_DEVICE(0x413c, 0x8197) },
109
110 /* Foxconn - Hon Hai */
111 { USB_VENDOR_AND_INTERFACE_INFO(0x0489, 0xff, 0x01, 0x01) },
112
113 /* Broadcom devices with vendor specific id */
114 { USB_VENDOR_AND_INTERFACE_INFO(0x0a5c, 0xff, 0x01, 0x01),
115 .driver_info = BTUSB_BCM_PATCHRAM },
116
117 /* ASUSTek Computer - Broadcom based */
118 { USB_VENDOR_AND_INTERFACE_INFO(0x0b05, 0xff, 0x01, 0x01) },
119
120 /* Belkin F8065bf - Broadcom based */
121 { USB_VENDOR_AND_INTERFACE_INFO(0x050d, 0xff, 0x01, 0x01) },
122
123 /* IMC Networks - Broadcom based */
124 { USB_VENDOR_AND_INTERFACE_INFO(0x13d3, 0xff, 0x01, 0x01) },
125
126 /* Intel Bluetooth USB Bootloader (RAM module) */
127 { USB_DEVICE(0x8087, 0x0a5a),
128 .driver_info = BTUSB_INTEL_BOOT | BTUSB_BROKEN_ISOC },
129
130 { } /* Terminating entry */
131 };
132
133 MODULE_DEVICE_TABLE(usb, btusb_table);
134
135 static const struct usb_device_id blacklist_table[] = {
136 /* CSR BlueCore devices */
137 { USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
138
139 /* Broadcom BCM2033 without firmware */
140 { USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
141
142 /* Atheros 3011 with sflash firmware */
143 { USB_DEVICE(0x0489, 0xe027), .driver_info = BTUSB_IGNORE },
144 { USB_DEVICE(0x0489, 0xe03d), .driver_info = BTUSB_IGNORE },
145 { USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
146 { USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
147 { USB_DEVICE(0x0cf3, 0xe019), .driver_info = BTUSB_IGNORE },
148 { USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
149
150 /* Atheros AR9285 Malbec with sflash firmware */
151 { USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
152
153 /* Atheros 3012 with sflash firmware */
154 { USB_DEVICE(0x0489, 0xe04d), .driver_info = BTUSB_ATH3012 },
155 { USB_DEVICE(0x0489, 0xe04e), .driver_info = BTUSB_ATH3012 },
156 { USB_DEVICE(0x0489, 0xe056), .driver_info = BTUSB_ATH3012 },
157 { USB_DEVICE(0x0489, 0xe057), .driver_info = BTUSB_ATH3012 },
158 { USB_DEVICE(0x0489, 0xe05f), .driver_info = BTUSB_ATH3012 },
159 { USB_DEVICE(0x0489, 0xe078), .driver_info = BTUSB_ATH3012 },
160 { USB_DEVICE(0x04c5, 0x1330), .driver_info = BTUSB_ATH3012 },
161 { USB_DEVICE(0x04ca, 0x3004), .driver_info = BTUSB_ATH3012 },
162 { USB_DEVICE(0x04ca, 0x3005), .driver_info = BTUSB_ATH3012 },
163 { USB_DEVICE(0x04ca, 0x3006), .driver_info = BTUSB_ATH3012 },
164 { USB_DEVICE(0x04ca, 0x3007), .driver_info = BTUSB_ATH3012 },
165 { USB_DEVICE(0x04ca, 0x3008), .driver_info = BTUSB_ATH3012 },
166 { USB_DEVICE(0x04ca, 0x300b), .driver_info = BTUSB_ATH3012 },
167 { USB_DEVICE(0x0930, 0x0219), .driver_info = BTUSB_ATH3012 },
168 { USB_DEVICE(0x0930, 0x0220), .driver_info = BTUSB_ATH3012 },
169 { USB_DEVICE(0x0930, 0x0227), .driver_info = BTUSB_ATH3012 },
170 { USB_DEVICE(0x0b05, 0x17d0), .driver_info = BTUSB_ATH3012 },
171 { USB_DEVICE(0x0cf3, 0x0036), .driver_info = BTUSB_ATH3012 },
172 { USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
173 { USB_DEVICE(0x0cf3, 0x3008), .driver_info = BTUSB_ATH3012 },
174 { USB_DEVICE(0x0cf3, 0x311d), .driver_info = BTUSB_ATH3012 },
175 { USB_DEVICE(0x0cf3, 0x311e), .driver_info = BTUSB_ATH3012 },
176 { USB_DEVICE(0x0cf3, 0x311f), .driver_info = BTUSB_ATH3012 },
177 { USB_DEVICE(0x0cf3, 0x3121), .driver_info = BTUSB_ATH3012 },
178 { USB_DEVICE(0x0cf3, 0x817a), .driver_info = BTUSB_ATH3012 },
179 { USB_DEVICE(0x0cf3, 0xe003), .driver_info = BTUSB_ATH3012 },
180 { USB_DEVICE(0x0cf3, 0xe004), .driver_info = BTUSB_ATH3012 },
181 { USB_DEVICE(0x0cf3, 0xe005), .driver_info = BTUSB_ATH3012 },
182 { USB_DEVICE(0x13d3, 0x3362), .driver_info = BTUSB_ATH3012 },
183 { USB_DEVICE(0x13d3, 0x3375), .driver_info = BTUSB_ATH3012 },
184 { USB_DEVICE(0x13d3, 0x3393), .driver_info = BTUSB_ATH3012 },
185 { USB_DEVICE(0x13d3, 0x3402), .driver_info = BTUSB_ATH3012 },
186 { USB_DEVICE(0x13d3, 0x3432), .driver_info = BTUSB_ATH3012 },
187
188 /* Atheros AR5BBU12 with sflash firmware */
189 { USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
190
191 /* Atheros AR5BBU12 with sflash firmware */
192 { USB_DEVICE(0x0489, 0xe036), .driver_info = BTUSB_ATH3012 },
193 { USB_DEVICE(0x0489, 0xe03c), .driver_info = BTUSB_ATH3012 },
194
195 /* Broadcom BCM2035 */
196 { USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
197 { USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
198 { USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
199
200 /* Broadcom BCM2045 */
201 { USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
202 { USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
203
204 /* IBM/Lenovo ThinkPad with Broadcom chip */
205 { USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
206 { USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
207
208 /* HP laptop with Broadcom chip */
209 { USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
210
211 /* Dell laptop with Broadcom chip */
212 { USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
213
214 /* Dell Wireless 370 and 410 devices */
215 { USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
216 { USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
217
218 /* Belkin F8T012 and F8T013 devices */
219 { USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
220 { USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
221
222 /* Asus WL-BTD202 device */
223 { USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
224
225 /* Kensington Bluetooth USB adapter */
226 { USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
227
228 /* RTX Telecom based adapters with buggy SCO support */
229 { USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
230 { USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
231
232 /* CONWISE Technology based adapters with buggy SCO support */
233 { USB_DEVICE(0x0e5e, 0x6622), .driver_info = BTUSB_BROKEN_ISOC },
234
235 /* Digianswer devices */
236 { USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
237 { USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
238
239 /* CSR BlueCore Bluetooth Sniffer */
240 { USB_DEVICE(0x0a12, 0x0002),
241 .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
242
243 /* Frontline ComProbe Bluetooth Sniffer */
244 { USB_DEVICE(0x16d3, 0x0002),
245 .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
246
247 /* Intel Bluetooth device */
248 { USB_DEVICE(0x8087, 0x07dc), .driver_info = BTUSB_INTEL },
249 { USB_DEVICE(0x8087, 0x0a2a), .driver_info = BTUSB_INTEL },
250
251 /* Marvell device */
252 { USB_DEVICE(0x1286, 0x2044), .driver_info = BTUSB_MARVELL },
253 { USB_DEVICE(0x1286, 0x2046), .driver_info = BTUSB_MARVELL },
254
255 { } /* Terminating entry */
256 };
257
258 #define BTUSB_MAX_ISOC_FRAMES 10
259
260 #define BTUSB_INTR_RUNNING 0
261 #define BTUSB_BULK_RUNNING 1
262 #define BTUSB_ISOC_RUNNING 2
263 #define BTUSB_SUSPENDING 3
264 #define BTUSB_DID_ISO_RESUME 4
265
266 struct btusb_data {
267 struct hci_dev *hdev;
268 struct usb_device *udev;
269 struct usb_interface *intf;
270 struct usb_interface *isoc;
271
272 unsigned long flags;
273
274 struct work_struct work;
275 struct work_struct waker;
276
277 struct usb_anchor deferred;
278 struct usb_anchor tx_anchor;
279 int tx_in_flight;
280 spinlock_t txlock;
281
282 struct usb_anchor intr_anchor;
283 struct usb_anchor bulk_anchor;
284 struct usb_anchor isoc_anchor;
285 spinlock_t rxlock;
286
287 struct sk_buff *evt_skb;
288 struct sk_buff *acl_skb;
289 struct sk_buff *sco_skb;
290
291 struct usb_endpoint_descriptor *intr_ep;
292 struct usb_endpoint_descriptor *bulk_tx_ep;
293 struct usb_endpoint_descriptor *bulk_rx_ep;
294 struct usb_endpoint_descriptor *isoc_tx_ep;
295 struct usb_endpoint_descriptor *isoc_rx_ep;
296
297 __u8 cmdreq_type;
298
299 unsigned int sco_num;
300 int isoc_altsetting;
301 int suspend_count;
302 };
303
304 static inline void btusb_free_frags(struct btusb_data *data)
305 {
306 unsigned long flags;
307
308 spin_lock_irqsave(&data->rxlock, flags);
309
310 kfree_skb(data->evt_skb);
311 data->evt_skb = NULL;
312
313 kfree_skb(data->acl_skb);
314 data->acl_skb = NULL;
315
316 kfree_skb(data->sco_skb);
317 data->sco_skb = NULL;
318
319 spin_unlock_irqrestore(&data->rxlock, flags);
320 }
321
322 static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count)
323 {
324 struct sk_buff *skb;
325 int err = 0;
326
327 spin_lock(&data->rxlock);
328 skb = data->evt_skb;
329
330 while (count) {
331 int len;
332
333 if (!skb) {
334 skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC);
335 if (!skb) {
336 err = -ENOMEM;
337 break;
338 }
339
340 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
341 bt_cb(skb)->expect = HCI_EVENT_HDR_SIZE;
342 }
343
344 len = min_t(uint, bt_cb(skb)->expect, count);
345 memcpy(skb_put(skb, len), buffer, len);
346
347 count -= len;
348 buffer += len;
349 bt_cb(skb)->expect -= len;
350
351 if (skb->len == HCI_EVENT_HDR_SIZE) {
352 /* Complete event header */
353 bt_cb(skb)->expect = hci_event_hdr(skb)->plen;
354
355 if (skb_tailroom(skb) < bt_cb(skb)->expect) {
356 kfree_skb(skb);
357 skb = NULL;
358
359 err = -EILSEQ;
360 break;
361 }
362 }
363
364 if (bt_cb(skb)->expect == 0) {
365 /* Complete frame */
366 hci_recv_frame(data->hdev, skb);
367 skb = NULL;
368 }
369 }
370
371 data->evt_skb = skb;
372 spin_unlock(&data->rxlock);
373
374 return err;
375 }
376
377 static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count)
378 {
379 struct sk_buff *skb;
380 int err = 0;
381
382 spin_lock(&data->rxlock);
383 skb = data->acl_skb;
384
385 while (count) {
386 int len;
387
388 if (!skb) {
389 skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
390 if (!skb) {
391 err = -ENOMEM;
392 break;
393 }
394
395 bt_cb(skb)->pkt_type = HCI_ACLDATA_PKT;
396 bt_cb(skb)->expect = HCI_ACL_HDR_SIZE;
397 }
398
399 len = min_t(uint, bt_cb(skb)->expect, count);
400 memcpy(skb_put(skb, len), buffer, len);
401
402 count -= len;
403 buffer += len;
404 bt_cb(skb)->expect -= len;
405
406 if (skb->len == HCI_ACL_HDR_SIZE) {
407 __le16 dlen = hci_acl_hdr(skb)->dlen;
408
409 /* Complete ACL header */
410 bt_cb(skb)->expect = __le16_to_cpu(dlen);
411
412 if (skb_tailroom(skb) < bt_cb(skb)->expect) {
413 kfree_skb(skb);
414 skb = NULL;
415
416 err = -EILSEQ;
417 break;
418 }
419 }
420
421 if (bt_cb(skb)->expect == 0) {
422 /* Complete frame */
423 hci_recv_frame(data->hdev, skb);
424 skb = NULL;
425 }
426 }
427
428 data->acl_skb = skb;
429 spin_unlock(&data->rxlock);
430
431 return err;
432 }
433
434 static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count)
435 {
436 struct sk_buff *skb;
437 int err = 0;
438
439 spin_lock(&data->rxlock);
440 skb = data->sco_skb;
441
442 while (count) {
443 int len;
444
445 if (!skb) {
446 skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC);
447 if (!skb) {
448 err = -ENOMEM;
449 break;
450 }
451
452 bt_cb(skb)->pkt_type = HCI_SCODATA_PKT;
453 bt_cb(skb)->expect = HCI_SCO_HDR_SIZE;
454 }
455
456 len = min_t(uint, bt_cb(skb)->expect, count);
457 memcpy(skb_put(skb, len), buffer, len);
458
459 count -= len;
460 buffer += len;
461 bt_cb(skb)->expect -= len;
462
463 if (skb->len == HCI_SCO_HDR_SIZE) {
464 /* Complete SCO header */
465 bt_cb(skb)->expect = hci_sco_hdr(skb)->dlen;
466
467 if (skb_tailroom(skb) < bt_cb(skb)->expect) {
468 kfree_skb(skb);
469 skb = NULL;
470
471 err = -EILSEQ;
472 break;
473 }
474 }
475
476 if (bt_cb(skb)->expect == 0) {
477 /* Complete frame */
478 hci_recv_frame(data->hdev, skb);
479 skb = NULL;
480 }
481 }
482
483 data->sco_skb = skb;
484 spin_unlock(&data->rxlock);
485
486 return err;
487 }
488
489 static void btusb_intr_complete(struct urb *urb)
490 {
491 struct hci_dev *hdev = urb->context;
492 struct btusb_data *data = hci_get_drvdata(hdev);
493 int err;
494
495 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
496 urb->actual_length);
497
498 if (!test_bit(HCI_RUNNING, &hdev->flags))
499 return;
500
501 if (urb->status == 0) {
502 hdev->stat.byte_rx += urb->actual_length;
503
504 if (btusb_recv_intr(data, urb->transfer_buffer,
505 urb->actual_length) < 0) {
506 BT_ERR("%s corrupted event packet", hdev->name);
507 hdev->stat.err_rx++;
508 }
509 } else if (urb->status == -ENOENT) {
510 /* Avoid suspend failed when usb_kill_urb */
511 return;
512 }
513
514 if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
515 return;
516
517 usb_mark_last_busy(data->udev);
518 usb_anchor_urb(urb, &data->intr_anchor);
519
520 err = usb_submit_urb(urb, GFP_ATOMIC);
521 if (err < 0) {
522 /* -EPERM: urb is being killed;
523 * -ENODEV: device got disconnected */
524 if (err != -EPERM && err != -ENODEV)
525 BT_ERR("%s urb %p failed to resubmit (%d)",
526 hdev->name, urb, -err);
527 usb_unanchor_urb(urb);
528 }
529 }
530
531 static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
532 {
533 struct btusb_data *data = hci_get_drvdata(hdev);
534 struct urb *urb;
535 unsigned char *buf;
536 unsigned int pipe;
537 int err, size;
538
539 BT_DBG("%s", hdev->name);
540
541 if (!data->intr_ep)
542 return -ENODEV;
543
544 urb = usb_alloc_urb(0, mem_flags);
545 if (!urb)
546 return -ENOMEM;
547
548 size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
549
550 buf = kmalloc(size, mem_flags);
551 if (!buf) {
552 usb_free_urb(urb);
553 return -ENOMEM;
554 }
555
556 pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
557
558 usb_fill_int_urb(urb, data->udev, pipe, buf, size,
559 btusb_intr_complete, hdev, data->intr_ep->bInterval);
560
561 urb->transfer_flags |= URB_FREE_BUFFER;
562
563 usb_anchor_urb(urb, &data->intr_anchor);
564
565 err = usb_submit_urb(urb, mem_flags);
566 if (err < 0) {
567 if (err != -EPERM && err != -ENODEV)
568 BT_ERR("%s urb %p submission failed (%d)",
569 hdev->name, urb, -err);
570 usb_unanchor_urb(urb);
571 }
572
573 usb_free_urb(urb);
574
575 return err;
576 }
577
578 static void btusb_bulk_complete(struct urb *urb)
579 {
580 struct hci_dev *hdev = urb->context;
581 struct btusb_data *data = hci_get_drvdata(hdev);
582 int err;
583
584 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
585 urb->actual_length);
586
587 if (!test_bit(HCI_RUNNING, &hdev->flags))
588 return;
589
590 if (urb->status == 0) {
591 hdev->stat.byte_rx += urb->actual_length;
592
593 if (btusb_recv_bulk(data, urb->transfer_buffer,
594 urb->actual_length) < 0) {
595 BT_ERR("%s corrupted ACL packet", hdev->name);
596 hdev->stat.err_rx++;
597 }
598 } else if (urb->status == -ENOENT) {
599 /* Avoid suspend failed when usb_kill_urb */
600 return;
601 }
602
603 if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
604 return;
605
606 usb_anchor_urb(urb, &data->bulk_anchor);
607 usb_mark_last_busy(data->udev);
608
609 err = usb_submit_urb(urb, GFP_ATOMIC);
610 if (err < 0) {
611 /* -EPERM: urb is being killed;
612 * -ENODEV: device got disconnected */
613 if (err != -EPERM && err != -ENODEV)
614 BT_ERR("%s urb %p failed to resubmit (%d)",
615 hdev->name, urb, -err);
616 usb_unanchor_urb(urb);
617 }
618 }
619
620 static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
621 {
622 struct btusb_data *data = hci_get_drvdata(hdev);
623 struct urb *urb;
624 unsigned char *buf;
625 unsigned int pipe;
626 int err, size = HCI_MAX_FRAME_SIZE;
627
628 BT_DBG("%s", hdev->name);
629
630 if (!data->bulk_rx_ep)
631 return -ENODEV;
632
633 urb = usb_alloc_urb(0, mem_flags);
634 if (!urb)
635 return -ENOMEM;
636
637 buf = kmalloc(size, mem_flags);
638 if (!buf) {
639 usb_free_urb(urb);
640 return -ENOMEM;
641 }
642
643 pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
644
645 usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
646 btusb_bulk_complete, hdev);
647
648 urb->transfer_flags |= URB_FREE_BUFFER;
649
650 usb_mark_last_busy(data->udev);
651 usb_anchor_urb(urb, &data->bulk_anchor);
652
653 err = usb_submit_urb(urb, mem_flags);
654 if (err < 0) {
655 if (err != -EPERM && err != -ENODEV)
656 BT_ERR("%s urb %p submission failed (%d)",
657 hdev->name, urb, -err);
658 usb_unanchor_urb(urb);
659 }
660
661 usb_free_urb(urb);
662
663 return err;
664 }
665
666 static void btusb_isoc_complete(struct urb *urb)
667 {
668 struct hci_dev *hdev = urb->context;
669 struct btusb_data *data = hci_get_drvdata(hdev);
670 int i, err;
671
672 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
673 urb->actual_length);
674
675 if (!test_bit(HCI_RUNNING, &hdev->flags))
676 return;
677
678 if (urb->status == 0) {
679 for (i = 0; i < urb->number_of_packets; i++) {
680 unsigned int offset = urb->iso_frame_desc[i].offset;
681 unsigned int length = urb->iso_frame_desc[i].actual_length;
682
683 if (urb->iso_frame_desc[i].status)
684 continue;
685
686 hdev->stat.byte_rx += length;
687
688 if (btusb_recv_isoc(data, urb->transfer_buffer + offset,
689 length) < 0) {
690 BT_ERR("%s corrupted SCO packet", hdev->name);
691 hdev->stat.err_rx++;
692 }
693 }
694 } else if (urb->status == -ENOENT) {
695 /* Avoid suspend failed when usb_kill_urb */
696 return;
697 }
698
699 if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
700 return;
701
702 usb_anchor_urb(urb, &data->isoc_anchor);
703
704 err = usb_submit_urb(urb, GFP_ATOMIC);
705 if (err < 0) {
706 /* -EPERM: urb is being killed;
707 * -ENODEV: device got disconnected */
708 if (err != -EPERM && err != -ENODEV)
709 BT_ERR("%s urb %p failed to resubmit (%d)",
710 hdev->name, urb, -err);
711 usb_unanchor_urb(urb);
712 }
713 }
714
715 static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
716 {
717 int i, offset = 0;
718
719 BT_DBG("len %d mtu %d", len, mtu);
720
721 for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
722 i++, offset += mtu, len -= mtu) {
723 urb->iso_frame_desc[i].offset = offset;
724 urb->iso_frame_desc[i].length = mtu;
725 }
726
727 if (len && i < BTUSB_MAX_ISOC_FRAMES) {
728 urb->iso_frame_desc[i].offset = offset;
729 urb->iso_frame_desc[i].length = len;
730 i++;
731 }
732
733 urb->number_of_packets = i;
734 }
735
736 static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
737 {
738 struct btusb_data *data = hci_get_drvdata(hdev);
739 struct urb *urb;
740 unsigned char *buf;
741 unsigned int pipe;
742 int err, size;
743
744 BT_DBG("%s", hdev->name);
745
746 if (!data->isoc_rx_ep)
747 return -ENODEV;
748
749 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
750 if (!urb)
751 return -ENOMEM;
752
753 size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
754 BTUSB_MAX_ISOC_FRAMES;
755
756 buf = kmalloc(size, mem_flags);
757 if (!buf) {
758 usb_free_urb(urb);
759 return -ENOMEM;
760 }
761
762 pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
763
764 usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_isoc_complete,
765 hdev, data->isoc_rx_ep->bInterval);
766
767 urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
768
769 __fill_isoc_descriptor(urb, size,
770 le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
771
772 usb_anchor_urb(urb, &data->isoc_anchor);
773
774 err = usb_submit_urb(urb, mem_flags);
775 if (err < 0) {
776 if (err != -EPERM && err != -ENODEV)
777 BT_ERR("%s urb %p submission failed (%d)",
778 hdev->name, urb, -err);
779 usb_unanchor_urb(urb);
780 }
781
782 usb_free_urb(urb);
783
784 return err;
785 }
786
787 static void btusb_tx_complete(struct urb *urb)
788 {
789 struct sk_buff *skb = urb->context;
790 struct hci_dev *hdev = (struct hci_dev *)skb->dev;
791 struct btusb_data *data = hci_get_drvdata(hdev);
792
793 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
794 urb->actual_length);
795
796 if (!test_bit(HCI_RUNNING, &hdev->flags))
797 goto done;
798
799 if (!urb->status)
800 hdev->stat.byte_tx += urb->transfer_buffer_length;
801 else
802 hdev->stat.err_tx++;
803
804 done:
805 spin_lock(&data->txlock);
806 data->tx_in_flight--;
807 spin_unlock(&data->txlock);
808
809 kfree(urb->setup_packet);
810
811 kfree_skb(skb);
812 }
813
814 static void btusb_isoc_tx_complete(struct urb *urb)
815 {
816 struct sk_buff *skb = urb->context;
817 struct hci_dev *hdev = (struct hci_dev *)skb->dev;
818
819 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
820 urb->actual_length);
821
822 if (!test_bit(HCI_RUNNING, &hdev->flags))
823 goto done;
824
825 if (!urb->status)
826 hdev->stat.byte_tx += urb->transfer_buffer_length;
827 else
828 hdev->stat.err_tx++;
829
830 done:
831 kfree(urb->setup_packet);
832
833 kfree_skb(skb);
834 }
835
836 static int btusb_open(struct hci_dev *hdev)
837 {
838 struct btusb_data *data = hci_get_drvdata(hdev);
839 int err;
840
841 BT_DBG("%s", hdev->name);
842
843 err = usb_autopm_get_interface(data->intf);
844 if (err < 0)
845 return err;
846
847 data->intf->needs_remote_wakeup = 1;
848
849 if (test_and_set_bit(HCI_RUNNING, &hdev->flags))
850 goto done;
851
852 if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
853 goto done;
854
855 err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
856 if (err < 0)
857 goto failed;
858
859 err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
860 if (err < 0) {
861 usb_kill_anchored_urbs(&data->intr_anchor);
862 goto failed;
863 }
864
865 set_bit(BTUSB_BULK_RUNNING, &data->flags);
866 btusb_submit_bulk_urb(hdev, GFP_KERNEL);
867
868 done:
869 usb_autopm_put_interface(data->intf);
870 return 0;
871
872 failed:
873 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
874 clear_bit(HCI_RUNNING, &hdev->flags);
875 usb_autopm_put_interface(data->intf);
876 return err;
877 }
878
879 static void btusb_stop_traffic(struct btusb_data *data)
880 {
881 usb_kill_anchored_urbs(&data->intr_anchor);
882 usb_kill_anchored_urbs(&data->bulk_anchor);
883 usb_kill_anchored_urbs(&data->isoc_anchor);
884 }
885
886 static int btusb_close(struct hci_dev *hdev)
887 {
888 struct btusb_data *data = hci_get_drvdata(hdev);
889 int err;
890
891 BT_DBG("%s", hdev->name);
892
893 if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
894 return 0;
895
896 cancel_work_sync(&data->work);
897 cancel_work_sync(&data->waker);
898
899 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
900 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
901 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
902
903 btusb_stop_traffic(data);
904 btusb_free_frags(data);
905
906 err = usb_autopm_get_interface(data->intf);
907 if (err < 0)
908 goto failed;
909
910 data->intf->needs_remote_wakeup = 0;
911 usb_autopm_put_interface(data->intf);
912
913 failed:
914 usb_scuttle_anchored_urbs(&data->deferred);
915 return 0;
916 }
917
918 static int btusb_flush(struct hci_dev *hdev)
919 {
920 struct btusb_data *data = hci_get_drvdata(hdev);
921
922 BT_DBG("%s", hdev->name);
923
924 usb_kill_anchored_urbs(&data->tx_anchor);
925 btusb_free_frags(data);
926
927 return 0;
928 }
929
930 static struct urb *alloc_ctrl_urb(struct hci_dev *hdev, struct sk_buff *skb)
931 {
932 struct btusb_data *data = hci_get_drvdata(hdev);
933 struct usb_ctrlrequest *dr;
934 struct urb *urb;
935 unsigned int pipe;
936
937 urb = usb_alloc_urb(0, GFP_KERNEL);
938 if (!urb)
939 return ERR_PTR(-ENOMEM);
940
941 dr = kmalloc(sizeof(*dr), GFP_KERNEL);
942 if (!dr) {
943 usb_free_urb(urb);
944 return ERR_PTR(-ENOMEM);
945 }
946
947 dr->bRequestType = data->cmdreq_type;
948 dr->bRequest = 0;
949 dr->wIndex = 0;
950 dr->wValue = 0;
951 dr->wLength = __cpu_to_le16(skb->len);
952
953 pipe = usb_sndctrlpipe(data->udev, 0x00);
954
955 usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
956 skb->data, skb->len, btusb_tx_complete, skb);
957
958 skb->dev = (void *)hdev;
959
960 return urb;
961 }
962
963 static struct urb *alloc_bulk_urb(struct hci_dev *hdev, struct sk_buff *skb)
964 {
965 struct btusb_data *data = hci_get_drvdata(hdev);
966 struct urb *urb;
967 unsigned int pipe;
968
969 if (!data->bulk_tx_ep)
970 return ERR_PTR(-ENODEV);
971
972 urb = usb_alloc_urb(0, GFP_KERNEL);
973 if (!urb)
974 return ERR_PTR(-ENOMEM);
975
976 pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress);
977
978 usb_fill_bulk_urb(urb, data->udev, pipe,
979 skb->data, skb->len, btusb_tx_complete, skb);
980
981 skb->dev = (void *)hdev;
982
983 return urb;
984 }
985
986 static struct urb *alloc_isoc_urb(struct hci_dev *hdev, struct sk_buff *skb)
987 {
988 struct btusb_data *data = hci_get_drvdata(hdev);
989 struct urb *urb;
990 unsigned int pipe;
991
992 if (!data->isoc_tx_ep)
993 return ERR_PTR(-ENODEV);
994
995 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_KERNEL);
996 if (!urb)
997 return ERR_PTR(-ENOMEM);
998
999 pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress);
1000
1001 usb_fill_int_urb(urb, data->udev, pipe,
1002 skb->data, skb->len, btusb_isoc_tx_complete,
1003 skb, data->isoc_tx_ep->bInterval);
1004
1005 urb->transfer_flags = URB_ISO_ASAP;
1006
1007 __fill_isoc_descriptor(urb, skb->len,
1008 le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
1009
1010 skb->dev = (void *)hdev;
1011
1012 return urb;
1013 }
1014
1015 static int submit_tx_urb(struct hci_dev *hdev, struct urb *urb)
1016 {
1017 struct btusb_data *data = hci_get_drvdata(hdev);
1018 int err;
1019
1020 usb_anchor_urb(urb, &data->tx_anchor);
1021
1022 err = usb_submit_urb(urb, GFP_KERNEL);
1023 if (err < 0) {
1024 if (err != -EPERM && err != -ENODEV)
1025 BT_ERR("%s urb %p submission failed (%d)",
1026 hdev->name, urb, -err);
1027 kfree(urb->setup_packet);
1028 usb_unanchor_urb(urb);
1029 } else {
1030 usb_mark_last_busy(data->udev);
1031 }
1032
1033 usb_free_urb(urb);
1034 return err;
1035 }
1036
1037 static int submit_or_queue_tx_urb(struct hci_dev *hdev, struct urb *urb)
1038 {
1039 struct btusb_data *data = hci_get_drvdata(hdev);
1040 unsigned long flags;
1041 bool suspending;
1042
1043 spin_lock_irqsave(&data->txlock, flags);
1044 suspending = test_bit(BTUSB_SUSPENDING, &data->flags);
1045 if (!suspending)
1046 data->tx_in_flight++;
1047 spin_unlock_irqrestore(&data->txlock, flags);
1048
1049 if (!suspending)
1050 return submit_tx_urb(hdev, urb);
1051
1052 usb_anchor_urb(urb, &data->deferred);
1053 schedule_work(&data->waker);
1054
1055 usb_free_urb(urb);
1056 return 0;
1057 }
1058
1059 static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
1060 {
1061 struct urb *urb;
1062
1063 BT_DBG("%s", hdev->name);
1064
1065 if (!test_bit(HCI_RUNNING, &hdev->flags))
1066 return -EBUSY;
1067
1068 switch (bt_cb(skb)->pkt_type) {
1069 case HCI_COMMAND_PKT:
1070 urb = alloc_ctrl_urb(hdev, skb);
1071 if (IS_ERR(urb))
1072 return PTR_ERR(urb);
1073
1074 hdev->stat.cmd_tx++;
1075 return submit_or_queue_tx_urb(hdev, urb);
1076
1077 case HCI_ACLDATA_PKT:
1078 urb = alloc_bulk_urb(hdev, skb);
1079 if (IS_ERR(urb))
1080 return PTR_ERR(urb);
1081
1082 hdev->stat.acl_tx++;
1083 return submit_or_queue_tx_urb(hdev, urb);
1084
1085 case HCI_SCODATA_PKT:
1086 if (hci_conn_num(hdev, SCO_LINK) < 1)
1087 return -ENODEV;
1088
1089 urb = alloc_isoc_urb(hdev, skb);
1090 if (IS_ERR(urb))
1091 return PTR_ERR(urb);
1092
1093 hdev->stat.sco_tx++;
1094 return submit_tx_urb(hdev, urb);
1095 }
1096
1097 return -EILSEQ;
1098 }
1099
1100 static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
1101 {
1102 struct btusb_data *data = hci_get_drvdata(hdev);
1103
1104 BT_DBG("%s evt %d", hdev->name, evt);
1105
1106 if (hci_conn_num(hdev, SCO_LINK) != data->sco_num) {
1107 data->sco_num = hci_conn_num(hdev, SCO_LINK);
1108 schedule_work(&data->work);
1109 }
1110 }
1111
1112 static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
1113 {
1114 struct btusb_data *data = hci_get_drvdata(hdev);
1115 struct usb_interface *intf = data->isoc;
1116 struct usb_endpoint_descriptor *ep_desc;
1117 int i, err;
1118
1119 if (!data->isoc)
1120 return -ENODEV;
1121
1122 err = usb_set_interface(data->udev, 1, altsetting);
1123 if (err < 0) {
1124 BT_ERR("%s setting interface failed (%d)", hdev->name, -err);
1125 return err;
1126 }
1127
1128 data->isoc_altsetting = altsetting;
1129
1130 data->isoc_tx_ep = NULL;
1131 data->isoc_rx_ep = NULL;
1132
1133 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1134 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1135
1136 if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
1137 data->isoc_tx_ep = ep_desc;
1138 continue;
1139 }
1140
1141 if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
1142 data->isoc_rx_ep = ep_desc;
1143 continue;
1144 }
1145 }
1146
1147 if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
1148 BT_ERR("%s invalid SCO descriptors", hdev->name);
1149 return -ENODEV;
1150 }
1151
1152 return 0;
1153 }
1154
1155 static void btusb_work(struct work_struct *work)
1156 {
1157 struct btusb_data *data = container_of(work, struct btusb_data, work);
1158 struct hci_dev *hdev = data->hdev;
1159 int new_alts;
1160 int err;
1161
1162 if (data->sco_num > 0) {
1163 if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
1164 err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
1165 if (err < 0) {
1166 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1167 usb_kill_anchored_urbs(&data->isoc_anchor);
1168 return;
1169 }
1170
1171 set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
1172 }
1173
1174 if (hdev->voice_setting & 0x0020) {
1175 static const int alts[3] = { 2, 4, 5 };
1176
1177 new_alts = alts[data->sco_num - 1];
1178 } else {
1179 new_alts = data->sco_num;
1180 }
1181
1182 if (data->isoc_altsetting != new_alts) {
1183 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1184 usb_kill_anchored_urbs(&data->isoc_anchor);
1185
1186 if (__set_isoc_interface(hdev, new_alts) < 0)
1187 return;
1188 }
1189
1190 if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
1191 if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
1192 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1193 else
1194 btusb_submit_isoc_urb(hdev, GFP_KERNEL);
1195 }
1196 } else {
1197 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1198 usb_kill_anchored_urbs(&data->isoc_anchor);
1199
1200 __set_isoc_interface(hdev, 0);
1201 if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
1202 usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
1203 }
1204 }
1205
1206 static void btusb_waker(struct work_struct *work)
1207 {
1208 struct btusb_data *data = container_of(work, struct btusb_data, waker);
1209 int err;
1210
1211 err = usb_autopm_get_interface(data->intf);
1212 if (err < 0)
1213 return;
1214
1215 usb_autopm_put_interface(data->intf);
1216 }
1217
1218 static int btusb_setup_bcm92035(struct hci_dev *hdev)
1219 {
1220 struct sk_buff *skb;
1221 u8 val = 0x00;
1222
1223 BT_DBG("%s", hdev->name);
1224
1225 skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);
1226 if (IS_ERR(skb))
1227 BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb));
1228 else
1229 kfree_skb(skb);
1230
1231 return 0;
1232 }
1233
1234 static int btusb_setup_csr(struct hci_dev *hdev)
1235 {
1236 struct hci_rp_read_local_version *rp;
1237 struct sk_buff *skb;
1238 int ret;
1239
1240 BT_DBG("%s", hdev->name);
1241
1242 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1243 HCI_INIT_TIMEOUT);
1244 if (IS_ERR(skb)) {
1245 BT_ERR("Reading local version failed (%ld)", -PTR_ERR(skb));
1246 return -PTR_ERR(skb);
1247 }
1248
1249 rp = (struct hci_rp_read_local_version *)skb->data;
1250
1251 if (!rp->status) {
1252 if (le16_to_cpu(rp->manufacturer) != 10) {
1253 /* Clear the reset quirk since this is not an actual
1254 * early Bluetooth 1.1 device from CSR.
1255 */
1256 clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
1257
1258 /* These fake CSR controllers have all a broken
1259 * stored link key handling and so just disable it.
1260 */
1261 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY,
1262 &hdev->quirks);
1263 }
1264 }
1265
1266 ret = -bt_to_errno(rp->status);
1267
1268 kfree_skb(skb);
1269
1270 return ret;
1271 }
1272
1273 struct intel_version {
1274 u8 status;
1275 u8 hw_platform;
1276 u8 hw_variant;
1277 u8 hw_revision;
1278 u8 fw_variant;
1279 u8 fw_revision;
1280 u8 fw_build_num;
1281 u8 fw_build_ww;
1282 u8 fw_build_yy;
1283 u8 fw_patch_num;
1284 } __packed;
1285
1286 static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev,
1287 struct intel_version *ver)
1288 {
1289 const struct firmware *fw;
1290 char fwname[64];
1291 int ret;
1292
1293 snprintf(fwname, sizeof(fwname),
1294 "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq",
1295 ver->hw_platform, ver->hw_variant, ver->hw_revision,
1296 ver->fw_variant, ver->fw_revision, ver->fw_build_num,
1297 ver->fw_build_ww, ver->fw_build_yy);
1298
1299 ret = request_firmware(&fw, fwname, &hdev->dev);
1300 if (ret < 0) {
1301 if (ret == -EINVAL) {
1302 BT_ERR("%s Intel firmware file request failed (%d)",
1303 hdev->name, ret);
1304 return NULL;
1305 }
1306
1307 BT_ERR("%s failed to open Intel firmware file: %s(%d)",
1308 hdev->name, fwname, ret);
1309
1310 /* If the correct firmware patch file is not found, use the
1311 * default firmware patch file instead
1312 */
1313 snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq",
1314 ver->hw_platform, ver->hw_variant);
1315 if (request_firmware(&fw, fwname, &hdev->dev) < 0) {
1316 BT_ERR("%s failed to open default Intel fw file: %s",
1317 hdev->name, fwname);
1318 return NULL;
1319 }
1320 }
1321
1322 BT_INFO("%s: Intel Bluetooth firmware file: %s", hdev->name, fwname);
1323
1324 return fw;
1325 }
1326
1327 static int btusb_setup_intel_patching(struct hci_dev *hdev,
1328 const struct firmware *fw,
1329 const u8 **fw_ptr, int *disable_patch)
1330 {
1331 struct sk_buff *skb;
1332 struct hci_command_hdr *cmd;
1333 const u8 *cmd_param;
1334 struct hci_event_hdr *evt = NULL;
1335 const u8 *evt_param = NULL;
1336 int remain = fw->size - (*fw_ptr - fw->data);
1337
1338 /* The first byte indicates the types of the patch command or event.
1339 * 0x01 means HCI command and 0x02 is HCI event. If the first bytes
1340 * in the current firmware buffer doesn't start with 0x01 or
1341 * the size of remain buffer is smaller than HCI command header,
1342 * the firmware file is corrupted and it should stop the patching
1343 * process.
1344 */
1345 if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) {
1346 BT_ERR("%s Intel fw corrupted: invalid cmd read", hdev->name);
1347 return -EINVAL;
1348 }
1349 (*fw_ptr)++;
1350 remain--;
1351
1352 cmd = (struct hci_command_hdr *)(*fw_ptr);
1353 *fw_ptr += sizeof(*cmd);
1354 remain -= sizeof(*cmd);
1355
1356 /* Ensure that the remain firmware data is long enough than the length
1357 * of command parameter. If not, the firmware file is corrupted.
1358 */
1359 if (remain < cmd->plen) {
1360 BT_ERR("%s Intel fw corrupted: invalid cmd len", hdev->name);
1361 return -EFAULT;
1362 }
1363
1364 /* If there is a command that loads a patch in the firmware
1365 * file, then enable the patch upon success, otherwise just
1366 * disable the manufacturer mode, for example patch activation
1367 * is not required when the default firmware patch file is used
1368 * because there are no patch data to load.
1369 */
1370 if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e)
1371 *disable_patch = 0;
1372
1373 cmd_param = *fw_ptr;
1374 *fw_ptr += cmd->plen;
1375 remain -= cmd->plen;
1376
1377 /* This reads the expected events when the above command is sent to the
1378 * device. Some vendor commands expects more than one events, for
1379 * example command status event followed by vendor specific event.
1380 * For this case, it only keeps the last expected event. so the command
1381 * can be sent with __hci_cmd_sync_ev() which returns the sk_buff of
1382 * last expected event.
1383 */
1384 while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) {
1385 (*fw_ptr)++;
1386 remain--;
1387
1388 evt = (struct hci_event_hdr *)(*fw_ptr);
1389 *fw_ptr += sizeof(*evt);
1390 remain -= sizeof(*evt);
1391
1392 if (remain < evt->plen) {
1393 BT_ERR("%s Intel fw corrupted: invalid evt len",
1394 hdev->name);
1395 return -EFAULT;
1396 }
1397
1398 evt_param = *fw_ptr;
1399 *fw_ptr += evt->plen;
1400 remain -= evt->plen;
1401 }
1402
1403 /* Every HCI commands in the firmware file has its correspond event.
1404 * If event is not found or remain is smaller than zero, the firmware
1405 * file is corrupted.
1406 */
1407 if (!evt || !evt_param || remain < 0) {
1408 BT_ERR("%s Intel fw corrupted: invalid evt read", hdev->name);
1409 return -EFAULT;
1410 }
1411
1412 skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen,
1413 cmd_param, evt->evt, HCI_INIT_TIMEOUT);
1414 if (IS_ERR(skb)) {
1415 BT_ERR("%s sending Intel patch command (0x%4.4x) failed (%ld)",
1416 hdev->name, cmd->opcode, PTR_ERR(skb));
1417 return PTR_ERR(skb);
1418 }
1419
1420 /* It ensures that the returned event matches the event data read from
1421 * the firmware file. At fist, it checks the length and then
1422 * the contents of the event.
1423 */
1424 if (skb->len != evt->plen) {
1425 BT_ERR("%s mismatch event length (opcode 0x%4.4x)", hdev->name,
1426 le16_to_cpu(cmd->opcode));
1427 kfree_skb(skb);
1428 return -EFAULT;
1429 }
1430
1431 if (memcmp(skb->data, evt_param, evt->plen)) {
1432 BT_ERR("%s mismatch event parameter (opcode 0x%4.4x)",
1433 hdev->name, le16_to_cpu(cmd->opcode));
1434 kfree_skb(skb);
1435 return -EFAULT;
1436 }
1437 kfree_skb(skb);
1438
1439 return 0;
1440 }
1441
1442 #define BDADDR_INTEL (&(bdaddr_t) {{0x00, 0x8b, 0x9e, 0x19, 0x03, 0x00}})
1443
1444 static int btusb_check_bdaddr_intel(struct hci_dev *hdev)
1445 {
1446 struct sk_buff *skb;
1447 struct hci_rp_read_bd_addr *rp;
1448
1449 skb = __hci_cmd_sync(hdev, HCI_OP_READ_BD_ADDR, 0, NULL,
1450 HCI_INIT_TIMEOUT);
1451 if (IS_ERR(skb)) {
1452 BT_ERR("%s reading Intel device address failed (%ld)",
1453 hdev->name, PTR_ERR(skb));
1454 return PTR_ERR(skb);
1455 }
1456
1457 if (skb->len != sizeof(*rp)) {
1458 BT_ERR("%s Intel device address length mismatch", hdev->name);
1459 kfree_skb(skb);
1460 return -EIO;
1461 }
1462
1463 rp = (struct hci_rp_read_bd_addr *)skb->data;
1464 if (rp->status) {
1465 BT_ERR("%s Intel device address result failed (%02x)",
1466 hdev->name, rp->status);
1467 kfree_skb(skb);
1468 return -bt_to_errno(rp->status);
1469 }
1470
1471 /* For some Intel based controllers, the default Bluetooth device
1472 * address 00:03:19:9E:8B:00 can be found. These controllers are
1473 * fully operational, but have the danger of duplicate addresses
1474 * and that in turn can cause problems with Bluetooth operation.
1475 */
1476 if (!bacmp(&rp->bdaddr, BDADDR_INTEL)) {
1477 BT_ERR("%s found Intel default device address (%pMR)",
1478 hdev->name, &rp->bdaddr);
1479 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
1480 }
1481
1482 kfree_skb(skb);
1483
1484 return 0;
1485 }
1486
1487 static int btusb_setup_intel(struct hci_dev *hdev)
1488 {
1489 struct sk_buff *skb;
1490 const struct firmware *fw;
1491 const u8 *fw_ptr;
1492 int disable_patch;
1493 struct intel_version *ver;
1494
1495 const u8 mfg_enable[] = { 0x01, 0x00 };
1496 const u8 mfg_disable[] = { 0x00, 0x00 };
1497 const u8 mfg_reset_deactivate[] = { 0x00, 0x01 };
1498 const u8 mfg_reset_activate[] = { 0x00, 0x02 };
1499
1500 BT_DBG("%s", hdev->name);
1501
1502 /* The controller has a bug with the first HCI command sent to it
1503 * returning number of completed commands as zero. This would stall the
1504 * command processing in the Bluetooth core.
1505 *
1506 * As a workaround, send HCI Reset command first which will reset the
1507 * number of completed commands and allow normal command processing
1508 * from now on.
1509 */
1510 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1511 if (IS_ERR(skb)) {
1512 BT_ERR("%s sending initial HCI reset command failed (%ld)",
1513 hdev->name, PTR_ERR(skb));
1514 return PTR_ERR(skb);
1515 }
1516 kfree_skb(skb);
1517
1518 /* Read Intel specific controller version first to allow selection of
1519 * which firmware file to load.
1520 *
1521 * The returned information are hardware variant and revision plus
1522 * firmware variant, revision and build number.
1523 */
1524 skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT);
1525 if (IS_ERR(skb)) {
1526 BT_ERR("%s reading Intel fw version command failed (%ld)",
1527 hdev->name, PTR_ERR(skb));
1528 return PTR_ERR(skb);
1529 }
1530
1531 if (skb->len != sizeof(*ver)) {
1532 BT_ERR("%s Intel version event length mismatch", hdev->name);
1533 kfree_skb(skb);
1534 return -EIO;
1535 }
1536
1537 ver = (struct intel_version *)skb->data;
1538 if (ver->status) {
1539 BT_ERR("%s Intel fw version event failed (%02x)", hdev->name,
1540 ver->status);
1541 kfree_skb(skb);
1542 return -bt_to_errno(ver->status);
1543 }
1544
1545 BT_INFO("%s: read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x",
1546 hdev->name, ver->hw_platform, ver->hw_variant,
1547 ver->hw_revision, ver->fw_variant, ver->fw_revision,
1548 ver->fw_build_num, ver->fw_build_ww, ver->fw_build_yy,
1549 ver->fw_patch_num);
1550
1551 /* fw_patch_num indicates the version of patch the device currently
1552 * have. If there is no patch data in the device, it is always 0x00.
1553 * So, if it is other than 0x00, no need to patch the deivce again.
1554 */
1555 if (ver->fw_patch_num) {
1556 BT_INFO("%s: Intel device is already patched. patch num: %02x",
1557 hdev->name, ver->fw_patch_num);
1558 kfree_skb(skb);
1559 btusb_check_bdaddr_intel(hdev);
1560 return 0;
1561 }
1562
1563 /* Opens the firmware patch file based on the firmware version read
1564 * from the controller. If it fails to open the matching firmware
1565 * patch file, it tries to open the default firmware patch file.
1566 * If no patch file is found, allow the device to operate without
1567 * a patch.
1568 */
1569 fw = btusb_setup_intel_get_fw(hdev, ver);
1570 if (!fw) {
1571 kfree_skb(skb);
1572 btusb_check_bdaddr_intel(hdev);
1573 return 0;
1574 }
1575 fw_ptr = fw->data;
1576
1577 /* This Intel specific command enables the manufacturer mode of the
1578 * controller.
1579 *
1580 * Only while this mode is enabled, the driver can download the
1581 * firmware patch data and configuration parameters.
1582 */
1583 skb = __hci_cmd_sync(hdev, 0xfc11, 2, mfg_enable, HCI_INIT_TIMEOUT);
1584 if (IS_ERR(skb)) {
1585 BT_ERR("%s entering Intel manufacturer mode failed (%ld)",
1586 hdev->name, PTR_ERR(skb));
1587 release_firmware(fw);
1588 return PTR_ERR(skb);
1589 }
1590
1591 if (skb->data[0]) {
1592 u8 evt_status = skb->data[0];
1593
1594 BT_ERR("%s enable Intel manufacturer mode event failed (%02x)",
1595 hdev->name, evt_status);
1596 kfree_skb(skb);
1597 release_firmware(fw);
1598 return -bt_to_errno(evt_status);
1599 }
1600 kfree_skb(skb);
1601
1602 disable_patch = 1;
1603
1604 /* The firmware data file consists of list of Intel specific HCI
1605 * commands and its expected events. The first byte indicates the
1606 * type of the message, either HCI command or HCI event.
1607 *
1608 * It reads the command and its expected event from the firmware file,
1609 * and send to the controller. Once __hci_cmd_sync_ev() returns,
1610 * the returned event is compared with the event read from the firmware
1611 * file and it will continue until all the messages are downloaded to
1612 * the controller.
1613 *
1614 * Once the firmware patching is completed successfully,
1615 * the manufacturer mode is disabled with reset and activating the
1616 * downloaded patch.
1617 *
1618 * If the firmware patching fails, the manufacturer mode is
1619 * disabled with reset and deactivating the patch.
1620 *
1621 * If the default patch file is used, no reset is done when disabling
1622 * the manufacturer.
1623 */
1624 while (fw->size > fw_ptr - fw->data) {
1625 int ret;
1626
1627 ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr,
1628 &disable_patch);
1629 if (ret < 0)
1630 goto exit_mfg_deactivate;
1631 }
1632
1633 release_firmware(fw);
1634
1635 if (disable_patch)
1636 goto exit_mfg_disable;
1637
1638 /* Patching completed successfully and disable the manufacturer mode
1639 * with reset and activate the downloaded firmware patches.
1640 */
1641 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_activate),
1642 mfg_reset_activate, HCI_INIT_TIMEOUT);
1643 if (IS_ERR(skb)) {
1644 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1645 hdev->name, PTR_ERR(skb));
1646 return PTR_ERR(skb);
1647 }
1648 kfree_skb(skb);
1649
1650 BT_INFO("%s: Intel Bluetooth firmware patch completed and activated",
1651 hdev->name);
1652
1653 btusb_check_bdaddr_intel(hdev);
1654 return 0;
1655
1656 exit_mfg_disable:
1657 /* Disable the manufacturer mode without reset */
1658 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_disable), mfg_disable,
1659 HCI_INIT_TIMEOUT);
1660 if (IS_ERR(skb)) {
1661 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1662 hdev->name, PTR_ERR(skb));
1663 return PTR_ERR(skb);
1664 }
1665 kfree_skb(skb);
1666
1667 BT_INFO("%s: Intel Bluetooth firmware patch completed", hdev->name);
1668
1669 btusb_check_bdaddr_intel(hdev);
1670 return 0;
1671
1672 exit_mfg_deactivate:
1673 release_firmware(fw);
1674
1675 /* Patching failed. Disable the manufacturer mode with reset and
1676 * deactivate the downloaded firmware patches.
1677 */
1678 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_deactivate),
1679 mfg_reset_deactivate, HCI_INIT_TIMEOUT);
1680 if (IS_ERR(skb)) {
1681 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1682 hdev->name, PTR_ERR(skb));
1683 return PTR_ERR(skb);
1684 }
1685 kfree_skb(skb);
1686
1687 BT_INFO("%s: Intel Bluetooth firmware patch completed and deactivated",
1688 hdev->name);
1689
1690 btusb_check_bdaddr_intel(hdev);
1691 return 0;
1692 }
1693
1694 static int btusb_set_bdaddr_intel(struct hci_dev *hdev, const bdaddr_t *bdaddr)
1695 {
1696 struct sk_buff *skb;
1697 long ret;
1698
1699 skb = __hci_cmd_sync(hdev, 0xfc31, 6, bdaddr, HCI_INIT_TIMEOUT);
1700 if (IS_ERR(skb)) {
1701 ret = PTR_ERR(skb);
1702 BT_ERR("%s: changing Intel device address failed (%ld)",
1703 hdev->name, ret);
1704 return ret;
1705 }
1706 kfree_skb(skb);
1707
1708 return 0;
1709 }
1710
1711 static int btusb_set_bdaddr_marvell(struct hci_dev *hdev,
1712 const bdaddr_t *bdaddr)
1713 {
1714 struct sk_buff *skb;
1715 u8 buf[8];
1716 long ret;
1717
1718 buf[0] = 0xfe;
1719 buf[1] = sizeof(bdaddr_t);
1720 memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
1721
1722 skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT);
1723 if (IS_ERR(skb)) {
1724 ret = PTR_ERR(skb);
1725 BT_ERR("%s: changing Marvell device address failed (%ld)",
1726 hdev->name, ret);
1727 return ret;
1728 }
1729 kfree_skb(skb);
1730
1731 return 0;
1732 }
1733
1734 #define BDADDR_BCM20702A0 (&(bdaddr_t) {{0x00, 0xa0, 0x02, 0x70, 0x20, 0x00}})
1735
1736 static int btusb_setup_bcm_patchram(struct hci_dev *hdev)
1737 {
1738 struct btusb_data *data = hci_get_drvdata(hdev);
1739 struct usb_device *udev = data->udev;
1740 char fw_name[64];
1741 const struct firmware *fw;
1742 const u8 *fw_ptr;
1743 size_t fw_size;
1744 const struct hci_command_hdr *cmd;
1745 const u8 *cmd_param;
1746 u16 opcode;
1747 struct sk_buff *skb;
1748 struct hci_rp_read_local_version *ver;
1749 struct hci_rp_read_bd_addr *bda;
1750 long ret;
1751
1752 snprintf(fw_name, sizeof(fw_name), "brcm/%s-%04x-%04x.hcd",
1753 udev->product ? udev->product : "BCM",
1754 le16_to_cpu(udev->descriptor.idVendor),
1755 le16_to_cpu(udev->descriptor.idProduct));
1756
1757 ret = request_firmware(&fw, fw_name, &hdev->dev);
1758 if (ret < 0) {
1759 BT_INFO("%s: BCM: patch %s not found", hdev->name, fw_name);
1760 return 0;
1761 }
1762
1763 /* Reset */
1764 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1765 if (IS_ERR(skb)) {
1766 ret = PTR_ERR(skb);
1767 BT_ERR("%s: HCI_OP_RESET failed (%ld)", hdev->name, ret);
1768 goto done;
1769 }
1770 kfree_skb(skb);
1771
1772 /* Read Local Version Info */
1773 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1774 HCI_INIT_TIMEOUT);
1775 if (IS_ERR(skb)) {
1776 ret = PTR_ERR(skb);
1777 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION failed (%ld)",
1778 hdev->name, ret);
1779 goto done;
1780 }
1781
1782 if (skb->len != sizeof(*ver)) {
1783 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION event length mismatch",
1784 hdev->name);
1785 kfree_skb(skb);
1786 ret = -EIO;
1787 goto done;
1788 }
1789
1790 ver = (struct hci_rp_read_local_version *)skb->data;
1791 BT_INFO("%s: BCM: patching hci_ver=%02x hci_rev=%04x lmp_ver=%02x "
1792 "lmp_subver=%04x", hdev->name, ver->hci_ver, ver->hci_rev,
1793 ver->lmp_ver, ver->lmp_subver);
1794 kfree_skb(skb);
1795
1796 /* Start Download */
1797 skb = __hci_cmd_sync(hdev, 0xfc2e, 0, NULL, HCI_INIT_TIMEOUT);
1798 if (IS_ERR(skb)) {
1799 ret = PTR_ERR(skb);
1800 BT_ERR("%s: BCM: Download Minidrv command failed (%ld)",
1801 hdev->name, ret);
1802 goto reset_fw;
1803 }
1804 kfree_skb(skb);
1805
1806 /* 50 msec delay after Download Minidrv completes */
1807 msleep(50);
1808
1809 fw_ptr = fw->data;
1810 fw_size = fw->size;
1811
1812 while (fw_size >= sizeof(*cmd)) {
1813 cmd = (struct hci_command_hdr *)fw_ptr;
1814 fw_ptr += sizeof(*cmd);
1815 fw_size -= sizeof(*cmd);
1816
1817 if (fw_size < cmd->plen) {
1818 BT_ERR("%s: BCM: patch %s is corrupted",
1819 hdev->name, fw_name);
1820 ret = -EINVAL;
1821 goto reset_fw;
1822 }
1823
1824 cmd_param = fw_ptr;
1825 fw_ptr += cmd->plen;
1826 fw_size -= cmd->plen;
1827
1828 opcode = le16_to_cpu(cmd->opcode);
1829
1830 skb = __hci_cmd_sync(hdev, opcode, cmd->plen, cmd_param,
1831 HCI_INIT_TIMEOUT);
1832 if (IS_ERR(skb)) {
1833 ret = PTR_ERR(skb);
1834 BT_ERR("%s: BCM: patch command %04x failed (%ld)",
1835 hdev->name, opcode, ret);
1836 goto reset_fw;
1837 }
1838 kfree_skb(skb);
1839 }
1840
1841 /* 250 msec delay after Launch Ram completes */
1842 msleep(250);
1843
1844 reset_fw:
1845 /* Reset */
1846 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1847 if (IS_ERR(skb)) {
1848 ret = PTR_ERR(skb);
1849 BT_ERR("%s: HCI_OP_RESET failed (%ld)", hdev->name, ret);
1850 goto done;
1851 }
1852 kfree_skb(skb);
1853
1854 /* Read Local Version Info */
1855 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1856 HCI_INIT_TIMEOUT);
1857 if (IS_ERR(skb)) {
1858 ret = PTR_ERR(skb);
1859 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION failed (%ld)",
1860 hdev->name, ret);
1861 goto done;
1862 }
1863
1864 if (skb->len != sizeof(*ver)) {
1865 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION event length mismatch",
1866 hdev->name);
1867 kfree_skb(skb);
1868 ret = -EIO;
1869 goto done;
1870 }
1871
1872 ver = (struct hci_rp_read_local_version *)skb->data;
1873 BT_INFO("%s: BCM: firmware hci_ver=%02x hci_rev=%04x lmp_ver=%02x "
1874 "lmp_subver=%04x", hdev->name, ver->hci_ver, ver->hci_rev,
1875 ver->lmp_ver, ver->lmp_subver);
1876 kfree_skb(skb);
1877
1878 /* Read BD Address */
1879 skb = __hci_cmd_sync(hdev, HCI_OP_READ_BD_ADDR, 0, NULL,
1880 HCI_INIT_TIMEOUT);
1881 if (IS_ERR(skb)) {
1882 ret = PTR_ERR(skb);
1883 BT_ERR("%s: HCI_OP_READ_BD_ADDR failed (%ld)",
1884 hdev->name, ret);
1885 goto done;
1886 }
1887
1888 if (skb->len != sizeof(*bda)) {
1889 BT_ERR("%s: HCI_OP_READ_BD_ADDR event length mismatch",
1890 hdev->name);
1891 kfree_skb(skb);
1892 ret = -EIO;
1893 goto done;
1894 }
1895
1896 bda = (struct hci_rp_read_bd_addr *)skb->data;
1897 if (bda->status) {
1898 BT_ERR("%s: HCI_OP_READ_BD_ADDR error status (%02x)",
1899 hdev->name, bda->status);
1900 kfree_skb(skb);
1901 ret = -bt_to_errno(bda->status);
1902 goto done;
1903 }
1904
1905 /* The address 00:20:70:02:A0:00 indicates a BCM20702A0 controller
1906 * with no configured address.
1907 */
1908 if (!bacmp(&bda->bdaddr, BDADDR_BCM20702A0)) {
1909 BT_INFO("%s: BCM: using default device address (%pMR)",
1910 hdev->name, &bda->bdaddr);
1911 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
1912 }
1913
1914 kfree_skb(skb);
1915
1916 done:
1917 release_firmware(fw);
1918
1919 return ret;
1920 }
1921
1922 static int btusb_set_bdaddr_bcm(struct hci_dev *hdev, const bdaddr_t *bdaddr)
1923 {
1924 struct sk_buff *skb;
1925 long ret;
1926
1927 skb = __hci_cmd_sync(hdev, 0xfc01, 6, bdaddr, HCI_INIT_TIMEOUT);
1928 if (IS_ERR(skb)) {
1929 ret = PTR_ERR(skb);
1930 BT_ERR("%s: BCM: Change address command failed (%ld)",
1931 hdev->name, ret);
1932 return ret;
1933 }
1934 kfree_skb(skb);
1935
1936 return 0;
1937 }
1938
1939 static int btusb_probe(struct usb_interface *intf,
1940 const struct usb_device_id *id)
1941 {
1942 struct usb_endpoint_descriptor *ep_desc;
1943 struct btusb_data *data;
1944 struct hci_dev *hdev;
1945 int i, err;
1946
1947 BT_DBG("intf %p id %p", intf, id);
1948
1949 /* interface numbers are hardcoded in the spec */
1950 if (intf->cur_altsetting->desc.bInterfaceNumber != 0)
1951 return -ENODEV;
1952
1953 if (!id->driver_info) {
1954 const struct usb_device_id *match;
1955
1956 match = usb_match_id(intf, blacklist_table);
1957 if (match)
1958 id = match;
1959 }
1960
1961 if (id->driver_info == BTUSB_IGNORE)
1962 return -ENODEV;
1963
1964 if (id->driver_info & BTUSB_ATH3012) {
1965 struct usb_device *udev = interface_to_usbdev(intf);
1966
1967 /* Old firmware would otherwise let ath3k driver load
1968 * patch and sysconfig files */
1969 if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001)
1970 return -ENODEV;
1971 }
1972
1973 data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
1974 if (!data)
1975 return -ENOMEM;
1976
1977 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1978 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1979
1980 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
1981 data->intr_ep = ep_desc;
1982 continue;
1983 }
1984
1985 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
1986 data->bulk_tx_ep = ep_desc;
1987 continue;
1988 }
1989
1990 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
1991 data->bulk_rx_ep = ep_desc;
1992 continue;
1993 }
1994 }
1995
1996 if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep)
1997 return -ENODEV;
1998
1999 data->cmdreq_type = USB_TYPE_CLASS;
2000
2001 data->udev = interface_to_usbdev(intf);
2002 data->intf = intf;
2003
2004 INIT_WORK(&data->work, btusb_work);
2005 INIT_WORK(&data->waker, btusb_waker);
2006 init_usb_anchor(&data->deferred);
2007 init_usb_anchor(&data->tx_anchor);
2008 spin_lock_init(&data->txlock);
2009
2010 init_usb_anchor(&data->intr_anchor);
2011 init_usb_anchor(&data->bulk_anchor);
2012 init_usb_anchor(&data->isoc_anchor);
2013 spin_lock_init(&data->rxlock);
2014
2015 hdev = hci_alloc_dev();
2016 if (!hdev)
2017 return -ENOMEM;
2018
2019 hdev->bus = HCI_USB;
2020 hci_set_drvdata(hdev, data);
2021
2022 data->hdev = hdev;
2023
2024 SET_HCIDEV_DEV(hdev, &intf->dev);
2025
2026 hdev->open = btusb_open;
2027 hdev->close = btusb_close;
2028 hdev->flush = btusb_flush;
2029 hdev->send = btusb_send_frame;
2030 hdev->notify = btusb_notify;
2031
2032 if (id->driver_info & BTUSB_BCM92035)
2033 hdev->setup = btusb_setup_bcm92035;
2034
2035 if (id->driver_info & BTUSB_BCM_PATCHRAM) {
2036 hdev->setup = btusb_setup_bcm_patchram;
2037 hdev->set_bdaddr = btusb_set_bdaddr_bcm;
2038 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
2039 }
2040
2041 if (id->driver_info & BTUSB_INTEL) {
2042 hdev->setup = btusb_setup_intel;
2043 hdev->set_bdaddr = btusb_set_bdaddr_intel;
2044 }
2045
2046 if (id->driver_info & BTUSB_MARVELL)
2047 hdev->set_bdaddr = btusb_set_bdaddr_marvell;
2048
2049 if (id->driver_info & BTUSB_INTEL_BOOT)
2050 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2051
2052 /* Interface numbers are hardcoded in the specification */
2053 data->isoc = usb_ifnum_to_if(data->udev, 1);
2054
2055 if (!reset)
2056 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2057
2058 if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
2059 if (!disable_scofix)
2060 set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
2061 }
2062
2063 if (id->driver_info & BTUSB_BROKEN_ISOC)
2064 data->isoc = NULL;
2065
2066 if (id->driver_info & BTUSB_DIGIANSWER) {
2067 data->cmdreq_type = USB_TYPE_VENDOR;
2068 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2069 }
2070
2071 if (id->driver_info & BTUSB_CSR) {
2072 struct usb_device *udev = data->udev;
2073 u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice);
2074
2075 /* Old firmware would otherwise execute USB reset */
2076 if (bcdDevice < 0x117)
2077 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
2078
2079 /* Fake CSR devices with broken commands */
2080 if (bcdDevice <= 0x100)
2081 hdev->setup = btusb_setup_csr;
2082 }
2083
2084 if (id->driver_info & BTUSB_SNIFFER) {
2085 struct usb_device *udev = data->udev;
2086
2087 /* New sniffer firmware has crippled HCI interface */
2088 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
2089 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2090 }
2091
2092 if (id->driver_info & BTUSB_INTEL_BOOT) {
2093 /* A bug in the bootloader causes that interrupt interface is
2094 * only enabled after receiving SetInterface(0, AltSetting=0).
2095 */
2096 err = usb_set_interface(data->udev, 0, 0);
2097 if (err < 0) {
2098 BT_ERR("failed to set interface 0, alt 0 %d", err);
2099 hci_free_dev(hdev);
2100 return err;
2101 }
2102 }
2103
2104 if (data->isoc) {
2105 err = usb_driver_claim_interface(&btusb_driver,
2106 data->isoc, data);
2107 if (err < 0) {
2108 hci_free_dev(hdev);
2109 return err;
2110 }
2111 }
2112
2113 err = hci_register_dev(hdev);
2114 if (err < 0) {
2115 hci_free_dev(hdev);
2116 return err;
2117 }
2118
2119 usb_set_intfdata(intf, data);
2120
2121 return 0;
2122 }
2123
2124 static void btusb_disconnect(struct usb_interface *intf)
2125 {
2126 struct btusb_data *data = usb_get_intfdata(intf);
2127 struct hci_dev *hdev;
2128
2129 BT_DBG("intf %p", intf);
2130
2131 if (!data)
2132 return;
2133
2134 hdev = data->hdev;
2135 usb_set_intfdata(data->intf, NULL);
2136
2137 if (data->isoc)
2138 usb_set_intfdata(data->isoc, NULL);
2139
2140 hci_unregister_dev(hdev);
2141
2142 if (intf == data->isoc)
2143 usb_driver_release_interface(&btusb_driver, data->intf);
2144 else if (data->isoc)
2145 usb_driver_release_interface(&btusb_driver, data->isoc);
2146
2147 btusb_free_frags(data);
2148 hci_free_dev(hdev);
2149 }
2150
2151 #ifdef CONFIG_PM
2152 static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
2153 {
2154 struct btusb_data *data = usb_get_intfdata(intf);
2155
2156 BT_DBG("intf %p", intf);
2157
2158 if (data->suspend_count++)
2159 return 0;
2160
2161 spin_lock_irq(&data->txlock);
2162 if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) {
2163 set_bit(BTUSB_SUSPENDING, &data->flags);
2164 spin_unlock_irq(&data->txlock);
2165 } else {
2166 spin_unlock_irq(&data->txlock);
2167 data->suspend_count--;
2168 return -EBUSY;
2169 }
2170
2171 cancel_work_sync(&data->work);
2172
2173 btusb_stop_traffic(data);
2174 usb_kill_anchored_urbs(&data->tx_anchor);
2175
2176 return 0;
2177 }
2178
2179 static void play_deferred(struct btusb_data *data)
2180 {
2181 struct urb *urb;
2182 int err;
2183
2184 while ((urb = usb_get_from_anchor(&data->deferred))) {
2185 err = usb_submit_urb(urb, GFP_ATOMIC);
2186 if (err < 0)
2187 break;
2188
2189 data->tx_in_flight++;
2190 }
2191 usb_scuttle_anchored_urbs(&data->deferred);
2192 }
2193
2194 static int btusb_resume(struct usb_interface *intf)
2195 {
2196 struct btusb_data *data = usb_get_intfdata(intf);
2197 struct hci_dev *hdev = data->hdev;
2198 int err = 0;
2199
2200 BT_DBG("intf %p", intf);
2201
2202 if (--data->suspend_count)
2203 return 0;
2204
2205 if (!test_bit(HCI_RUNNING, &hdev->flags))
2206 goto done;
2207
2208 if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
2209 err = btusb_submit_intr_urb(hdev, GFP_NOIO);
2210 if (err < 0) {
2211 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
2212 goto failed;
2213 }
2214 }
2215
2216 if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
2217 err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
2218 if (err < 0) {
2219 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
2220 goto failed;
2221 }
2222
2223 btusb_submit_bulk_urb(hdev, GFP_NOIO);
2224 }
2225
2226 if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
2227 if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
2228 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
2229 else
2230 btusb_submit_isoc_urb(hdev, GFP_NOIO);
2231 }
2232
2233 spin_lock_irq(&data->txlock);
2234 play_deferred(data);
2235 clear_bit(BTUSB_SUSPENDING, &data->flags);
2236 spin_unlock_irq(&data->txlock);
2237 schedule_work(&data->work);
2238
2239 return 0;
2240
2241 failed:
2242 usb_scuttle_anchored_urbs(&data->deferred);
2243 done:
2244 spin_lock_irq(&data->txlock);
2245 clear_bit(BTUSB_SUSPENDING, &data->flags);
2246 spin_unlock_irq(&data->txlock);
2247
2248 return err;
2249 }
2250 #endif
2251
2252 static struct usb_driver btusb_driver = {
2253 .name = "btusb",
2254 .probe = btusb_probe,
2255 .disconnect = btusb_disconnect,
2256 #ifdef CONFIG_PM
2257 .suspend = btusb_suspend,
2258 .resume = btusb_resume,
2259 #endif
2260 .id_table = btusb_table,
2261 .supports_autosuspend = 1,
2262 .disable_hub_initiated_lpm = 1,
2263 };
2264
2265 module_usb_driver(btusb_driver);
2266
2267 module_param(disable_scofix, bool, 0644);
2268 MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
2269
2270 module_param(force_scofix, bool, 0644);
2271 MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
2272
2273 module_param(reset, bool, 0644);
2274 MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
2275
2276 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
2277 MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
2278 MODULE_VERSION(VERSION);
2279 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.111254 seconds and 6 git commands to generate.