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