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