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