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