projects / deliverable / linux.git / blob
? search:


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