]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/bluetooth/btusb.c
projects / mirror_ubuntu-bionic-kernel.git / blob
? search:


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