]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/bluetooth/btusb.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Bluetooth: ath3k: Add support of AR3012 bluetooth 13d3:3423 device
[mirror_ubuntu-bionic-kernel.git] / drivers / bluetooth / btusb.c
CommitLineData
5e23b923
MH		 1/*
2 *
3 * Generic Bluetooth USB driver
4 *
9bfa35fe 5 * Copyright (C) 2005-2008 Marcel Holtmann <marcel@holtmann.org>
5e23b923
MH		 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
5e23b923 24#include <linux/module.h>
5e23b923 25#include <linux/usb.h>
dffd30ee 26#include <linux/firmware.h>
5e23b923
MH		 27
28#include <net/bluetooth/bluetooth.h>
29#include <net/bluetooth/hci_core.h>
30
7bee549e 31#define VERSION "0.6"
cfeb4145 32
90ab5ee9
RR		 33static bool disable_scofix;
34static bool force_scofix;
7a9d4020 35
90ab5ee9 36static bool reset = 1;
cfeb4145
MH		 37
38static struct usb_driver btusb_driver;
39
40#define BTUSB_IGNORE 0x01
7a9d4020
MH		 41#define BTUSB_DIGIANSWER 0x02
42#define BTUSB_CSR 0x04
43#define BTUSB_SNIFFER 0x08
44#define BTUSB_BCM92035 0x10
45#define BTUSB_BROKEN_ISOC 0x20
46#define BTUSB_WRONG_SCO_MTU 0x40
2d25f8b4 47#define BTUSB_ATH3012 0x80
dffd30ee 48#define BTUSB_INTEL 0x100
40df783d
MH		 49#define BTUSB_INTEL_BOOT 0x200
50#define BTUSB_BCM_PATCHRAM 0x400
ae8df494 51#define BTUSB_MARVELL 0x800
4fcef8ed 52#define BTUSB_SWAVE 0x1000
5e23b923 53
54265202 54static const struct usb_device_id btusb_table[] = {
5e23b923
MH		 55 /* Generic Bluetooth USB device */
56 { USB_DEVICE_INFO(0xe0, 0x01, 0x01) },
57
1fa6535f
HR		 58 /* Apple-specific (Broadcom) devices */
59 { USB_VENDOR_AND_INTERFACE_INFO(0x05ac, 0xff, 0x01, 0x01) },
60
178c059e
CYC		 61 /* MediaTek MT76x0E */
62 { USB_DEVICE(0x0e8d, 0x763f) },
63
c510eae3 64 /* Broadcom SoftSailing reporting vendor specific */
2e8b5063 65 { USB_DEVICE(0x0a5c, 0x21e1) },
c510eae3 66
3cd01976
NI		 67 /* Apple MacBookPro 7,1 */
68 { USB_DEVICE(0x05ac, 0x8213) },
69
0a79f674
CL		 70 /* Apple iMac11,1 */
71 { USB_DEVICE(0x05ac, 0x8215) },
72
9c047157
NI		 73 /* Apple MacBookPro6,2 */
74 { USB_DEVICE(0x05ac, 0x8218) },
75
3e3ede7d
EH		 76 /* Apple MacBookAir3,1, MacBookAir3,2 */
77 { USB_DEVICE(0x05ac, 0x821b) },
78
a63b723d
PAVM		 79 /* Apple MacBookAir4,1 */
80 { USB_DEVICE(0x05ac, 0x821f) },
81
88d377b6
MAP		 82 /* Apple MacBookPro8,2 */
83 { USB_DEVICE(0x05ac, 0x821a) },
84
f78b6826
JK		 85 /* Apple MacMini5,1 */
86 { USB_DEVICE(0x05ac, 0x8281) },
87
cfeb4145 88 /* AVM BlueFRITZ! USB v2.0 */
4fcef8ed 89 { USB_DEVICE(0x057c, 0x3800), .driver_info = BTUSB_SWAVE },
cfeb4145
MH		 90
91 /* Bluetooth Ultraport Module from IBM */
92 { USB_DEVICE(0x04bf, 0x030a) },
93
94 /* ALPS Modules with non-standard id */
95 { USB_DEVICE(0x044e, 0x3001) },
96 { USB_DEVICE(0x044e, 0x3002) },
97
98 /* Ericsson with non-standard id */
99 { USB_DEVICE(0x0bdb, 0x1002) },
100
101 /* Canyon CN-BTU1 with HID interfaces */
7a9d4020 102 { USB_DEVICE(0x0c10, 0x0000) },
cfeb4145 103
d13431ca 104 /* Broadcom BCM20702A0 */
0b880062
AS		 105 { USB_DEVICE(0x0489, 0xe042) },
106 { USB_DEVICE(0x04ca, 0x2003) },
1ee3ff61 107 { USB_DEVICE(0x0b05, 0x17b5) },
38a172be 108 { USB_DEVICE(0x0b05, 0x17cb) },
d13431ca 109 { USB_DEVICE(0x413c, 0x8197) },
a86c02ea
F		 110 { USB_DEVICE(0x13d3, 0x3404),
111 .driver_info = BTUSB_BCM_PATCHRAM },
d13431ca 112
98514036 113 /* Foxconn - Hon Hai */
6029ddc2
HS		 114 { USB_VENDOR_AND_INTERFACE_INFO(0x0489, 0xff, 0x01, 0x01),
115 .driver_info = BTUSB_BCM_PATCHRAM },
98514036 116
0b880062 117 /* Broadcom devices with vendor specific id */
10d4c673
PG		 118 { USB_VENDOR_AND_INTERFACE_INFO(0x0a5c, 0xff, 0x01, 0x01),
119 .driver_info = BTUSB_BCM_PATCHRAM },
92c385f4 120
c2aef6e8
MH		 121 /* ASUSTek Computer - Broadcom based */
122 { USB_VENDOR_AND_INTERFACE_INFO(0x0b05, 0xff, 0x01, 0x01) },
123
5bcecf32
KB		 124 /* Belkin F8065bf - Broadcom based */
125 { USB_VENDOR_AND_INTERFACE_INFO(0x050d, 0xff, 0x01, 0x01) },
126
9113bfd8
JK		 127 /* IMC Networks - Broadcom based */
128 { USB_VENDOR_AND_INTERFACE_INFO(0x13d3, 0xff, 0x01, 0x01) },
129
40df783d 130 /* Intel Bluetooth USB Bootloader (RAM module) */
d92f2df0
MH		 131 { USB_DEVICE(0x8087, 0x0a5a),
132 .driver_info = BTUSB_INTEL_BOOT | BTUSB_BROKEN_ISOC },
40df783d 133
5e23b923
MH		 134 { } /* Terminating entry */
135};
136
137MODULE_DEVICE_TABLE(usb, btusb_table);
138
54265202 139static const struct usb_device_id blacklist_table[] = {
cfeb4145
MH		 140 /* CSR BlueCore devices */
141 { USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR },
142
143 /* Broadcom BCM2033 without firmware */
144 { USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE },
145
be93112a 146 /* Atheros 3011 with sflash firmware */
0b880062
AS		 147 { USB_DEVICE(0x0489, 0xe027), .driver_info = BTUSB_IGNORE },
148 { USB_DEVICE(0x0489, 0xe03d), .driver_info = BTUSB_IGNORE },
149 { USB_DEVICE(0x0930, 0x0215), .driver_info = BTUSB_IGNORE },
be93112a 150 { USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE },
6eda541d 151 { USB_DEVICE(0x0cf3, 0xe019), .driver_info = BTUSB_IGNORE },
2a7bcccc 152 { USB_DEVICE(0x13d3, 0x3304), .driver_info = BTUSB_IGNORE },
be93112a 153
509e7861
CYC		 154 /* Atheros AR9285 Malbec with sflash firmware */
155 { USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE },
156
d9f51b51 157 /* Atheros 3012 with sflash firmware */
0b880062
AS		 158 { USB_DEVICE(0x0489, 0xe04d), .driver_info = BTUSB_ATH3012 },
159 { USB_DEVICE(0x0489, 0xe04e), .driver_info = BTUSB_ATH3012 },
160 { USB_DEVICE(0x0489, 0xe056), .driver_info = BTUSB_ATH3012 },
161 { USB_DEVICE(0x0489, 0xe057), .driver_info = BTUSB_ATH3012 },
162 { USB_DEVICE(0x0489, 0xe05f), .driver_info = BTUSB_ATH3012 },
4b552bc9 163 { USB_DEVICE(0x0489, 0xe078), .driver_info = BTUSB_ATH3012 },
0b880062
AS		 164 { USB_DEVICE(0x04c5, 0x1330), .driver_info = BTUSB_ATH3012 },
165 { USB_DEVICE(0x04ca, 0x3004), .driver_info = BTUSB_ATH3012 },
166 { USB_DEVICE(0x04ca, 0x3005), .driver_info = BTUSB_ATH3012 },
167 { USB_DEVICE(0x04ca, 0x3006), .driver_info = BTUSB_ATH3012 },
1fb4e09a 168 { USB_DEVICE(0x04ca, 0x3007), .driver_info = BTUSB_ATH3012 },
0b880062
AS		 169 { USB_DEVICE(0x04ca, 0x3008), .driver_info = BTUSB_ATH3012 },
170 { USB_DEVICE(0x04ca, 0x300b), .driver_info = BTUSB_ATH3012 },
134d3b35 171 { USB_DEVICE(0x04ca, 0x3010), .driver_info = BTUSB_ATH3012 },
0b880062
AS		 172 { USB_DEVICE(0x0930, 0x0219), .driver_info = BTUSB_ATH3012 },
173 { USB_DEVICE(0x0930, 0x0220), .driver_info = BTUSB_ATH3012 },
89d2975f 174 { USB_DEVICE(0x0930, 0x0227), .driver_info = BTUSB_ATH3012 },
a735f9e2 175 { USB_DEVICE(0x0b05, 0x17d0), .driver_info = BTUSB_ATH3012 },
d66629c1 176 { USB_DEVICE(0x0cf3, 0x0036), .driver_info = BTUSB_ATH3012 },
2d25f8b4 177 { USB_DEVICE(0x0cf3, 0x3004), .driver_info = BTUSB_ATH3012 },
94a32d10 178 { USB_DEVICE(0x0cf3, 0x3008), .driver_info = BTUSB_ATH3012 },
07c0ea87 179 { USB_DEVICE(0x0cf3, 0x311d), .driver_info = BTUSB_ATH3012 },
b131237c 180 { USB_DEVICE(0x0cf3, 0x311e), .driver_info = BTUSB_ATH3012 },
1e56f1eb 181 { USB_DEVICE(0x0cf3, 0x311f), .driver_info = BTUSB_ATH3012 },
0b880062 182 { USB_DEVICE(0x0cf3, 0x3121), .driver_info = BTUSB_ATH3012 },
ebaf5795 183 { USB_DEVICE(0x0cf3, 0x817a), .driver_info = BTUSB_ATH3012 },
0b880062 184 { USB_DEVICE(0x0cf3, 0xe003), .driver_info = BTUSB_ATH3012 },
ac71311e 185 { USB_DEVICE(0x0cf3, 0xe004), .driver_info = BTUSB_ATH3012 },
0a3658cc 186 { USB_DEVICE(0x0cf3, 0xe005), .driver_info = BTUSB_ATH3012 },
0b880062
AS		 187 { USB_DEVICE(0x13d3, 0x3362), .driver_info = BTUSB_ATH3012 },
188 { USB_DEVICE(0x13d3, 0x3375), .driver_info = BTUSB_ATH3012 },
eed307e2 189 { USB_DEVICE(0x13d3, 0x3393), .driver_info = BTUSB_ATH3012 },
5b77a1f3 190 { USB_DEVICE(0x13d3, 0x3402), .driver_info = BTUSB_ATH3012 },
3bb30a7c 191 { USB_DEVICE(0x13d3, 0x3408), .driver_info = BTUSB_ATH3012 },
033efa92 192 { USB_DEVICE(0x13d3, 0x3423), .driver_info = BTUSB_ATH3012 },
fa2f1394 193 { USB_DEVICE(0x13d3, 0x3432), .driver_info = BTUSB_ATH3012 },
d9f51b51 194
e9036e33
CYC		 195 /* Atheros AR5BBU12 with sflash firmware */
196 { USB_DEVICE(0x0489, 0xe02c), .driver_info = BTUSB_IGNORE },
197
85d59726 198 /* Atheros AR5BBU12 with sflash firmware */
bc21fde2 199 { USB_DEVICE(0x0489, 0xe036), .driver_info = BTUSB_ATH3012 },
0b880062 200 { USB_DEVICE(0x0489, 0xe03c), .driver_info = BTUSB_ATH3012 },
85d59726 201
cfeb4145 202 /* Broadcom BCM2035 */
7a9d4020 203 { USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 },
0b880062
AS		 204 { USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU },
205 { USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU },
cfeb4145
MH		 206
207 /* Broadcom BCM2045 */
7a9d4020
MH		 208 { USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU },
209 { USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU },
bdbef3d6 210
cfeb4145 211 /* IBM/Lenovo ThinkPad with Broadcom chip */
7a9d4020
MH		 212 { USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU },
213 { USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU },
cfeb4145
MH		 214
215 /* HP laptop with Broadcom chip */
7a9d4020 216 { USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU },
cfeb4145
MH		 217
218 /* Dell laptop with Broadcom chip */
7a9d4020 219 { USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU },
cfeb4145 220
5ddd4a60 221 /* Dell Wireless 370 and 410 devices */
7a9d4020 222 { USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU },
5ddd4a60 223 { USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU },
cfeb4145 224
7a9d4020
MH		 225 /* Belkin F8T012 and F8T013 devices */
226 { USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU },
227 { USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU },
cfeb4145 228
5ddd4a60
MH		 229 /* Asus WL-BTD202 device */
230 { USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU },
231
232 /* Kensington Bluetooth USB adapter */
233 { USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU },
234
cfeb4145
MH		 235 /* RTX Telecom based adapters with buggy SCO support */
236 { USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC },
237 { USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC },
238
239 /* CONWISE Technology based adapters with buggy SCO support */
240 { USB_DEVICE(0x0e5e, 0x6622), .driver_info = BTUSB_BROKEN_ISOC },
241
4fcef8ed
MH		 242 /* Roper Class 1 Bluetooth Dongle (Silicon Wave based) */
243 { USB_DEVICE(0x1300, 0x0001), .driver_info = BTUSB_SWAVE },
244
cfeb4145
MH		 245 /* Digianswer devices */
246 { USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER },
247 { USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE },
248
249 /* CSR BlueCore Bluetooth Sniffer */
4f64fa80
MH		 250 { USB_DEVICE(0x0a12, 0x0002),
251 .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
cfeb4145
MH		 252
253 /* Frontline ComProbe Bluetooth Sniffer */
4f64fa80
MH		 254 { USB_DEVICE(0x16d3, 0x0002),
255 .driver_info = BTUSB_SNIFFER | BTUSB_BROKEN_ISOC },
cfeb4145 256
dffd30ee
THJA		 257 /* Intel Bluetooth device */
258 { USB_DEVICE(0x8087, 0x07dc), .driver_info = BTUSB_INTEL },
ef4e5e4a 259 { USB_DEVICE(0x8087, 0x0a2a), .driver_info = BTUSB_INTEL },
dffd30ee 260
ae8df494
AK		 261 /* Marvell device */
262 { USB_DEVICE(0x1286, 0x2044), .driver_info = BTUSB_MARVELL },
263 { USB_DEVICE(0x1286, 0x2046), .driver_info = BTUSB_MARVELL },
264
5e23b923
MH		 265 { } /* Terminating entry */
266};
267
9bfa35fe
MH		 268#define BTUSB_MAX_ISOC_FRAMES 10
269
5e23b923
MH		 270#define BTUSB_INTR_RUNNING 0
271#define BTUSB_BULK_RUNNING 1
9bfa35fe 272#define BTUSB_ISOC_RUNNING 2
7bee549e 273#define BTUSB_SUSPENDING 3
08b8b6c4 274#define BTUSB_DID_ISO_RESUME 4
5e23b923
MH		 275
276struct btusb_data {
277 struct hci_dev *hdev;
278 struct usb_device *udev;
5fbcd260 279 struct usb_interface *intf;
9bfa35fe 280 struct usb_interface *isoc;
5e23b923 281
5e23b923
MH		 282 unsigned long flags;
283
284 struct work_struct work;
7bee549e 285 struct work_struct waker;
5e23b923 286
803b5836 287 struct usb_anchor deferred;
5e23b923 288 struct usb_anchor tx_anchor;
803b5836
MH		 289 int tx_in_flight;
290 spinlock_t txlock;
291
5e23b923
MH		 292 struct usb_anchor intr_anchor;
293 struct usb_anchor bulk_anchor;
9bfa35fe 294 struct usb_anchor isoc_anchor;
803b5836
MH		 295 spinlock_t rxlock;
296
297 struct sk_buff *evt_skb;
298 struct sk_buff *acl_skb;
299 struct sk_buff *sco_skb;
5e23b923
MH		 300
301 struct usb_endpoint_descriptor *intr_ep;
302 struct usb_endpoint_descriptor *bulk_tx_ep;
303 struct usb_endpoint_descriptor *bulk_rx_ep;
9bfa35fe
MH		 304 struct usb_endpoint_descriptor *isoc_tx_ep;
305 struct usb_endpoint_descriptor *isoc_rx_ep;
306
7a9d4020
MH		 307 __u8 cmdreq_type;
308
43c2e57f 309 unsigned int sco_num;
9bfa35fe 310 int isoc_altsetting;
6a88adf2 311 int suspend_count;
2cbd3f5c 312
97307f51 313 int (*recv_event)(struct hci_dev *hdev, struct sk_buff *skb);
2cbd3f5c 314 int (*recv_bulk)(struct btusb_data *data, void *buffer, int count);
5e23b923
MH		 315};
316
803b5836
MH		 317static inline void btusb_free_frags(struct btusb_data *data)
318{
319 unsigned long flags;
320
321 spin_lock_irqsave(&data->rxlock, flags);
322
323 kfree_skb(data->evt_skb);
324 data->evt_skb = NULL;
325
326 kfree_skb(data->acl_skb);
327 data->acl_skb = NULL;
328
329 kfree_skb(data->sco_skb);
330 data->sco_skb = NULL;
331
332 spin_unlock_irqrestore(&data->rxlock, flags);
333}
334
1ffa4ad0
MH		 335static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count)
336{
803b5836
MH		 337 struct sk_buff *skb;
338 int err = 0;
339
340 spin_lock(&data->rxlock);
341 skb = data->evt_skb;
342
343 while (count) {
344 int len;
345
346 if (!skb) {
347 skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC);
348 if (!skb) {
349 err = -ENOMEM;
350 break;
351 }
352
353 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
354 bt_cb(skb)->expect = HCI_EVENT_HDR_SIZE;
355 }
356
357 len = min_t(uint, bt_cb(skb)->expect, count);
358 memcpy(skb_put(skb, len), buffer, len);
359
360 count -= len;
361 buffer += len;
362 bt_cb(skb)->expect -= len;
363
364 if (skb->len == HCI_EVENT_HDR_SIZE) {
365 /* Complete event header */
366 bt_cb(skb)->expect = hci_event_hdr(skb)->plen;
367
368 if (skb_tailroom(skb) < bt_cb(skb)->expect) {
369 kfree_skb(skb);
370 skb = NULL;
371
372 err = -EILSEQ;
373 break;
374 }
375 }
376
377 if (bt_cb(skb)->expect == 0) {
378 /* Complete frame */
97307f51 379 data->recv_event(data->hdev, skb);
803b5836
MH		 380 skb = NULL;
381 }
382 }
383
384 data->evt_skb = skb;
385 spin_unlock(&data->rxlock);
386
387 return err;
1ffa4ad0
MH		 388}
389
390static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count)
391{
803b5836
MH		 392 struct sk_buff *skb;
393 int err = 0;
394
395 spin_lock(&data->rxlock);
396 skb = data->acl_skb;
397
398 while (count) {
399 int len;
400
401 if (!skb) {
402 skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC);
403 if (!skb) {
404 err = -ENOMEM;
405 break;
406 }
407
408 bt_cb(skb)->pkt_type = HCI_ACLDATA_PKT;
409 bt_cb(skb)->expect = HCI_ACL_HDR_SIZE;
410 }
411
412 len = min_t(uint, bt_cb(skb)->expect, count);
413 memcpy(skb_put(skb, len), buffer, len);
414
415 count -= len;
416 buffer += len;
417 bt_cb(skb)->expect -= len;
418
419 if (skb->len == HCI_ACL_HDR_SIZE) {
420 __le16 dlen = hci_acl_hdr(skb)->dlen;
421
422 /* Complete ACL header */
423 bt_cb(skb)->expect = __le16_to_cpu(dlen);
424
425 if (skb_tailroom(skb) < bt_cb(skb)->expect) {
426 kfree_skb(skb);
427 skb = NULL;
428
429 err = -EILSEQ;
430 break;
431 }
432 }
433
434 if (bt_cb(skb)->expect == 0) {
435 /* Complete frame */
436 hci_recv_frame(data->hdev, skb);
437 skb = NULL;
438 }
439 }
440
441 data->acl_skb = skb;
442 spin_unlock(&data->rxlock);
443
444 return err;
1ffa4ad0
MH		 445}
446
447static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count)
448{
803b5836
MH		 449 struct sk_buff *skb;
450 int err = 0;
451
452 spin_lock(&data->rxlock);
453 skb = data->sco_skb;
454
455 while (count) {
456 int len;
457
458 if (!skb) {
459 skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC);
460 if (!skb) {
461 err = -ENOMEM;
462 break;
463 }
464
465 bt_cb(skb)->pkt_type = HCI_SCODATA_PKT;
466 bt_cb(skb)->expect = HCI_SCO_HDR_SIZE;
467 }
468
469 len = min_t(uint, bt_cb(skb)->expect, count);
470 memcpy(skb_put(skb, len), buffer, len);
471
472 count -= len;
473 buffer += len;
474 bt_cb(skb)->expect -= len;
475
476 if (skb->len == HCI_SCO_HDR_SIZE) {
477 /* Complete SCO header */
478 bt_cb(skb)->expect = hci_sco_hdr(skb)->dlen;
479
480 if (skb_tailroom(skb) < bt_cb(skb)->expect) {
481 kfree_skb(skb);
482 skb = NULL;
483
484 err = -EILSEQ;
485 break;
486 }
487 }
488
489 if (bt_cb(skb)->expect == 0) {
490 /* Complete frame */
491 hci_recv_frame(data->hdev, skb);
492 skb = NULL;
493 }
494 }
495
496 data->sco_skb = skb;
497 spin_unlock(&data->rxlock);
498
499 return err;
1ffa4ad0
MH		 500}
501
5e23b923
MH		 502static void btusb_intr_complete(struct urb *urb)
503{
504 struct hci_dev *hdev = urb->context;
155961e8 505 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 506 int err;
507
89e7533d
MH		 508 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
509 urb->actual_length);
5e23b923
MH		 510
511 if (!test_bit(HCI_RUNNING, &hdev->flags))
512 return;
513
514 if (urb->status == 0) {
9bfa35fe
MH		 515 hdev->stat.byte_rx += urb->actual_length;
516
1ffa4ad0
MH		 517 if (btusb_recv_intr(data, urb->transfer_buffer,
518 urb->actual_length) < 0) {
5e23b923
MH		 519 BT_ERR("%s corrupted event packet", hdev->name);
520 hdev->stat.err_rx++;
521 }
85560c4a
CC		 522 } else if (urb->status == -ENOENT) {
523 /* Avoid suspend failed when usb_kill_urb */
524 return;
5e23b923
MH		 525 }
526
527 if (!test_bit(BTUSB_INTR_RUNNING, &data->flags))
528 return;
529
7bee549e 530 usb_mark_last_busy(data->udev);
5e23b923
MH		 531 usb_anchor_urb(urb, &data->intr_anchor);
532
533 err = usb_submit_urb(urb, GFP_ATOMIC);
534 if (err < 0) {
4935f1c1
PB		 535 /* -EPERM: urb is being killed;
536 * -ENODEV: device got disconnected */
537 if (err != -EPERM && err != -ENODEV)
61faddf6 538 BT_ERR("%s urb %p failed to resubmit (%d)",
89e7533d 539 hdev->name, urb, -err);
5e23b923
MH		 540 usb_unanchor_urb(urb);
541 }
542}
543
2eda66f4 544static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags)
5e23b923 545{
155961e8 546 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 547 struct urb *urb;
548 unsigned char *buf;
549 unsigned int pipe;
550 int err, size;
551
552 BT_DBG("%s", hdev->name);
553
9bfa35fe
MH		 554 if (!data->intr_ep)
555 return -ENODEV;
556
2eda66f4 557 urb = usb_alloc_urb(0, mem_flags);
5e23b923
MH		 558 if (!urb)
559 return -ENOMEM;
560
561 size = le16_to_cpu(data->intr_ep->wMaxPacketSize);
562
2eda66f4 563 buf = kmalloc(size, mem_flags);
5e23b923
MH		 564 if (!buf) {
565 usb_free_urb(urb);
566 return -ENOMEM;
567 }
568
569 pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress);
570
571 usb_fill_int_urb(urb, data->udev, pipe, buf, size,
89e7533d 572 btusb_intr_complete, hdev, data->intr_ep->bInterval);
5e23b923
MH		 573
574 urb->transfer_flags |= URB_FREE_BUFFER;
575
576 usb_anchor_urb(urb, &data->intr_anchor);
577
2eda66f4 578 err = usb_submit_urb(urb, mem_flags);
5e23b923 579 if (err < 0) {
d4b8d1c9
PB		 580 if (err != -EPERM && err != -ENODEV)
581 BT_ERR("%s urb %p submission failed (%d)",
89e7533d 582 hdev->name, urb, -err);
5e23b923 583 usb_unanchor_urb(urb);
5e23b923
MH		 584 }
585
586 usb_free_urb(urb);
587
588 return err;
589}
590
591static void btusb_bulk_complete(struct urb *urb)
592{
593 struct hci_dev *hdev = urb->context;
155961e8 594 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 595 int err;
596
89e7533d
MH		 597 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
598 urb->actual_length);
5e23b923
MH		 599
600 if (!test_bit(HCI_RUNNING, &hdev->flags))
601 return;
602
603 if (urb->status == 0) {
9bfa35fe
MH		 604 hdev->stat.byte_rx += urb->actual_length;
605
2cbd3f5c 606 if (data->recv_bulk(data, urb->transfer_buffer,
1ffa4ad0 607 urb->actual_length) < 0) {
5e23b923
MH		 608 BT_ERR("%s corrupted ACL packet", hdev->name);
609 hdev->stat.err_rx++;
610 }
85560c4a
CC		 611 } else if (urb->status == -ENOENT) {
612 /* Avoid suspend failed when usb_kill_urb */
613 return;
5e23b923
MH		 614 }
615
616 if (!test_bit(BTUSB_BULK_RUNNING, &data->flags))
617 return;
618
619 usb_anchor_urb(urb, &data->bulk_anchor);
652fd781 620 usb_mark_last_busy(data->udev);
5e23b923
MH		 621
622 err = usb_submit_urb(urb, GFP_ATOMIC);
623 if (err < 0) {
4935f1c1
PB		 624 /* -EPERM: urb is being killed;
625 * -ENODEV: device got disconnected */
626 if (err != -EPERM && err != -ENODEV)
61faddf6 627 BT_ERR("%s urb %p failed to resubmit (%d)",
89e7533d 628 hdev->name, urb, -err);
5e23b923
MH		 629 usb_unanchor_urb(urb);
630 }
631}
632
2eda66f4 633static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags)
5e23b923 634{
155961e8 635 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 636 struct urb *urb;
637 unsigned char *buf;
638 unsigned int pipe;
290ba200 639 int err, size = HCI_MAX_FRAME_SIZE;
5e23b923
MH		 640
641 BT_DBG("%s", hdev->name);
642
9bfa35fe
MH		 643 if (!data->bulk_rx_ep)
644 return -ENODEV;
645
2eda66f4 646 urb = usb_alloc_urb(0, mem_flags);
5e23b923
MH		 647 if (!urb)
648 return -ENOMEM;
649
2eda66f4 650 buf = kmalloc(size, mem_flags);
5e23b923
MH		 651 if (!buf) {
652 usb_free_urb(urb);
653 return -ENOMEM;
654 }
655
656 pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress);
657
89e7533d
MH		 658 usb_fill_bulk_urb(urb, data->udev, pipe, buf, size,
659 btusb_bulk_complete, hdev);
5e23b923
MH		 660
661 urb->transfer_flags |= URB_FREE_BUFFER;
662
7bee549e 663 usb_mark_last_busy(data->udev);
5e23b923
MH		 664 usb_anchor_urb(urb, &data->bulk_anchor);
665
2eda66f4 666 err = usb_submit_urb(urb, mem_flags);
5e23b923 667 if (err < 0) {
d4b8d1c9
PB		 668 if (err != -EPERM && err != -ENODEV)
669 BT_ERR("%s urb %p submission failed (%d)",
89e7533d 670 hdev->name, urb, -err);
5e23b923 671 usb_unanchor_urb(urb);
5e23b923
MH		 672 }
673
674 usb_free_urb(urb);
675
676 return err;
677}
678
9bfa35fe
MH		 679static void btusb_isoc_complete(struct urb *urb)
680{
681 struct hci_dev *hdev = urb->context;
155961e8 682 struct btusb_data *data = hci_get_drvdata(hdev);
9bfa35fe
MH		 683 int i, err;
684
89e7533d
MH		 685 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
686 urb->actual_length);
9bfa35fe
MH		 687
688 if (!test_bit(HCI_RUNNING, &hdev->flags))
689 return;
690
691 if (urb->status == 0) {
692 for (i = 0; i < urb->number_of_packets; i++) {
693 unsigned int offset = urb->iso_frame_desc[i].offset;
694 unsigned int length = urb->iso_frame_desc[i].actual_length;
695
696 if (urb->iso_frame_desc[i].status)
697 continue;
698
699 hdev->stat.byte_rx += length;
700
1ffa4ad0
MH		 701 if (btusb_recv_isoc(data, urb->transfer_buffer + offset,
702 length) < 0) {
9bfa35fe
MH		 703 BT_ERR("%s corrupted SCO packet", hdev->name);
704 hdev->stat.err_rx++;
705 }
706 }
85560c4a
CC		 707 } else if (urb->status == -ENOENT) {
708 /* Avoid suspend failed when usb_kill_urb */
709 return;
9bfa35fe
MH		 710 }
711
712 if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags))
713 return;
714
715 usb_anchor_urb(urb, &data->isoc_anchor);
716
717 err = usb_submit_urb(urb, GFP_ATOMIC);
718 if (err < 0) {
4935f1c1
PB		 719 /* -EPERM: urb is being killed;
720 * -ENODEV: device got disconnected */
721 if (err != -EPERM && err != -ENODEV)
61faddf6 722 BT_ERR("%s urb %p failed to resubmit (%d)",
89e7533d 723 hdev->name, urb, -err);
9bfa35fe
MH		 724 usb_unanchor_urb(urb);
725 }
726}
727
42b16b3f 728static inline void __fill_isoc_descriptor(struct urb *urb, int len, int mtu)
9bfa35fe
MH		 729{
730 int i, offset = 0;
731
732 BT_DBG("len %d mtu %d", len, mtu);
733
734 for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu;
735 i++, offset += mtu, len -= mtu) {
736 urb->iso_frame_desc[i].offset = offset;
737 urb->iso_frame_desc[i].length = mtu;
738 }
739
740 if (len && i < BTUSB_MAX_ISOC_FRAMES) {
741 urb->iso_frame_desc[i].offset = offset;
742 urb->iso_frame_desc[i].length = len;
743 i++;
744 }
745
746 urb->number_of_packets = i;
747}
748
2eda66f4 749static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags)
9bfa35fe 750{
155961e8 751 struct btusb_data *data = hci_get_drvdata(hdev);
9bfa35fe
MH		 752 struct urb *urb;
753 unsigned char *buf;
754 unsigned int pipe;
755 int err, size;
756
757 BT_DBG("%s", hdev->name);
758
759 if (!data->isoc_rx_ep)
760 return -ENODEV;
761
2eda66f4 762 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags);
9bfa35fe
MH		 763 if (!urb)
764 return -ENOMEM;
765
766 size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) *
767 BTUSB_MAX_ISOC_FRAMES;
768
2eda66f4 769 buf = kmalloc(size, mem_flags);
9bfa35fe
MH		 770 if (!buf) {
771 usb_free_urb(urb);
772 return -ENOMEM;
773 }
774
775 pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress);
776
fa0fb93f 777 usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_isoc_complete,
89e7533d 778 hdev, data->isoc_rx_ep->bInterval);
9bfa35fe 779
89e7533d 780 urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP;
9bfa35fe
MH		 781
782 __fill_isoc_descriptor(urb, size,
89e7533d 783 le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize));
9bfa35fe
MH		 784
785 usb_anchor_urb(urb, &data->isoc_anchor);
786
2eda66f4 787 err = usb_submit_urb(urb, mem_flags);
9bfa35fe 788 if (err < 0) {
d4b8d1c9
PB		 789 if (err != -EPERM && err != -ENODEV)
790 BT_ERR("%s urb %p submission failed (%d)",
89e7533d 791 hdev->name, urb, -err);
9bfa35fe 792 usb_unanchor_urb(urb);
9bfa35fe
MH		 793 }
794
795 usb_free_urb(urb);
796
797 return err;
798}
799
5e23b923 800static void btusb_tx_complete(struct urb *urb)
7bee549e
ON		 801{
802 struct sk_buff *skb = urb->context;
89e7533d 803 struct hci_dev *hdev = (struct hci_dev *)skb->dev;
155961e8 804 struct btusb_data *data = hci_get_drvdata(hdev);
7bee549e 805
89e7533d
MH		 806 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
807 urb->actual_length);
7bee549e
ON		 808
809 if (!test_bit(HCI_RUNNING, &hdev->flags))
810 goto done;
811
812 if (!urb->status)
813 hdev->stat.byte_tx += urb->transfer_buffer_length;
814 else
815 hdev->stat.err_tx++;
816
817done:
818 spin_lock(&data->txlock);
819 data->tx_in_flight--;
820 spin_unlock(&data->txlock);
821
822 kfree(urb->setup_packet);
823
824 kfree_skb(skb);
825}
826
827static void btusb_isoc_tx_complete(struct urb *urb)
5e23b923
MH		 828{
829 struct sk_buff *skb = urb->context;
89e7533d 830 struct hci_dev *hdev = (struct hci_dev *)skb->dev;
5e23b923 831
89e7533d
MH		 832 BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status,
833 urb->actual_length);
5e23b923
MH		 834
835 if (!test_bit(HCI_RUNNING, &hdev->flags))
836 goto done;
837
838 if (!urb->status)
839 hdev->stat.byte_tx += urb->transfer_buffer_length;
840 else
841 hdev->stat.err_tx++;
842
843done:
844 kfree(urb->setup_packet);
845
846 kfree_skb(skb);
847}
848
849static int btusb_open(struct hci_dev *hdev)
850{
155961e8 851 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 852 int err;
853
854 BT_DBG("%s", hdev->name);
855
7bee549e
ON		 856 err = usb_autopm_get_interface(data->intf);
857 if (err < 0)
858 return err;
859
860 data->intf->needs_remote_wakeup = 1;
861
5e23b923 862 if (test_and_set_bit(HCI_RUNNING, &hdev->flags))
7bee549e 863 goto done;
5e23b923
MH		 864
865 if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags))
7bee549e 866 goto done;
5e23b923 867
2eda66f4 868 err = btusb_submit_intr_urb(hdev, GFP_KERNEL);
43c2e57f
MH		 869 if (err < 0)
870 goto failed;
871
872 err = btusb_submit_bulk_urb(hdev, GFP_KERNEL);
5e23b923 873 if (err < 0) {
43c2e57f
MH		 874 usb_kill_anchored_urbs(&data->intr_anchor);
875 goto failed;
5e23b923
MH		 876 }
877
43c2e57f
MH		 878 set_bit(BTUSB_BULK_RUNNING, &data->flags);
879 btusb_submit_bulk_urb(hdev, GFP_KERNEL);
880
7bee549e
ON		 881done:
882 usb_autopm_put_interface(data->intf);
43c2e57f
MH		 883 return 0;
884
885failed:
886 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
887 clear_bit(HCI_RUNNING, &hdev->flags);
7bee549e 888 usb_autopm_put_interface(data->intf);
5e23b923
MH		 889 return err;
890}
891
7bee549e
ON		 892static void btusb_stop_traffic(struct btusb_data *data)
893{
894 usb_kill_anchored_urbs(&data->intr_anchor);
895 usb_kill_anchored_urbs(&data->bulk_anchor);
896 usb_kill_anchored_urbs(&data->isoc_anchor);
897}
898
5e23b923
MH		 899static int btusb_close(struct hci_dev *hdev)
900{
155961e8 901 struct btusb_data *data = hci_get_drvdata(hdev);
7bee549e 902 int err;
5e23b923
MH		 903
904 BT_DBG("%s", hdev->name);
905
906 if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags))
907 return 0;
908
e8c3c3d2 909 cancel_work_sync(&data->work);
404291ac 910 cancel_work_sync(&data->waker);
e8c3c3d2 911
9bfa35fe 912 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
5e23b923 913 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
5e23b923 914 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
7bee549e
ON		 915
916 btusb_stop_traffic(data);
803b5836
MH		 917 btusb_free_frags(data);
918
7bee549e
ON		 919 err = usb_autopm_get_interface(data->intf);
920 if (err < 0)
7b8e2c1d 921 goto failed;
7bee549e
ON		 922
923 data->intf->needs_remote_wakeup = 0;
924 usb_autopm_put_interface(data->intf);
5e23b923 925
7b8e2c1d
ON		 926failed:
927 usb_scuttle_anchored_urbs(&data->deferred);
5e23b923
MH		 928 return 0;
929}
930
931static int btusb_flush(struct hci_dev *hdev)
932{
155961e8 933 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 934
935 BT_DBG("%s", hdev->name);
936
937 usb_kill_anchored_urbs(&data->tx_anchor);
803b5836 938 btusb_free_frags(data);
5e23b923
MH		 939
940 return 0;
941}
942
047b2ec8 943static struct urb *alloc_ctrl_urb(struct hci_dev *hdev, struct sk_buff *skb)
5e23b923 944{
155961e8 945 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 946 struct usb_ctrlrequest *dr;
947 struct urb *urb;
948 unsigned int pipe;
5e23b923 949
047b2ec8
MH		 950 urb = usb_alloc_urb(0, GFP_KERNEL);
951 if (!urb)
952 return ERR_PTR(-ENOMEM);
5e23b923 953
047b2ec8
MH		 954 dr = kmalloc(sizeof(*dr), GFP_KERNEL);
955 if (!dr) {
956 usb_free_urb(urb);
957 return ERR_PTR(-ENOMEM);
958 }
5e23b923 959
047b2ec8
MH		 960 dr->bRequestType = data->cmdreq_type;
961 dr->bRequest = 0;
962 dr->wIndex = 0;
963 dr->wValue = 0;
964 dr->wLength = __cpu_to_le16(skb->len);
7bd8f09f 965
047b2ec8 966 pipe = usb_sndctrlpipe(data->udev, 0x00);
5e23b923 967
89e7533d 968 usb_fill_control_urb(urb, data->udev, pipe, (void *)dr,
047b2ec8 969 skb->data, skb->len, btusb_tx_complete, skb);
5e23b923 970
89e7533d 971 skb->dev = (void *)hdev;
5e23b923 972
047b2ec8
MH		 973 return urb;
974}
5e23b923 975
047b2ec8
MH		 976static struct urb *alloc_bulk_urb(struct hci_dev *hdev, struct sk_buff *skb)
977{
978 struct btusb_data *data = hci_get_drvdata(hdev);
979 struct urb *urb;
980 unsigned int pipe;
5e23b923 981
047b2ec8
MH		 982 if (!data->bulk_tx_ep)
983 return ERR_PTR(-ENODEV);
9bfa35fe 984
047b2ec8
MH		 985 urb = usb_alloc_urb(0, GFP_KERNEL);
986 if (!urb)
987 return ERR_PTR(-ENOMEM);
5e23b923 988
047b2ec8 989 pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress);
5e23b923 990
047b2ec8
MH		 991 usb_fill_bulk_urb(urb, data->udev, pipe,
992 skb->data, skb->len, btusb_tx_complete, skb);
5e23b923 993
89e7533d 994 skb->dev = (void *)hdev;
5e23b923 995
047b2ec8
MH		 996 return urb;
997}
9bfa35fe 998
047b2ec8
MH		 999static struct urb *alloc_isoc_urb(struct hci_dev *hdev, struct sk_buff *skb)
1000{
1001 struct btusb_data *data = hci_get_drvdata(hdev);
1002 struct urb *urb;
1003 unsigned int pipe;
9bfa35fe 1004
047b2ec8
MH		 1005 if (!data->isoc_tx_ep)
1006 return ERR_PTR(-ENODEV);
9bfa35fe 1007
047b2ec8
MH		 1008 urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_KERNEL);
1009 if (!urb)
1010 return ERR_PTR(-ENOMEM);
9bfa35fe 1011
047b2ec8 1012 pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress);
9bfa35fe 1013
047b2ec8
MH		 1014 usb_fill_int_urb(urb, data->udev, pipe,
1015 skb->data, skb->len, btusb_isoc_tx_complete,
1016 skb, data->isoc_tx_ep->bInterval);
9bfa35fe 1017
047b2ec8 1018 urb->transfer_flags = URB_ISO_ASAP;
5e23b923 1019
047b2ec8
MH		 1020 __fill_isoc_descriptor(urb, skb->len,
1021 le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize));
5e23b923 1022
89e7533d 1023 skb->dev = (void *)hdev;
047b2ec8
MH		 1024
1025 return urb;
1026}
1027
1028static int submit_tx_urb(struct hci_dev *hdev, struct urb *urb)
1029{
1030 struct btusb_data *data = hci_get_drvdata(hdev);
1031 int err;
7bee549e 1032
5e23b923
MH		 1033 usb_anchor_urb(urb, &data->tx_anchor);
1034
e9753eff 1035 err = usb_submit_urb(urb, GFP_KERNEL);
5e23b923 1036 if (err < 0) {
5a9b80e2
PB		 1037 if (err != -EPERM && err != -ENODEV)
1038 BT_ERR("%s urb %p submission failed (%d)",
89e7533d 1039 hdev->name, urb, -err);
5e23b923
MH		 1040 kfree(urb->setup_packet);
1041 usb_unanchor_urb(urb);
7bee549e
ON		 1042 } else {
1043 usb_mark_last_busy(data->udev);
5e23b923
MH		 1044 }
1045
54a8a79c 1046 usb_free_urb(urb);
5e23b923
MH		 1047 return err;
1048}
1049
047b2ec8
MH		 1050static int submit_or_queue_tx_urb(struct hci_dev *hdev, struct urb *urb)
1051{
1052 struct btusb_data *data = hci_get_drvdata(hdev);
1053 unsigned long flags;
1054 bool suspending;
1055
1056 spin_lock_irqsave(&data->txlock, flags);
1057 suspending = test_bit(BTUSB_SUSPENDING, &data->flags);
1058 if (!suspending)
1059 data->tx_in_flight++;
1060 spin_unlock_irqrestore(&data->txlock, flags);
1061
1062 if (!suspending)
1063 return submit_tx_urb(hdev, urb);
1064
1065 usb_anchor_urb(urb, &data->deferred);
1066 schedule_work(&data->waker);
1067
1068 usb_free_urb(urb);
1069 return 0;
1070}
1071
1072static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb)
1073{
1074 struct urb *urb;
1075
1076 BT_DBG("%s", hdev->name);
1077
1078 if (!test_bit(HCI_RUNNING, &hdev->flags))
1079 return -EBUSY;
1080
1081 switch (bt_cb(skb)->pkt_type) {
1082 case HCI_COMMAND_PKT:
1083 urb = alloc_ctrl_urb(hdev, skb);
1084 if (IS_ERR(urb))
1085 return PTR_ERR(urb);
1086
1087 hdev->stat.cmd_tx++;
1088 return submit_or_queue_tx_urb(hdev, urb);
1089
1090 case HCI_ACLDATA_PKT:
1091 urb = alloc_bulk_urb(hdev, skb);
1092 if (IS_ERR(urb))
1093 return PTR_ERR(urb);
1094
1095 hdev->stat.acl_tx++;
1096 return submit_or_queue_tx_urb(hdev, urb);
1097
1098 case HCI_SCODATA_PKT:
1099 if (hci_conn_num(hdev, SCO_LINK) < 1)
1100 return -ENODEV;
1101
1102 urb = alloc_isoc_urb(hdev, skb);
1103 if (IS_ERR(urb))
1104 return PTR_ERR(urb);
1105
1106 hdev->stat.sco_tx++;
1107 return submit_tx_urb(hdev, urb);
1108 }
1109
1110 return -EILSEQ;
1111}
1112
5e23b923
MH		 1113static void btusb_notify(struct hci_dev *hdev, unsigned int evt)
1114{
155961e8 1115 struct btusb_data *data = hci_get_drvdata(hdev);
5e23b923
MH		 1116
1117 BT_DBG("%s evt %d", hdev->name, evt);
1118
014f7bc7
MH		 1119 if (hci_conn_num(hdev, SCO_LINK) != data->sco_num) {
1120 data->sco_num = hci_conn_num(hdev, SCO_LINK);
43c2e57f 1121 schedule_work(&data->work);
a780efa8 1122 }
5e23b923
MH		 1123}
1124
42b16b3f 1125static inline int __set_isoc_interface(struct hci_dev *hdev, int altsetting)
9bfa35fe 1126{
155961e8 1127 struct btusb_data *data = hci_get_drvdata(hdev);
9bfa35fe
MH		 1128 struct usb_interface *intf = data->isoc;
1129 struct usb_endpoint_descriptor *ep_desc;
1130 int i, err;
1131
1132 if (!data->isoc)
1133 return -ENODEV;
1134
1135 err = usb_set_interface(data->udev, 1, altsetting);
1136 if (err < 0) {
1137 BT_ERR("%s setting interface failed (%d)", hdev->name, -err);
1138 return err;
1139 }
1140
1141 data->isoc_altsetting = altsetting;
1142
1143 data->isoc_tx_ep = NULL;
1144 data->isoc_rx_ep = NULL;
1145
1146 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
1147 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
1148
1149 if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) {
1150 data->isoc_tx_ep = ep_desc;
1151 continue;
1152 }
1153
1154 if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) {
1155 data->isoc_rx_ep = ep_desc;
1156 continue;
1157 }
1158 }
1159
1160 if (!data->isoc_tx_ep || !data->isoc_rx_ep) {
1161 BT_ERR("%s invalid SCO descriptors", hdev->name);
1162 return -ENODEV;
1163 }
1164
1165 return 0;
1166}
1167
5e23b923
MH		 1168static void btusb_work(struct work_struct *work)
1169{
1170 struct btusb_data *data = container_of(work, struct btusb_data, work);
1171 struct hci_dev *hdev = data->hdev;
f4001d28 1172 int new_alts;
7bee549e 1173 int err;
5e23b923 1174
014f7bc7 1175 if (data->sco_num > 0) {
08b8b6c4 1176 if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) {
8efdd0cd 1177 err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf);
7bee549e
ON		 1178 if (err < 0) {
1179 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1180 usb_kill_anchored_urbs(&data->isoc_anchor);
1181 return;
1182 }
1183
08b8b6c4 1184 set_bit(BTUSB_DID_ISO_RESUME, &data->flags);
7bee549e 1185 }
f4001d28
MA		 1186
1187 if (hdev->voice_setting & 0x0020) {
1188 static const int alts[3] = { 2, 4, 5 };
89e7533d 1189
014f7bc7 1190 new_alts = alts[data->sco_num - 1];
f4001d28 1191 } else {
014f7bc7 1192 new_alts = data->sco_num;
f4001d28
MA		 1193 }
1194
1195 if (data->isoc_altsetting != new_alts) {
9bfa35fe
MH		 1196 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1197 usb_kill_anchored_urbs(&data->isoc_anchor);
1198
f4001d28 1199 if (__set_isoc_interface(hdev, new_alts) < 0)
9bfa35fe
MH		 1200 return;
1201 }
1202
1203 if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
2eda66f4 1204 if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0)
9bfa35fe
MH		 1205 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1206 else
2eda66f4 1207 btusb_submit_isoc_urb(hdev, GFP_KERNEL);
9bfa35fe
MH		 1208 }
1209 } else {
1210 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
1211 usb_kill_anchored_urbs(&data->isoc_anchor);
1212
1213 __set_isoc_interface(hdev, 0);
08b8b6c4 1214 if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags))
8efdd0cd 1215 usb_autopm_put_interface(data->isoc ? data->isoc : data->intf);
5e23b923
MH		 1216 }
1217}
1218
7bee549e
ON		 1219static void btusb_waker(struct work_struct *work)
1220{
1221 struct btusb_data *data = container_of(work, struct btusb_data, waker);
1222 int err;
1223
1224 err = usb_autopm_get_interface(data->intf);
1225 if (err < 0)
1226 return;
1227
1228 usb_autopm_put_interface(data->intf);
1229}
1230
9f8f962c
MH		 1231static int btusb_setup_bcm92035(struct hci_dev *hdev)
1232{
1233 struct sk_buff *skb;
1234 u8 val = 0x00;
1235
1236 BT_DBG("%s", hdev->name);
1237
1238 skb = __hci_cmd_sync(hdev, 0xfc3b, 1, &val, HCI_INIT_TIMEOUT);
1239 if (IS_ERR(skb))
1240 BT_ERR("BCM92035 command failed (%ld)", -PTR_ERR(skb));
1241 else
1242 kfree_skb(skb);
1243
1244 return 0;
1245}
1246
81cac64b
MH		 1247static int btusb_setup_csr(struct hci_dev *hdev)
1248{
1249 struct hci_rp_read_local_version *rp;
1250 struct sk_buff *skb;
1251 int ret;
1252
1253 BT_DBG("%s", hdev->name);
1254
1255 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1256 HCI_INIT_TIMEOUT);
1257 if (IS_ERR(skb)) {
1258 BT_ERR("Reading local version failed (%ld)", -PTR_ERR(skb));
1259 return -PTR_ERR(skb);
1260 }
1261
89e7533d 1262 rp = (struct hci_rp_read_local_version *)skb->data;
81cac64b
MH		 1263
1264 if (!rp->status) {
1265 if (le16_to_cpu(rp->manufacturer) != 10) {
1266 /* Clear the reset quirk since this is not an actual
1267 * early Bluetooth 1.1 device from CSR.
1268 */
1269 clear_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
1270
1271 /* These fake CSR controllers have all a broken
1272 * stored link key handling and so just disable it.
1273 */
1274 set_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY,
1275 &hdev->quirks);
1276 }
1277 }
1278
1279 ret = -bt_to_errno(rp->status);
1280
1281 kfree_skb(skb);
1282
1283 return ret;
1284}
1285
dffd30ee
THJA		 1286struct intel_version {
1287 u8 status;
1288 u8 hw_platform;
1289 u8 hw_variant;
1290 u8 hw_revision;
1291 u8 fw_variant;
1292 u8 fw_revision;
1293 u8 fw_build_num;
1294 u8 fw_build_ww;
1295 u8 fw_build_yy;
1296 u8 fw_patch_num;
1297} __packed;
1298
1299static const struct firmware *btusb_setup_intel_get_fw(struct hci_dev *hdev,
89e7533d 1300 struct intel_version *ver)
dffd30ee
THJA		 1301{
1302 const struct firmware *fw;
1303 char fwname[64];
1304 int ret;
1305
1306 snprintf(fwname, sizeof(fwname),
1307 "intel/ibt-hw-%x.%x.%x-fw-%x.%x.%x.%x.%x.bseq",
1308 ver->hw_platform, ver->hw_variant, ver->hw_revision,
1309 ver->fw_variant, ver->fw_revision, ver->fw_build_num,
1310 ver->fw_build_ww, ver->fw_build_yy);
1311
1312 ret = request_firmware(&fw, fwname, &hdev->dev);
1313 if (ret < 0) {
1314 if (ret == -EINVAL) {
1315 BT_ERR("%s Intel firmware file request failed (%d)",
1316 hdev->name, ret);
1317 return NULL;
1318 }
1319
1320 BT_ERR("%s failed to open Intel firmware file: %s(%d)",
1321 hdev->name, fwname, ret);
1322
1323 /* If the correct firmware patch file is not found, use the
1324 * default firmware patch file instead
1325 */
1326 snprintf(fwname, sizeof(fwname), "intel/ibt-hw-%x.%x.bseq",
1327 ver->hw_platform, ver->hw_variant);
1328 if (request_firmware(&fw, fwname, &hdev->dev) < 0) {
1329 BT_ERR("%s failed to open default Intel fw file: %s",
1330 hdev->name, fwname);
1331 return NULL;
1332 }
1333 }
1334
1335 BT_INFO("%s: Intel Bluetooth firmware file: %s", hdev->name, fwname);
1336
1337 return fw;
1338}
1339
1340static int btusb_setup_intel_patching(struct hci_dev *hdev,
1341 const struct firmware *fw,
1342 const u8 **fw_ptr, int *disable_patch)
1343{
1344 struct sk_buff *skb;
1345 struct hci_command_hdr *cmd;
1346 const u8 *cmd_param;
1347 struct hci_event_hdr *evt = NULL;
1348 const u8 *evt_param = NULL;
1349 int remain = fw->size - (*fw_ptr - fw->data);
1350
1351 /* The first byte indicates the types of the patch command or event.
1352 * 0x01 means HCI command and 0x02 is HCI event. If the first bytes
1353 * in the current firmware buffer doesn't start with 0x01 or
1354 * the size of remain buffer is smaller than HCI command header,
1355 * the firmware file is corrupted and it should stop the patching
1356 * process.
1357 */
1358 if (remain > HCI_COMMAND_HDR_SIZE && *fw_ptr[0] != 0x01) {
1359 BT_ERR("%s Intel fw corrupted: invalid cmd read", hdev->name);
1360 return -EINVAL;
1361 }
1362 (*fw_ptr)++;
1363 remain--;
1364
1365 cmd = (struct hci_command_hdr *)(*fw_ptr);
1366 *fw_ptr += sizeof(*cmd);
1367 remain -= sizeof(*cmd);
1368
1369 /* Ensure that the remain firmware data is long enough than the length
1370 * of command parameter. If not, the firmware file is corrupted.
1371 */
1372 if (remain < cmd->plen) {
1373 BT_ERR("%s Intel fw corrupted: invalid cmd len", hdev->name);
1374 return -EFAULT;
1375 }
1376
1377 /* If there is a command that loads a patch in the firmware
1378 * file, then enable the patch upon success, otherwise just
1379 * disable the manufacturer mode, for example patch activation
1380 * is not required when the default firmware patch file is used
1381 * because there are no patch data to load.
1382 */
1383 if (*disable_patch && le16_to_cpu(cmd->opcode) == 0xfc8e)
1384 *disable_patch = 0;
1385
1386 cmd_param = *fw_ptr;
1387 *fw_ptr += cmd->plen;
1388 remain -= cmd->plen;
1389
1390 /* This reads the expected events when the above command is sent to the
1391 * device. Some vendor commands expects more than one events, for
1392 * example command status event followed by vendor specific event.
1393 * For this case, it only keeps the last expected event. so the command
1394 * can be sent with __hci_cmd_sync_ev() which returns the sk_buff of
1395 * last expected event.
1396 */
1397 while (remain > HCI_EVENT_HDR_SIZE && *fw_ptr[0] == 0x02) {
1398 (*fw_ptr)++;
1399 remain--;
1400
1401 evt = (struct hci_event_hdr *)(*fw_ptr);
1402 *fw_ptr += sizeof(*evt);
1403 remain -= sizeof(*evt);
1404
1405 if (remain < evt->plen) {
1406 BT_ERR("%s Intel fw corrupted: invalid evt len",
1407 hdev->name);
1408 return -EFAULT;
1409 }
1410
1411 evt_param = *fw_ptr;
1412 *fw_ptr += evt->plen;
1413 remain -= evt->plen;
1414 }
1415
1416 /* Every HCI commands in the firmware file has its correspond event.
1417 * If event is not found or remain is smaller than zero, the firmware
1418 * file is corrupted.
1419 */
1420 if (!evt || !evt_param || remain < 0) {
1421 BT_ERR("%s Intel fw corrupted: invalid evt read", hdev->name);
1422 return -EFAULT;
1423 }
1424
1425 skb = __hci_cmd_sync_ev(hdev, le16_to_cpu(cmd->opcode), cmd->plen,
1426 cmd_param, evt->evt, HCI_INIT_TIMEOUT);
1427 if (IS_ERR(skb)) {
1428 BT_ERR("%s sending Intel patch command (0x%4.4x) failed (%ld)",
1429 hdev->name, cmd->opcode, PTR_ERR(skb));
d9c78e97 1430 return PTR_ERR(skb);
dffd30ee
THJA		 1431 }
1432
1433 /* It ensures that the returned event matches the event data read from
1434 * the firmware file. At fist, it checks the length and then
1435 * the contents of the event.
1436 */
1437 if (skb->len != evt->plen) {
1438 BT_ERR("%s mismatch event length (opcode 0x%4.4x)", hdev->name,
1439 le16_to_cpu(cmd->opcode));
1440 kfree_skb(skb);
1441 return -EFAULT;
1442 }
1443
1444 if (memcmp(skb->data, evt_param, evt->plen)) {
1445 BT_ERR("%s mismatch event parameter (opcode 0x%4.4x)",
1446 hdev->name, le16_to_cpu(cmd->opcode));
1447 kfree_skb(skb);
1448 return -EFAULT;
1449 }
1450 kfree_skb(skb);
1451
1452 return 0;
1453}
1454
40cb0984
MH		 1455#define BDADDR_INTEL (&(bdaddr_t) {{0x00, 0x8b, 0x9e, 0x19, 0x03, 0x00}})
1456
1457static int btusb_check_bdaddr_intel(struct hci_dev *hdev)
1458{
1459 struct sk_buff *skb;
1460 struct hci_rp_read_bd_addr *rp;
1461
1462 skb = __hci_cmd_sync(hdev, HCI_OP_READ_BD_ADDR, 0, NULL,
1463 HCI_INIT_TIMEOUT);
1464 if (IS_ERR(skb)) {
1465 BT_ERR("%s reading Intel device address failed (%ld)",
1466 hdev->name, PTR_ERR(skb));
1467 return PTR_ERR(skb);
1468 }
1469
1470 if (skb->len != sizeof(*rp)) {
1471 BT_ERR("%s Intel device address length mismatch", hdev->name);
1472 kfree_skb(skb);
1473 return -EIO;
1474 }
1475
89e7533d 1476 rp = (struct hci_rp_read_bd_addr *)skb->data;
40cb0984
MH		 1477 if (rp->status) {
1478 BT_ERR("%s Intel device address result failed (%02x)",
1479 hdev->name, rp->status);
1480 kfree_skb(skb);
1481 return -bt_to_errno(rp->status);
1482 }
1483
1484 /* For some Intel based controllers, the default Bluetooth device
1485 * address 00:03:19:9E:8B:00 can be found. These controllers are
1486 * fully operational, but have the danger of duplicate addresses
1487 * and that in turn can cause problems with Bluetooth operation.
1488 */
4739b5b1 1489 if (!bacmp(&rp->bdaddr, BDADDR_INTEL)) {
40cb0984
MH		 1490 BT_ERR("%s found Intel default device address (%pMR)",
1491 hdev->name, &rp->bdaddr);
4739b5b1
MH		 1492 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
1493 }
40cb0984
MH		 1494
1495 kfree_skb(skb);
1496
1497 return 0;
1498}
1499
dffd30ee
THJA		 1500static int btusb_setup_intel(struct hci_dev *hdev)
1501{
1502 struct sk_buff *skb;
1503 const struct firmware *fw;
1504 const u8 *fw_ptr;
1505 int disable_patch;
1506 struct intel_version *ver;
1507
1508 const u8 mfg_enable[] = { 0x01, 0x00 };
1509 const u8 mfg_disable[] = { 0x00, 0x00 };
1510 const u8 mfg_reset_deactivate[] = { 0x00, 0x01 };
1511 const u8 mfg_reset_activate[] = { 0x00, 0x02 };
1512
1513 BT_DBG("%s", hdev->name);
1514
1515 /* The controller has a bug with the first HCI command sent to it
1516 * returning number of completed commands as zero. This would stall the
1517 * command processing in the Bluetooth core.
1518 *
1519 * As a workaround, send HCI Reset command first which will reset the
1520 * number of completed commands and allow normal command processing
1521 * from now on.
1522 */
1523 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1524 if (IS_ERR(skb)) {
1525 BT_ERR("%s sending initial HCI reset command failed (%ld)",
1526 hdev->name, PTR_ERR(skb));
d9c78e97 1527 return PTR_ERR(skb);
dffd30ee
THJA		 1528 }
1529 kfree_skb(skb);
1530
1531 /* Read Intel specific controller version first to allow selection of
1532 * which firmware file to load.
1533 *
1534 * The returned information are hardware variant and revision plus
1535 * firmware variant, revision and build number.
1536 */
1537 skb = __hci_cmd_sync(hdev, 0xfc05, 0, NULL, HCI_INIT_TIMEOUT);
1538 if (IS_ERR(skb)) {
1539 BT_ERR("%s reading Intel fw version command failed (%ld)",
1540 hdev->name, PTR_ERR(skb));
d9c78e97 1541 return PTR_ERR(skb);
dffd30ee
THJA		 1542 }
1543
1544 if (skb->len != sizeof(*ver)) {
1545 BT_ERR("%s Intel version event length mismatch", hdev->name);
1546 kfree_skb(skb);
1547 return -EIO;
1548 }
1549
1550 ver = (struct intel_version *)skb->data;
1551 if (ver->status) {
1552 BT_ERR("%s Intel fw version event failed (%02x)", hdev->name,
1553 ver->status);
1554 kfree_skb(skb);
1555 return -bt_to_errno(ver->status);
1556 }
1557
1558 BT_INFO("%s: read Intel version: %02x%02x%02x%02x%02x%02x%02x%02x%02x",
1559 hdev->name, ver->hw_platform, ver->hw_variant,
1560 ver->hw_revision, ver->fw_variant, ver->fw_revision,
1561 ver->fw_build_num, ver->fw_build_ww, ver->fw_build_yy,
1562 ver->fw_patch_num);
1563
1564 /* fw_patch_num indicates the version of patch the device currently
1565 * have. If there is no patch data in the device, it is always 0x00.
1566 * So, if it is other than 0x00, no need to patch the deivce again.
1567 */
1568 if (ver->fw_patch_num) {
1569 BT_INFO("%s: Intel device is already patched. patch num: %02x",
1570 hdev->name, ver->fw_patch_num);
1571 kfree_skb(skb);
40cb0984 1572 btusb_check_bdaddr_intel(hdev);
dffd30ee
THJA		 1573 return 0;
1574 }
1575
1576 /* Opens the firmware patch file based on the firmware version read
1577 * from the controller. If it fails to open the matching firmware
1578 * patch file, it tries to open the default firmware patch file.
1579 * If no patch file is found, allow the device to operate without
1580 * a patch.
1581 */
1582 fw = btusb_setup_intel_get_fw(hdev, ver);
1583 if (!fw) {
1584 kfree_skb(skb);
40cb0984 1585 btusb_check_bdaddr_intel(hdev);
dffd30ee
THJA		 1586 return 0;
1587 }
1588 fw_ptr = fw->data;
1589
1590 /* This Intel specific command enables the manufacturer mode of the
1591 * controller.
1592 *
1593 * Only while this mode is enabled, the driver can download the
1594 * firmware patch data and configuration parameters.
1595 */
1596 skb = __hci_cmd_sync(hdev, 0xfc11, 2, mfg_enable, HCI_INIT_TIMEOUT);
1597 if (IS_ERR(skb)) {
1598 BT_ERR("%s entering Intel manufacturer mode failed (%ld)",
1599 hdev->name, PTR_ERR(skb));
1600 release_firmware(fw);
d9c78e97 1601 return PTR_ERR(skb);
dffd30ee
THJA		 1602 }
1603
1604 if (skb->data[0]) {
1605 u8 evt_status = skb->data[0];
89e7533d 1606
dffd30ee
THJA		 1607 BT_ERR("%s enable Intel manufacturer mode event failed (%02x)",
1608 hdev->name, evt_status);
1609 kfree_skb(skb);
1610 release_firmware(fw);
1611 return -bt_to_errno(evt_status);
1612 }
1613 kfree_skb(skb);
1614
1615 disable_patch = 1;
1616
1617 /* The firmware data file consists of list of Intel specific HCI
1618 * commands and its expected events. The first byte indicates the
1619 * type of the message, either HCI command or HCI event.
1620 *
1621 * It reads the command and its expected event from the firmware file,
1622 * and send to the controller. Once __hci_cmd_sync_ev() returns,
1623 * the returned event is compared with the event read from the firmware
1624 * file and it will continue until all the messages are downloaded to
1625 * the controller.
1626 *
1627 * Once the firmware patching is completed successfully,
1628 * the manufacturer mode is disabled with reset and activating the
1629 * downloaded patch.
1630 *
1631 * If the firmware patching fails, the manufacturer mode is
1632 * disabled with reset and deactivating the patch.
1633 *
1634 * If the default patch file is used, no reset is done when disabling
1635 * the manufacturer.
1636 */
1637 while (fw->size > fw_ptr - fw->data) {
1638 int ret;
1639
1640 ret = btusb_setup_intel_patching(hdev, fw, &fw_ptr,
1641 &disable_patch);
1642 if (ret < 0)
1643 goto exit_mfg_deactivate;
1644 }
1645
1646 release_firmware(fw);
1647
1648 if (disable_patch)
1649 goto exit_mfg_disable;
1650
1651 /* Patching completed successfully and disable the manufacturer mode
1652 * with reset and activate the downloaded firmware patches.
1653 */
1654 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_activate),
1655 mfg_reset_activate, HCI_INIT_TIMEOUT);
1656 if (IS_ERR(skb)) {
1657 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1658 hdev->name, PTR_ERR(skb));
d9c78e97 1659 return PTR_ERR(skb);
dffd30ee
THJA		 1660 }
1661 kfree_skb(skb);
1662
1663 BT_INFO("%s: Intel Bluetooth firmware patch completed and activated",
1664 hdev->name);
1665
40cb0984 1666 btusb_check_bdaddr_intel(hdev);
dffd30ee
THJA		 1667 return 0;
1668
1669exit_mfg_disable:
1670 /* Disable the manufacturer mode without reset */
1671 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_disable), mfg_disable,
1672 HCI_INIT_TIMEOUT);
1673 if (IS_ERR(skb)) {
1674 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1675 hdev->name, PTR_ERR(skb));
d9c78e97 1676 return PTR_ERR(skb);
dffd30ee
THJA		 1677 }
1678 kfree_skb(skb);
1679
1680 BT_INFO("%s: Intel Bluetooth firmware patch completed", hdev->name);
40cb0984
MH		 1681
1682 btusb_check_bdaddr_intel(hdev);
dffd30ee
THJA		 1683 return 0;
1684
1685exit_mfg_deactivate:
1686 release_firmware(fw);
1687
1688 /* Patching failed. Disable the manufacturer mode with reset and
1689 * deactivate the downloaded firmware patches.
1690 */
1691 skb = __hci_cmd_sync(hdev, 0xfc11, sizeof(mfg_reset_deactivate),
1692 mfg_reset_deactivate, HCI_INIT_TIMEOUT);
1693 if (IS_ERR(skb)) {
1694 BT_ERR("%s exiting Intel manufacturer mode failed (%ld)",
1695 hdev->name, PTR_ERR(skb));
d9c78e97 1696 return PTR_ERR(skb);
dffd30ee
THJA		 1697 }
1698 kfree_skb(skb);
1699
1700 BT_INFO("%s: Intel Bluetooth firmware patch completed and deactivated",
1701 hdev->name);
1702
40cb0984 1703 btusb_check_bdaddr_intel(hdev);
dffd30ee
THJA		 1704 return 0;
1705}
1706
cb8d6597
MH		 1707static int btusb_set_bdaddr_intel(struct hci_dev *hdev, const bdaddr_t *bdaddr)
1708{
1709 struct sk_buff *skb;
1710 long ret;
1711
1712 skb = __hci_cmd_sync(hdev, 0xfc31, 6, bdaddr, HCI_INIT_TIMEOUT);
1713 if (IS_ERR(skb)) {
1714 ret = PTR_ERR(skb);
1715 BT_ERR("%s: changing Intel device address failed (%ld)",
89e7533d 1716 hdev->name, ret);
cb8d6597
MH		 1717 return ret;
1718 }
1719 kfree_skb(skb);
1720
1721 return 0;
1722}
1723
ae8df494
AK		 1724static int btusb_set_bdaddr_marvell(struct hci_dev *hdev,
1725 const bdaddr_t *bdaddr)
1726{
1727 struct sk_buff *skb;
1728 u8 buf[8];
1729 long ret;
1730
1731 buf[0] = 0xfe;
1732 buf[1] = sizeof(bdaddr_t);
1733 memcpy(buf + 2, bdaddr, sizeof(bdaddr_t));
1734
1735 skb = __hci_cmd_sync(hdev, 0xfc22, sizeof(buf), buf, HCI_INIT_TIMEOUT);
1736 if (IS_ERR(skb)) {
1737 ret = PTR_ERR(skb);
1738 BT_ERR("%s: changing Marvell device address failed (%ld)",
1739 hdev->name, ret);
1740 return ret;
1741 }
1742 kfree_skb(skb);
1743
1744 return 0;
1745}
1746
c8abb73f
MH		 1747#define BDADDR_BCM20702A0 (&(bdaddr_t) {{0x00, 0xa0, 0x02, 0x70, 0x20, 0x00}})
1748
10d4c673
PG		 1749static int btusb_setup_bcm_patchram(struct hci_dev *hdev)
1750{
1751 struct btusb_data *data = hci_get_drvdata(hdev);
1752 struct usb_device *udev = data->udev;
1753 char fw_name[64];
1754 const struct firmware *fw;
1755 const u8 *fw_ptr;
1756 size_t fw_size;
1757 const struct hci_command_hdr *cmd;
1758 const u8 *cmd_param;
1759 u16 opcode;
1760 struct sk_buff *skb;
1761 struct hci_rp_read_local_version *ver;
c8abb73f 1762 struct hci_rp_read_bd_addr *bda;
10d4c673
PG		 1763 long ret;
1764
1765 snprintf(fw_name, sizeof(fw_name), "brcm/%s-%04x-%04x.hcd",
1766 udev->product ? udev->product : "BCM",
1767 le16_to_cpu(udev->descriptor.idVendor),
1768 le16_to_cpu(udev->descriptor.idProduct));
1769
1770 ret = request_firmware(&fw, fw_name, &hdev->dev);
1771 if (ret < 0) {
c8abb73f 1772 BT_INFO("%s: BCM: patch %s not found", hdev->name, fw_name);
10d4c673
PG		 1773 return 0;
1774 }
1775
1776 /* Reset */
1777 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1778 if (IS_ERR(skb)) {
1779 ret = PTR_ERR(skb);
1780 BT_ERR("%s: HCI_OP_RESET failed (%ld)", hdev->name, ret);
1781 goto done;
1782 }
1783 kfree_skb(skb);
1784
1785 /* Read Local Version Info */
1786 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1787 HCI_INIT_TIMEOUT);
1788 if (IS_ERR(skb)) {
1789 ret = PTR_ERR(skb);
1790 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION failed (%ld)",
89e7533d 1791 hdev->name, ret);
10d4c673
PG		 1792 goto done;
1793 }
1794
1795 if (skb->len != sizeof(*ver)) {
1796 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION event length mismatch",
89e7533d 1797 hdev->name);
10d4c673
PG		 1798 kfree_skb(skb);
1799 ret = -EIO;
1800 goto done;
1801 }
1802
89e7533d 1803 ver = (struct hci_rp_read_local_version *)skb->data;
10d4c673
PG		 1804 BT_INFO("%s: BCM: patching hci_ver=%02x hci_rev=%04x lmp_ver=%02x "
1805 "lmp_subver=%04x", hdev->name, ver->hci_ver, ver->hci_rev,
1806 ver->lmp_ver, ver->lmp_subver);
1807 kfree_skb(skb);
1808
1809 /* Start Download */
1810 skb = __hci_cmd_sync(hdev, 0xfc2e, 0, NULL, HCI_INIT_TIMEOUT);
1811 if (IS_ERR(skb)) {
1812 ret = PTR_ERR(skb);
1813 BT_ERR("%s: BCM: Download Minidrv command failed (%ld)",
89e7533d 1814 hdev->name, ret);
10d4c673
PG		 1815 goto reset_fw;
1816 }
1817 kfree_skb(skb);
1818
1819 /* 50 msec delay after Download Minidrv completes */
1820 msleep(50);
1821
1822 fw_ptr = fw->data;
1823 fw_size = fw->size;
1824
1825 while (fw_size >= sizeof(*cmd)) {
89e7533d 1826 cmd = (struct hci_command_hdr *)fw_ptr;
10d4c673
PG		 1827 fw_ptr += sizeof(*cmd);
1828 fw_size -= sizeof(*cmd);
1829
1830 if (fw_size < cmd->plen) {
1831 BT_ERR("%s: BCM: patch %s is corrupted",
89e7533d 1832 hdev->name, fw_name);
10d4c673
PG		 1833 ret = -EINVAL;
1834 goto reset_fw;
1835 }
1836
1837 cmd_param = fw_ptr;
1838 fw_ptr += cmd->plen;
1839 fw_size -= cmd->plen;
1840
1841 opcode = le16_to_cpu(cmd->opcode);
1842
1843 skb = __hci_cmd_sync(hdev, opcode, cmd->plen, cmd_param,
1844 HCI_INIT_TIMEOUT);
1845 if (IS_ERR(skb)) {
1846 ret = PTR_ERR(skb);
1847 BT_ERR("%s: BCM: patch command %04x failed (%ld)",
89e7533d 1848 hdev->name, opcode, ret);
10d4c673
PG		 1849 goto reset_fw;
1850 }
1851 kfree_skb(skb);
1852 }
1853
1854 /* 250 msec delay after Launch Ram completes */
1855 msleep(250);
1856
1857reset_fw:
1858 /* Reset */
1859 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT);
1860 if (IS_ERR(skb)) {
1861 ret = PTR_ERR(skb);
1862 BT_ERR("%s: HCI_OP_RESET failed (%ld)", hdev->name, ret);
1863 goto done;
1864 }
1865 kfree_skb(skb);
1866
1867 /* Read Local Version Info */
1868 skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
1869 HCI_INIT_TIMEOUT);
1870 if (IS_ERR(skb)) {
1871 ret = PTR_ERR(skb);
1872 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION failed (%ld)",
89e7533d 1873 hdev->name, ret);
10d4c673
PG		 1874 goto done;
1875 }
1876
1877 if (skb->len != sizeof(*ver)) {
1878 BT_ERR("%s: HCI_OP_READ_LOCAL_VERSION event length mismatch",
89e7533d 1879 hdev->name);
10d4c673
PG		 1880 kfree_skb(skb);
1881 ret = -EIO;
1882 goto done;
1883 }
1884
89e7533d 1885 ver = (struct hci_rp_read_local_version *)skb->data;
10d4c673
PG		 1886 BT_INFO("%s: BCM: firmware hci_ver=%02x hci_rev=%04x lmp_ver=%02x "
1887 "lmp_subver=%04x", hdev->name, ver->hci_ver, ver->hci_rev,
1888 ver->lmp_ver, ver->lmp_subver);
1889 kfree_skb(skb);
1890
c8abb73f
MH		 1891 /* Read BD Address */
1892 skb = __hci_cmd_sync(hdev, HCI_OP_READ_BD_ADDR, 0, NULL,
1893 HCI_INIT_TIMEOUT);
1894 if (IS_ERR(skb)) {
1895 ret = PTR_ERR(skb);
1896 BT_ERR("%s: HCI_OP_READ_BD_ADDR failed (%ld)",
89e7533d 1897 hdev->name, ret);
c8abb73f
MH		 1898 goto done;
1899 }
1900
1901 if (skb->len != sizeof(*bda)) {
1902 BT_ERR("%s: HCI_OP_READ_BD_ADDR event length mismatch",
89e7533d 1903 hdev->name);
c8abb73f
MH		 1904 kfree_skb(skb);
1905 ret = -EIO;
1906 goto done;
1907 }
1908
89e7533d 1909 bda = (struct hci_rp_read_bd_addr *)skb->data;
c8abb73f
MH		 1910 if (bda->status) {
1911 BT_ERR("%s: HCI_OP_READ_BD_ADDR error status (%02x)",
1912 hdev->name, bda->status);
1913 kfree_skb(skb);
1914 ret = -bt_to_errno(bda->status);
1915 goto done;
1916 }
1917
1918 /* The address 00:20:70:02:A0:00 indicates a BCM20702A0 controller
1919 * with no configured address.
1920 */
849e5086 1921 if (!bacmp(&bda->bdaddr, BDADDR_BCM20702A0)) {
c8abb73f
MH		 1922 BT_INFO("%s: BCM: using default device address (%pMR)",
1923 hdev->name, &bda->bdaddr);
849e5086
MH		 1924 set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks);
1925 }
c8abb73f
MH		 1926
1927 kfree_skb(skb);
1928
10d4c673
PG		 1929done:
1930 release_firmware(fw);
1931
1932 return ret;
1933}
1934
abbaf50e
MH		 1935static int btusb_set_bdaddr_bcm(struct hci_dev *hdev, const bdaddr_t *bdaddr)
1936{
1937 struct sk_buff *skb;
1938 long ret;
1939
1940 skb = __hci_cmd_sync(hdev, 0xfc01, 6, bdaddr, HCI_INIT_TIMEOUT);
1941 if (IS_ERR(skb)) {
1942 ret = PTR_ERR(skb);
1943 BT_ERR("%s: BCM: Change address command failed (%ld)",
89e7533d 1944 hdev->name, ret);
abbaf50e
MH		 1945 return ret;
1946 }
1947 kfree_skb(skb);
1948
1949 return 0;
1950}
1951
5859223e
TK		 1952static int btusb_set_bdaddr_ath3012(struct hci_dev *hdev,
1953 const bdaddr_t *bdaddr)
1954{
1955 struct sk_buff *skb;
1956 u8 buf[10];
1957 long ret;
1958
1959 buf[0] = 0x01;
1960 buf[1] = 0x01;
1961 buf[2] = 0x00;
1962 buf[3] = sizeof(bdaddr_t);
1963 memcpy(buf + 4, bdaddr, sizeof(bdaddr_t));
1964
1965 skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT);
1966 if (IS_ERR(skb)) {
1967 ret = PTR_ERR(skb);
1968 BT_ERR("%s: Change address command failed (%ld)",
1969 hdev->name, ret);
1970 return ret;
1971 }
1972 kfree_skb(skb);
1973
1974 return 0;
1975}
1976
5e23b923 1977static int btusb_probe(struct usb_interface *intf,
89e7533d 1978 const struct usb_device_id *id)
5e23b923
MH		 1979{
1980 struct usb_endpoint_descriptor *ep_desc;
1981 struct btusb_data *data;
1982 struct hci_dev *hdev;
1983 int i, err;
1984
1985 BT_DBG("intf %p id %p", intf, id);
1986
cfeb4145 1987 /* interface numbers are hardcoded in the spec */
5e23b923
MH		 1988 if (intf->cur_altsetting->desc.bInterfaceNumber != 0)
1989 return -ENODEV;
1990
1991 if (!id->driver_info) {
1992 const struct usb_device_id *match;
89e7533d 1993
5e23b923
MH		 1994 match = usb_match_id(intf, blacklist_table);
1995 if (match)
1996 id = match;
1997 }
1998
cfeb4145
MH		 1999 if (id->driver_info == BTUSB_IGNORE)
2000 return -ENODEV;
2001
2d25f8b4
SL		 2002 if (id->driver_info & BTUSB_ATH3012) {
2003 struct usb_device *udev = interface_to_usbdev(intf);
2004
2005 /* Old firmware would otherwise let ath3k driver load
2006 * patch and sysconfig files */
2007 if (le16_to_cpu(udev->descriptor.bcdDevice) <= 0x0001)
2008 return -ENODEV;
2009 }
2010
98921dbd 2011 data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL);
5e23b923
MH		 2012 if (!data)
2013 return -ENOMEM;
2014
2015 for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) {
2016 ep_desc = &intf->cur_altsetting->endpoint[i].desc;
2017
2018 if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) {
2019 data->intr_ep = ep_desc;
2020 continue;
2021 }
2022
2023 if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) {
2024 data->bulk_tx_ep = ep_desc;
2025 continue;
2026 }
2027
2028 if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) {
2029 data->bulk_rx_ep = ep_desc;
2030 continue;
2031 }
2032 }
2033
98921dbd 2034 if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep)
5e23b923 2035 return -ENODEV;
5e23b923 2036
7a9d4020
MH		 2037 data->cmdreq_type = USB_TYPE_CLASS;
2038
5e23b923 2039 data->udev = interface_to_usbdev(intf);
5fbcd260 2040 data->intf = intf;
5e23b923 2041
5e23b923 2042 INIT_WORK(&data->work, btusb_work);
7bee549e 2043 INIT_WORK(&data->waker, btusb_waker);
803b5836
MH		 2044 init_usb_anchor(&data->deferred);
2045 init_usb_anchor(&data->tx_anchor);
7bee549e 2046 spin_lock_init(&data->txlock);
5e23b923 2047
5e23b923
MH		 2048 init_usb_anchor(&data->intr_anchor);
2049 init_usb_anchor(&data->bulk_anchor);
9bfa35fe 2050 init_usb_anchor(&data->isoc_anchor);
803b5836 2051 spin_lock_init(&data->rxlock);
5e23b923 2052
97307f51 2053 data->recv_event = hci_recv_frame;
2cbd3f5c
MH		 2054 data->recv_bulk = btusb_recv_bulk;
2055
5e23b923 2056 hdev = hci_alloc_dev();
98921dbd 2057 if (!hdev)
5e23b923 2058 return -ENOMEM;
5e23b923 2059
c13854ce 2060 hdev->bus = HCI_USB;
155961e8 2061 hci_set_drvdata(hdev, data);
5e23b923
MH		 2062
2063 data->hdev = hdev;
2064
2065 SET_HCIDEV_DEV(hdev, &intf->dev);
2066
9f8f962c
MH		 2067 hdev->open = btusb_open;
2068 hdev->close = btusb_close;
2069 hdev->flush = btusb_flush;
2070 hdev->send = btusb_send_frame;
2071 hdev->notify = btusb_notify;
2072
2073 if (id->driver_info & BTUSB_BCM92035)
2074 hdev->setup = btusb_setup_bcm92035;
5e23b923 2075
abbaf50e 2076 if (id->driver_info & BTUSB_BCM_PATCHRAM) {
10d4c673 2077 hdev->setup = btusb_setup_bcm_patchram;
abbaf50e 2078 hdev->set_bdaddr = btusb_set_bdaddr_bcm;
27c3fbe0 2079 set_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks);
abbaf50e 2080 }
10d4c673 2081
cb8d6597 2082 if (id->driver_info & BTUSB_INTEL) {
dffd30ee 2083 hdev->setup = btusb_setup_intel;
cb8d6597
MH		 2084 hdev->set_bdaddr = btusb_set_bdaddr_intel;
2085 }
dffd30ee 2086
ae8df494
AK		 2087 if (id->driver_info & BTUSB_MARVELL)
2088 hdev->set_bdaddr = btusb_set_bdaddr_marvell;
2089
661cf88a
MH		 2090 if (id->driver_info & BTUSB_SWAVE) {
2091 set_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks);
d57dbe77 2092 set_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks);
661cf88a 2093 }
d57dbe77 2094
40df783d
MH		 2095 if (id->driver_info & BTUSB_INTEL_BOOT)
2096 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2097
5859223e
TK		 2098 if (id->driver_info & BTUSB_ATH3012)
2099 hdev->set_bdaddr = btusb_set_bdaddr_ath3012;
2100
7a9d4020 2101 /* Interface numbers are hardcoded in the specification */
9bfa35fe
MH		 2102 data->isoc = usb_ifnum_to_if(data->udev, 1);
2103
7a9d4020 2104 if (!reset)
a6c511c6 2105 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
cfeb4145
MH		 2106
2107 if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) {
2108 if (!disable_scofix)
2109 set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks);
2110 }
2111
9bfa35fe
MH		 2112 if (id->driver_info & BTUSB_BROKEN_ISOC)
2113 data->isoc = NULL;
2114
7a9d4020
MH		 2115 if (id->driver_info & BTUSB_DIGIANSWER) {
2116 data->cmdreq_type = USB_TYPE_VENDOR;
a6c511c6 2117 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
7a9d4020
MH		 2118 }
2119
2120 if (id->driver_info & BTUSB_CSR) {
2121 struct usb_device *udev = data->udev;
81cac64b 2122 u16 bcdDevice = le16_to_cpu(udev->descriptor.bcdDevice);
7a9d4020
MH		 2123
2124 /* Old firmware would otherwise execute USB reset */
81cac64b 2125 if (bcdDevice < 0x117)
a6c511c6 2126 set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks);
81cac64b
MH		 2127
2128 /* Fake CSR devices with broken commands */
2129 if (bcdDevice <= 0x100)
2130 hdev->setup = btusb_setup_csr;
7a9d4020
MH		 2131 }
2132
cfeb4145 2133 if (id->driver_info & BTUSB_SNIFFER) {
9bfa35fe 2134 struct usb_device *udev = data->udev;
cfeb4145 2135
7a9d4020 2136 /* New sniffer firmware has crippled HCI interface */
cfeb4145
MH		 2137 if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997)
2138 set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks);
2139 }
2140
3a5ef20c
MH		 2141 if (id->driver_info & BTUSB_INTEL_BOOT) {
2142 /* A bug in the bootloader causes that interrupt interface is
2143 * only enabled after receiving SetInterface(0, AltSetting=0).
2144 */
2145 err = usb_set_interface(data->udev, 0, 0);
2146 if (err < 0) {
2147 BT_ERR("failed to set interface 0, alt 0 %d", err);
2148 hci_free_dev(hdev);
2149 return err;
2150 }
2151 }
2152
9bfa35fe
MH		 2153 if (data->isoc) {
2154 err = usb_driver_claim_interface(&btusb_driver,
89e7533d 2155 data->isoc, data);
9bfa35fe
MH		 2156 if (err < 0) {
2157 hci_free_dev(hdev);
9bfa35fe
MH		 2158 return err;
2159 }
2160 }
2161
5e23b923
MH		 2162 err = hci_register_dev(hdev);
2163 if (err < 0) {
2164 hci_free_dev(hdev);
5e23b923
MH		 2165 return err;
2166 }
2167
2168 usb_set_intfdata(intf, data);
2169
2170 return 0;
2171}
2172
2173static void btusb_disconnect(struct usb_interface *intf)
2174{
2175 struct btusb_data *data = usb_get_intfdata(intf);
2176 struct hci_dev *hdev;
2177
2178 BT_DBG("intf %p", intf);
2179
2180 if (!data)
2181 return;
2182
2183 hdev = data->hdev;
5fbcd260
MH		 2184 usb_set_intfdata(data->intf, NULL);
2185
2186 if (data->isoc)
2187 usb_set_intfdata(data->isoc, NULL);
5e23b923
MH		 2188
2189 hci_unregister_dev(hdev);
2190
5fbcd260
MH		 2191 if (intf == data->isoc)
2192 usb_driver_release_interface(&btusb_driver, data->intf);
2193 else if (data->isoc)
2194 usb_driver_release_interface(&btusb_driver, data->isoc);
2195
803b5836 2196 btusb_free_frags(data);
5e23b923
MH		 2197 hci_free_dev(hdev);
2198}
2199
7bee549e 2200#ifdef CONFIG_PM
6a88adf2
MH		 2201static int btusb_suspend(struct usb_interface *intf, pm_message_t message)
2202{
2203 struct btusb_data *data = usb_get_intfdata(intf);
2204
2205 BT_DBG("intf %p", intf);
2206
2207 if (data->suspend_count++)
2208 return 0;
2209
7bee549e 2210 spin_lock_irq(&data->txlock);
5b1b0b81 2211 if (!(PMSG_IS_AUTO(message) && data->tx_in_flight)) {
7bee549e
ON		 2212 set_bit(BTUSB_SUSPENDING, &data->flags);
2213 spin_unlock_irq(&data->txlock);
2214 } else {
2215 spin_unlock_irq(&data->txlock);
2216 data->suspend_count--;
2217 return -EBUSY;
2218 }
2219
6a88adf2
MH		 2220 cancel_work_sync(&data->work);
2221
7bee549e 2222 btusb_stop_traffic(data);
6a88adf2
MH		 2223 usb_kill_anchored_urbs(&data->tx_anchor);
2224
6a88adf2
MH		 2225 return 0;
2226}
2227
7bee549e
ON		 2228static void play_deferred(struct btusb_data *data)
2229{
2230 struct urb *urb;
2231 int err;
2232
2233 while ((urb = usb_get_from_anchor(&data->deferred))) {
2234 err = usb_submit_urb(urb, GFP_ATOMIC);
2235 if (err < 0)
2236 break;
2237
2238 data->tx_in_flight++;
2239 }
2240 usb_scuttle_anchored_urbs(&data->deferred);
2241}
2242
6a88adf2
MH		 2243static int btusb_resume(struct usb_interface *intf)
2244{
2245 struct btusb_data *data = usb_get_intfdata(intf);
2246 struct hci_dev *hdev = data->hdev;
7bee549e 2247 int err = 0;
6a88adf2
MH		 2248
2249 BT_DBG("intf %p", intf);
2250
2251 if (--data->suspend_count)
2252 return 0;
2253
2254 if (!test_bit(HCI_RUNNING, &hdev->flags))
7bee549e 2255 goto done;
6a88adf2
MH		 2256
2257 if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) {
2258 err = btusb_submit_intr_urb(hdev, GFP_NOIO);
2259 if (err < 0) {
2260 clear_bit(BTUSB_INTR_RUNNING, &data->flags);
7bee549e 2261 goto failed;
6a88adf2
MH		 2262 }
2263 }
2264
2265 if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) {
43c2e57f
MH		 2266 err = btusb_submit_bulk_urb(hdev, GFP_NOIO);
2267 if (err < 0) {
6a88adf2 2268 clear_bit(BTUSB_BULK_RUNNING, &data->flags);
7bee549e
ON		 2269 goto failed;
2270 }
2271
2272 btusb_submit_bulk_urb(hdev, GFP_NOIO);
6a88adf2
MH		 2273 }
2274
2275 if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) {
2276 if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0)
2277 clear_bit(BTUSB_ISOC_RUNNING, &data->flags);
2278 else
2279 btusb_submit_isoc_urb(hdev, GFP_NOIO);
2280 }
2281
7bee549e
ON		 2282 spin_lock_irq(&data->txlock);
2283 play_deferred(data);
2284 clear_bit(BTUSB_SUSPENDING, &data->flags);
2285 spin_unlock_irq(&data->txlock);
2286 schedule_work(&data->work);
2287
6a88adf2 2288 return 0;
7bee549e
ON		 2289
2290failed:
2291 usb_scuttle_anchored_urbs(&data->deferred);
2292done:
2293 spin_lock_irq(&data->txlock);
2294 clear_bit(BTUSB_SUSPENDING, &data->flags);
2295 spin_unlock_irq(&data->txlock);
2296
2297 return err;
6a88adf2 2298}
7bee549e 2299#endif
6a88adf2 2300
5e23b923
MH		 2301static struct usb_driver btusb_driver = {
2302 .name = "btusb",
2303 .probe = btusb_probe,
2304 .disconnect = btusb_disconnect,
7bee549e 2305#ifdef CONFIG_PM
6a88adf2
MH		 2306 .suspend = btusb_suspend,
2307 .resume = btusb_resume,
7bee549e 2308#endif
5e23b923 2309 .id_table = btusb_table,
7bee549e 2310 .supports_autosuspend = 1,
e1f12eb6 2311 .disable_hub_initiated_lpm = 1,
5e23b923
MH		 2312};
2313
93f1508c 2314module_usb_driver(btusb_driver);
5e23b923 2315
cfeb4145
MH		 2316module_param(disable_scofix, bool, 0644);
2317MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size");
2318
2319module_param(force_scofix, bool, 0644);
2320MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size");
2321
2322module_param(reset, bool, 0644);
2323MODULE_PARM_DESC(reset, "Send HCI reset command on initialization");
2324
5e23b923
MH		 2325MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
2326MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION);
2327MODULE_VERSION(VERSION);
2328MODULE_LICENSE("GPL");
ubuntu-bionic-kernel mirror