Blame view
drivers/bluetooth/btusb.c
28 KB
5e23b923d [Bluetooth] Add g... |
1 2 3 4 |
/* * * Generic Bluetooth USB driver * |
9bfa35fe4 [Bluetooth] Add S... |
5 |
* Copyright (C) 2005-2008 Marcel Holtmann <marcel@holtmann.org> |
5e23b923d [Bluetooth] Add g... |
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 |
* * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA * */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/init.h> #include <linux/slab.h> #include <linux/types.h> #include <linux/sched.h> #include <linux/errno.h> #include <linux/skbuff.h> #include <linux/usb.h> #include <net/bluetooth/bluetooth.h> #include <net/bluetooth/hci_core.h> |
7bee549e1 Bluetooth: Add US... |
37 |
#define VERSION "0.6" |
cfeb41453 [Bluetooth] Add f... |
38 39 40 41 42 43 |
static int ignore_dga; static int ignore_csr; static int ignore_sniffer; static int disable_scofix; static int force_scofix; |
7a9d40205 Bluetooth: Send H... |
44 45 |
static int reset = 1; |
cfeb41453 [Bluetooth] Add f... |
46 47 48 49 |
static struct usb_driver btusb_driver; #define BTUSB_IGNORE 0x01 |
7a9d40205 Bluetooth: Send H... |
50 51 52 53 54 55 |
#define BTUSB_DIGIANSWER 0x02 #define BTUSB_CSR 0x04 #define BTUSB_SNIFFER 0x08 #define BTUSB_BCM92035 0x10 #define BTUSB_BROKEN_ISOC 0x20 #define BTUSB_WRONG_SCO_MTU 0x40 |
5e23b923d [Bluetooth] Add g... |
56 57 58 59 |
static struct usb_device_id btusb_table[] = { /* Generic Bluetooth USB device */ { USB_DEVICE_INFO(0xe0, 0x01, 0x01) }, |
3cd01976e Bluetooth: Add su... |
60 61 |
/* Apple MacBookPro 7,1 */ { USB_DEVICE(0x05ac, 0x8213) }, |
0a79f6744 Bluetooth: Added ... |
62 63 |
/* Apple iMac11,1 */ { USB_DEVICE(0x05ac, 0x8215) }, |
9c047157a Bluetooth: Add su... |
64 65 |
/* Apple MacBookPro6,2 */ { USB_DEVICE(0x05ac, 0x8218) }, |
3e3ede7dd Bluetooth: Add Ma... |
66 67 |
/* Apple MacBookAir3,1, MacBookAir3,2 */ { USB_DEVICE(0x05ac, 0x821b) }, |
cfeb41453 [Bluetooth] Add f... |
68 69 70 71 72 73 74 75 76 77 78 79 80 81 |
/* AVM BlueFRITZ! USB v2.0 */ { USB_DEVICE(0x057c, 0x3800) }, /* Bluetooth Ultraport Module from IBM */ { USB_DEVICE(0x04bf, 0x030a) }, /* ALPS Modules with non-standard id */ { USB_DEVICE(0x044e, 0x3001) }, { USB_DEVICE(0x044e, 0x3002) }, /* Ericsson with non-standard id */ { USB_DEVICE(0x0bdb, 0x1002) }, /* Canyon CN-BTU1 with HID interfaces */ |
7a9d40205 Bluetooth: Send H... |
82 |
{ USB_DEVICE(0x0c10, 0x0000) }, |
cfeb41453 [Bluetooth] Add f... |
83 |
|
5e23b923d [Bluetooth] Add g... |
84 85 86 87 88 89 |
{ } /* Terminating entry */ }; MODULE_DEVICE_TABLE(usb, btusb_table); static struct usb_device_id blacklist_table[] = { |
cfeb41453 [Bluetooth] Add f... |
90 91 92 93 94 |
/* CSR BlueCore devices */ { USB_DEVICE(0x0a12, 0x0001), .driver_info = BTUSB_CSR }, /* Broadcom BCM2033 without firmware */ { USB_DEVICE(0x0a5c, 0x2033), .driver_info = BTUSB_IGNORE }, |
be93112ac Bluetooth: Add ne... |
95 96 |
/* Atheros 3011 with sflash firmware */ { USB_DEVICE(0x0cf3, 0x3002), .driver_info = BTUSB_IGNORE }, |
509e7861d Bluetooth: add At... |
97 98 |
/* Atheros AR9285 Malbec with sflash firmware */ { USB_DEVICE(0x03f0, 0x311d), .driver_info = BTUSB_IGNORE }, |
cfeb41453 [Bluetooth] Add f... |
99 |
/* Broadcom BCM2035 */ |
7a9d40205 Bluetooth: Send H... |
100 101 102 |
{ USB_DEVICE(0x0a5c, 0x2035), .driver_info = BTUSB_WRONG_SCO_MTU }, { USB_DEVICE(0x0a5c, 0x200a), .driver_info = BTUSB_WRONG_SCO_MTU }, { USB_DEVICE(0x0a5c, 0x2009), .driver_info = BTUSB_BCM92035 }, |
cfeb41453 [Bluetooth] Add f... |
103 104 |
/* Broadcom BCM2045 */ |
7a9d40205 Bluetooth: Send H... |
105 106 |
{ USB_DEVICE(0x0a5c, 0x2039), .driver_info = BTUSB_WRONG_SCO_MTU }, { USB_DEVICE(0x0a5c, 0x2101), .driver_info = BTUSB_WRONG_SCO_MTU }, |
bdbef3d69 [Bluetooth] Fix I... |
107 |
|
cfeb41453 [Bluetooth] Add f... |
108 |
/* IBM/Lenovo ThinkPad with Broadcom chip */ |
7a9d40205 Bluetooth: Send H... |
109 110 |
{ USB_DEVICE(0x0a5c, 0x201e), .driver_info = BTUSB_WRONG_SCO_MTU }, { USB_DEVICE(0x0a5c, 0x2110), .driver_info = BTUSB_WRONG_SCO_MTU }, |
cfeb41453 [Bluetooth] Add f... |
111 112 |
/* HP laptop with Broadcom chip */ |
7a9d40205 Bluetooth: Send H... |
113 |
{ USB_DEVICE(0x03f0, 0x171d), .driver_info = BTUSB_WRONG_SCO_MTU }, |
cfeb41453 [Bluetooth] Add f... |
114 115 |
/* Dell laptop with Broadcom chip */ |
7a9d40205 Bluetooth: Send H... |
116 |
{ USB_DEVICE(0x413c, 0x8126), .driver_info = BTUSB_WRONG_SCO_MTU }, |
cfeb41453 [Bluetooth] Add f... |
117 |
|
5ddd4a606 Bluetooth: Allow ... |
118 |
/* Dell Wireless 370 and 410 devices */ |
7a9d40205 Bluetooth: Send H... |
119 |
{ USB_DEVICE(0x413c, 0x8152), .driver_info = BTUSB_WRONG_SCO_MTU }, |
5ddd4a606 Bluetooth: Allow ... |
120 |
{ USB_DEVICE(0x413c, 0x8156), .driver_info = BTUSB_WRONG_SCO_MTU }, |
cfeb41453 [Bluetooth] Add f... |
121 |
|
7a9d40205 Bluetooth: Send H... |
122 123 124 |
/* Belkin F8T012 and F8T013 devices */ { USB_DEVICE(0x050d, 0x0012), .driver_info = BTUSB_WRONG_SCO_MTU }, { USB_DEVICE(0x050d, 0x0013), .driver_info = BTUSB_WRONG_SCO_MTU }, |
cfeb41453 [Bluetooth] Add f... |
125 |
|
5ddd4a606 Bluetooth: Allow ... |
126 127 128 129 130 |
/* Asus WL-BTD202 device */ { USB_DEVICE(0x0b05, 0x1715), .driver_info = BTUSB_WRONG_SCO_MTU }, /* Kensington Bluetooth USB adapter */ { USB_DEVICE(0x047d, 0x105e), .driver_info = BTUSB_WRONG_SCO_MTU }, |
cfeb41453 [Bluetooth] Add f... |
131 132 133 134 135 136 |
/* RTX Telecom based adapters with buggy SCO support */ { USB_DEVICE(0x0400, 0x0807), .driver_info = BTUSB_BROKEN_ISOC }, { USB_DEVICE(0x0400, 0x080a), .driver_info = BTUSB_BROKEN_ISOC }, /* CONWISE Technology based adapters with buggy SCO support */ { USB_DEVICE(0x0e5e, 0x6622), .driver_info = BTUSB_BROKEN_ISOC }, |
cfeb41453 [Bluetooth] Add f... |
137 138 139 140 141 142 143 144 145 |
/* Digianswer devices */ { USB_DEVICE(0x08fd, 0x0001), .driver_info = BTUSB_DIGIANSWER }, { USB_DEVICE(0x08fd, 0x0002), .driver_info = BTUSB_IGNORE }, /* CSR BlueCore Bluetooth Sniffer */ { USB_DEVICE(0x0a12, 0x0002), .driver_info = BTUSB_SNIFFER }, /* Frontline ComProbe Bluetooth Sniffer */ { USB_DEVICE(0x16d3, 0x0002), .driver_info = BTUSB_SNIFFER }, |
5e23b923d [Bluetooth] Add g... |
146 147 |
{ } /* Terminating entry */ }; |
9bfa35fe4 [Bluetooth] Add S... |
148 |
#define BTUSB_MAX_ISOC_FRAMES 10 |
5e23b923d [Bluetooth] Add g... |
149 150 |
#define BTUSB_INTR_RUNNING 0 #define BTUSB_BULK_RUNNING 1 |
9bfa35fe4 [Bluetooth] Add S... |
151 |
#define BTUSB_ISOC_RUNNING 2 |
7bee549e1 Bluetooth: Add US... |
152 |
#define BTUSB_SUSPENDING 3 |
08b8b6c45 Bluetooth: Move b... |
153 |
#define BTUSB_DID_ISO_RESUME 4 |
5e23b923d [Bluetooth] Add g... |
154 155 156 157 |
struct btusb_data { struct hci_dev *hdev; struct usb_device *udev; |
5fbcd260c [Bluetooth] Fix U... |
158 |
struct usb_interface *intf; |
9bfa35fe4 [Bluetooth] Add S... |
159 |
struct usb_interface *isoc; |
5e23b923d [Bluetooth] Add g... |
160 161 162 163 164 165 |
spinlock_t lock; unsigned long flags; struct work_struct work; |
7bee549e1 Bluetooth: Add US... |
166 |
struct work_struct waker; |
5e23b923d [Bluetooth] Add g... |
167 168 169 170 |
struct usb_anchor tx_anchor; struct usb_anchor intr_anchor; struct usb_anchor bulk_anchor; |
9bfa35fe4 [Bluetooth] Add S... |
171 |
struct usb_anchor isoc_anchor; |
7bee549e1 Bluetooth: Add US... |
172 173 174 |
struct usb_anchor deferred; int tx_in_flight; spinlock_t txlock; |
5e23b923d [Bluetooth] Add g... |
175 176 177 178 |
struct usb_endpoint_descriptor *intr_ep; struct usb_endpoint_descriptor *bulk_tx_ep; struct usb_endpoint_descriptor *bulk_rx_ep; |
9bfa35fe4 [Bluetooth] Add S... |
179 180 |
struct usb_endpoint_descriptor *isoc_tx_ep; struct usb_endpoint_descriptor *isoc_rx_ep; |
7a9d40205 Bluetooth: Send H... |
181 |
__u8 cmdreq_type; |
43c2e57f9 Bluetooth: Submit... |
182 |
unsigned int sco_num; |
9bfa35fe4 [Bluetooth] Add S... |
183 |
int isoc_altsetting; |
6a88adf2a Bluetooth: Add su... |
184 |
int suspend_count; |
5e23b923d [Bluetooth] Add g... |
185 |
}; |
7bee549e1 Bluetooth: Add US... |
186 187 188 189 190 191 192 193 194 195 196 197 198 |
static int inc_tx(struct btusb_data *data) { unsigned long flags; int rv; spin_lock_irqsave(&data->txlock, flags); rv = test_bit(BTUSB_SUSPENDING, &data->flags); if (!rv) data->tx_in_flight++; spin_unlock_irqrestore(&data->txlock, flags); return rv; } |
5e23b923d [Bluetooth] Add g... |
199 200 201 202 203 204 205 206 207 208 209 210 211 |
static void btusb_intr_complete(struct urb *urb) { struct hci_dev *hdev = urb->context; struct btusb_data *data = hdev->driver_data; int err; BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status, urb->actual_length); if (!test_bit(HCI_RUNNING, &hdev->flags)) return; if (urb->status == 0) { |
9bfa35fe4 [Bluetooth] Add S... |
212 |
hdev->stat.byte_rx += urb->actual_length; |
5e23b923d [Bluetooth] Add g... |
213 214 215 216 217 218 219 220 221 222 |
if (hci_recv_fragment(hdev, HCI_EVENT_PKT, urb->transfer_buffer, urb->actual_length) < 0) { BT_ERR("%s corrupted event packet", hdev->name); hdev->stat.err_rx++; } } if (!test_bit(BTUSB_INTR_RUNNING, &data->flags)) return; |
7bee549e1 Bluetooth: Add US... |
223 |
usb_mark_last_busy(data->udev); |
5e23b923d [Bluetooth] Add g... |
224 225 226 227 |
usb_anchor_urb(urb, &data->intr_anchor); err = usb_submit_urb(urb, GFP_ATOMIC); if (err < 0) { |
61faddf66 Bluetooth: Fix lo... |
228 229 |
if (err != -EPERM) BT_ERR("%s urb %p failed to resubmit (%d)", |
5e23b923d [Bluetooth] Add g... |
230 231 232 233 |
hdev->name, urb, -err); usb_unanchor_urb(urb); } } |
2eda66f4a Bluetooth: Add fi... |
234 |
static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags) |
5e23b923d [Bluetooth] Add g... |
235 236 237 238 239 240 241 242 |
{ struct btusb_data *data = hdev->driver_data; struct urb *urb; unsigned char *buf; unsigned int pipe; int err, size; BT_DBG("%s", hdev->name); |
9bfa35fe4 [Bluetooth] Add S... |
243 244 |
if (!data->intr_ep) return -ENODEV; |
2eda66f4a Bluetooth: Add fi... |
245 |
urb = usb_alloc_urb(0, mem_flags); |
5e23b923d [Bluetooth] Add g... |
246 247 248 249 |
if (!urb) return -ENOMEM; size = le16_to_cpu(data->intr_ep->wMaxPacketSize); |
2eda66f4a Bluetooth: Add fi... |
250 |
buf = kmalloc(size, mem_flags); |
5e23b923d [Bluetooth] Add g... |
251 252 253 254 255 256 257 258 259 260 261 262 263 264 |
if (!buf) { usb_free_urb(urb); return -ENOMEM; } pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress); usb_fill_int_urb(urb, data->udev, pipe, buf, size, btusb_intr_complete, hdev, data->intr_ep->bInterval); urb->transfer_flags |= URB_FREE_BUFFER; usb_anchor_urb(urb, &data->intr_anchor); |
2eda66f4a Bluetooth: Add fi... |
265 |
err = usb_submit_urb(urb, mem_flags); |
5e23b923d [Bluetooth] Add g... |
266 267 268 269 |
if (err < 0) { BT_ERR("%s urb %p submission failed (%d)", hdev->name, urb, -err); usb_unanchor_urb(urb); |
5e23b923d [Bluetooth] Add g... |
270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 |
} usb_free_urb(urb); return err; } static void btusb_bulk_complete(struct urb *urb) { struct hci_dev *hdev = urb->context; struct btusb_data *data = hdev->driver_data; int err; BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status, urb->actual_length); if (!test_bit(HCI_RUNNING, &hdev->flags)) return; if (urb->status == 0) { |
9bfa35fe4 [Bluetooth] Add S... |
290 |
hdev->stat.byte_rx += urb->actual_length; |
5e23b923d [Bluetooth] Add g... |
291 292 293 294 295 296 297 298 299 300 301 302 |
if (hci_recv_fragment(hdev, HCI_ACLDATA_PKT, urb->transfer_buffer, urb->actual_length) < 0) { BT_ERR("%s corrupted ACL packet", hdev->name); hdev->stat.err_rx++; } } if (!test_bit(BTUSB_BULK_RUNNING, &data->flags)) return; usb_anchor_urb(urb, &data->bulk_anchor); |
652fd781a Bluetooth: Preven... |
303 |
usb_mark_last_busy(data->udev); |
5e23b923d [Bluetooth] Add g... |
304 305 306 |
err = usb_submit_urb(urb, GFP_ATOMIC); if (err < 0) { |
61faddf66 Bluetooth: Fix lo... |
307 308 |
if (err != -EPERM) BT_ERR("%s urb %p failed to resubmit (%d)", |
5e23b923d [Bluetooth] Add g... |
309 310 311 312 |
hdev->name, urb, -err); usb_unanchor_urb(urb); } } |
2eda66f4a Bluetooth: Add fi... |
313 |
static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags) |
5e23b923d [Bluetooth] Add g... |
314 315 316 317 318 |
{ struct btusb_data *data = hdev->driver_data; struct urb *urb; unsigned char *buf; unsigned int pipe; |
290ba2008 Bluetooth: Improv... |
319 |
int err, size = HCI_MAX_FRAME_SIZE; |
5e23b923d [Bluetooth] Add g... |
320 321 |
BT_DBG("%s", hdev->name); |
9bfa35fe4 [Bluetooth] Add S... |
322 323 |
if (!data->bulk_rx_ep) return -ENODEV; |
2eda66f4a Bluetooth: Add fi... |
324 |
urb = usb_alloc_urb(0, mem_flags); |
5e23b923d [Bluetooth] Add g... |
325 326 |
if (!urb) return -ENOMEM; |
2eda66f4a Bluetooth: Add fi... |
327 |
buf = kmalloc(size, mem_flags); |
5e23b923d [Bluetooth] Add g... |
328 329 330 331 332 333 334 335 336 337 338 |
if (!buf) { usb_free_urb(urb); return -ENOMEM; } pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress); usb_fill_bulk_urb(urb, data->udev, pipe, buf, size, btusb_bulk_complete, hdev); urb->transfer_flags |= URB_FREE_BUFFER; |
7bee549e1 Bluetooth: Add US... |
339 |
usb_mark_last_busy(data->udev); |
5e23b923d [Bluetooth] Add g... |
340 |
usb_anchor_urb(urb, &data->bulk_anchor); |
2eda66f4a Bluetooth: Add fi... |
341 |
err = usb_submit_urb(urb, mem_flags); |
5e23b923d [Bluetooth] Add g... |
342 343 344 345 |
if (err < 0) { BT_ERR("%s urb %p submission failed (%d)", hdev->name, urb, -err); usb_unanchor_urb(urb); |
5e23b923d [Bluetooth] Add g... |
346 347 348 349 350 351 |
} usb_free_urb(urb); return err; } |
9bfa35fe4 [Bluetooth] Add S... |
352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 |
static void btusb_isoc_complete(struct urb *urb) { struct hci_dev *hdev = urb->context; struct btusb_data *data = hdev->driver_data; int i, err; BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status, urb->actual_length); if (!test_bit(HCI_RUNNING, &hdev->flags)) return; if (urb->status == 0) { for (i = 0; i < urb->number_of_packets; i++) { unsigned int offset = urb->iso_frame_desc[i].offset; unsigned int length = urb->iso_frame_desc[i].actual_length; if (urb->iso_frame_desc[i].status) continue; hdev->stat.byte_rx += length; if (hci_recv_fragment(hdev, HCI_SCODATA_PKT, urb->transfer_buffer + offset, length) < 0) { BT_ERR("%s corrupted SCO packet", hdev->name); hdev->stat.err_rx++; } } } if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags)) return; usb_anchor_urb(urb, &data->isoc_anchor); err = usb_submit_urb(urb, GFP_ATOMIC); if (err < 0) { |
61faddf66 Bluetooth: Fix lo... |
390 391 |
if (err != -EPERM) BT_ERR("%s urb %p failed to resubmit (%d)", |
9bfa35fe4 [Bluetooth] Add S... |
392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 |
hdev->name, urb, -err); usb_unanchor_urb(urb); } } static void inline __fill_isoc_descriptor(struct urb *urb, int len, int mtu) { int i, offset = 0; BT_DBG("len %d mtu %d", len, mtu); for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu; i++, offset += mtu, len -= mtu) { urb->iso_frame_desc[i].offset = offset; urb->iso_frame_desc[i].length = mtu; } if (len && i < BTUSB_MAX_ISOC_FRAMES) { urb->iso_frame_desc[i].offset = offset; urb->iso_frame_desc[i].length = len; i++; } urb->number_of_packets = i; } |
2eda66f4a Bluetooth: Add fi... |
417 |
static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags) |
9bfa35fe4 [Bluetooth] Add S... |
418 419 420 421 422 423 424 425 426 427 428 |
{ struct btusb_data *data = hdev->driver_data; struct urb *urb; unsigned char *buf; unsigned int pipe; int err, size; BT_DBG("%s", hdev->name); if (!data->isoc_rx_ep) return -ENODEV; |
2eda66f4a Bluetooth: Add fi... |
429 |
urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags); |
9bfa35fe4 [Bluetooth] Add S... |
430 431 432 433 434 |
if (!urb) return -ENOMEM; size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) * BTUSB_MAX_ISOC_FRAMES; |
2eda66f4a Bluetooth: Add fi... |
435 |
buf = kmalloc(size, mem_flags); |
9bfa35fe4 [Bluetooth] Add S... |
436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 |
if (!buf) { usb_free_urb(urb); return -ENOMEM; } pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress); urb->dev = data->udev; urb->pipe = pipe; urb->context = hdev; urb->complete = btusb_isoc_complete; urb->interval = data->isoc_rx_ep->bInterval; urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP; urb->transfer_buffer = buf; urb->transfer_buffer_length = size; __fill_isoc_descriptor(urb, size, le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize)); usb_anchor_urb(urb, &data->isoc_anchor); |
2eda66f4a Bluetooth: Add fi... |
457 |
err = usb_submit_urb(urb, mem_flags); |
9bfa35fe4 [Bluetooth] Add S... |
458 459 460 461 |
if (err < 0) { BT_ERR("%s urb %p submission failed (%d)", hdev->name, urb, -err); usb_unanchor_urb(urb); |
9bfa35fe4 [Bluetooth] Add S... |
462 463 464 465 466 467 |
} usb_free_urb(urb); return err; } |
5e23b923d [Bluetooth] Add g... |
468 469 470 471 |
static void btusb_tx_complete(struct urb *urb) { struct sk_buff *skb = urb->context; struct hci_dev *hdev = (struct hci_dev *) skb->dev; |
7bee549e1 Bluetooth: Add US... |
472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 |
struct btusb_data *data = hdev->driver_data; BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status, urb->actual_length); if (!test_bit(HCI_RUNNING, &hdev->flags)) goto done; if (!urb->status) hdev->stat.byte_tx += urb->transfer_buffer_length; else hdev->stat.err_tx++; done: spin_lock(&data->txlock); data->tx_in_flight--; spin_unlock(&data->txlock); kfree(urb->setup_packet); kfree_skb(skb); } static void btusb_isoc_tx_complete(struct urb *urb) { struct sk_buff *skb = urb->context; struct hci_dev *hdev = (struct hci_dev *) skb->dev; |
5e23b923d [Bluetooth] Add g... |
499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 |
BT_DBG("%s urb %p status %d count %d", hdev->name, urb, urb->status, urb->actual_length); if (!test_bit(HCI_RUNNING, &hdev->flags)) goto done; if (!urb->status) hdev->stat.byte_tx += urb->transfer_buffer_length; else hdev->stat.err_tx++; done: kfree(urb->setup_packet); kfree_skb(skb); } static int btusb_open(struct hci_dev *hdev) { struct btusb_data *data = hdev->driver_data; int err; BT_DBG("%s", hdev->name); |
7bee549e1 Bluetooth: Add US... |
523 524 525 526 527 |
err = usb_autopm_get_interface(data->intf); if (err < 0) return err; data->intf->needs_remote_wakeup = 1; |
5e23b923d [Bluetooth] Add g... |
528 |
if (test_and_set_bit(HCI_RUNNING, &hdev->flags)) |
7bee549e1 Bluetooth: Add US... |
529 |
goto done; |
5e23b923d [Bluetooth] Add g... |
530 531 |
if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags)) |
7bee549e1 Bluetooth: Add US... |
532 |
goto done; |
5e23b923d [Bluetooth] Add g... |
533 |
|
2eda66f4a Bluetooth: Add fi... |
534 |
err = btusb_submit_intr_urb(hdev, GFP_KERNEL); |
43c2e57f9 Bluetooth: Submit... |
535 536 537 538 |
if (err < 0) goto failed; err = btusb_submit_bulk_urb(hdev, GFP_KERNEL); |
5e23b923d [Bluetooth] Add g... |
539 |
if (err < 0) { |
43c2e57f9 Bluetooth: Submit... |
540 541 |
usb_kill_anchored_urbs(&data->intr_anchor); goto failed; |
5e23b923d [Bluetooth] Add g... |
542 |
} |
43c2e57f9 Bluetooth: Submit... |
543 544 |
set_bit(BTUSB_BULK_RUNNING, &data->flags); btusb_submit_bulk_urb(hdev, GFP_KERNEL); |
7bee549e1 Bluetooth: Add US... |
545 546 |
done: usb_autopm_put_interface(data->intf); |
43c2e57f9 Bluetooth: Submit... |
547 548 549 550 551 |
return 0; failed: clear_bit(BTUSB_INTR_RUNNING, &data->flags); clear_bit(HCI_RUNNING, &hdev->flags); |
7bee549e1 Bluetooth: Add US... |
552 |
usb_autopm_put_interface(data->intf); |
5e23b923d [Bluetooth] Add g... |
553 554 |
return err; } |
7bee549e1 Bluetooth: Add US... |
555 556 557 558 559 560 |
static void btusb_stop_traffic(struct btusb_data *data) { usb_kill_anchored_urbs(&data->intr_anchor); usb_kill_anchored_urbs(&data->bulk_anchor); usb_kill_anchored_urbs(&data->isoc_anchor); } |
5e23b923d [Bluetooth] Add g... |
561 562 563 |
static int btusb_close(struct hci_dev *hdev) { struct btusb_data *data = hdev->driver_data; |
7bee549e1 Bluetooth: Add US... |
564 |
int err; |
5e23b923d [Bluetooth] Add g... |
565 566 567 568 569 |
BT_DBG("%s", hdev->name); if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags)) return 0; |
e8c3c3d22 [Bluetooth] Fix w... |
570 |
cancel_work_sync(&data->work); |
404291ac9 btusb bluetooth d... |
571 |
cancel_work_sync(&data->waker); |
e8c3c3d22 [Bluetooth] Fix w... |
572 |
|
9bfa35fe4 [Bluetooth] Add S... |
573 |
clear_bit(BTUSB_ISOC_RUNNING, &data->flags); |
5e23b923d [Bluetooth] Add g... |
574 |
clear_bit(BTUSB_BULK_RUNNING, &data->flags); |
5e23b923d [Bluetooth] Add g... |
575 |
clear_bit(BTUSB_INTR_RUNNING, &data->flags); |
7bee549e1 Bluetooth: Add US... |
576 577 578 579 |
btusb_stop_traffic(data); err = usb_autopm_get_interface(data->intf); if (err < 0) |
7b8e2c1db fix memory leak i... |
580 |
goto failed; |
7bee549e1 Bluetooth: Add US... |
581 582 583 |
data->intf->needs_remote_wakeup = 0; usb_autopm_put_interface(data->intf); |
5e23b923d [Bluetooth] Add g... |
584 |
|
7b8e2c1db fix memory leak i... |
585 586 |
failed: usb_scuttle_anchored_urbs(&data->deferred); |
5e23b923d [Bluetooth] Add g... |
587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 |
return 0; } static int btusb_flush(struct hci_dev *hdev) { struct btusb_data *data = hdev->driver_data; BT_DBG("%s", hdev->name); usb_kill_anchored_urbs(&data->tx_anchor); return 0; } static int btusb_send_frame(struct sk_buff *skb) { struct hci_dev *hdev = (struct hci_dev *) skb->dev; struct btusb_data *data = hdev->driver_data; struct usb_ctrlrequest *dr; struct urb *urb; unsigned int pipe; int err; BT_DBG("%s", hdev->name); if (!test_bit(HCI_RUNNING, &hdev->flags)) return -EBUSY; switch (bt_cb(skb)->pkt_type) { case HCI_COMMAND_PKT: urb = usb_alloc_urb(0, GFP_ATOMIC); if (!urb) return -ENOMEM; dr = kmalloc(sizeof(*dr), GFP_ATOMIC); if (!dr) { usb_free_urb(urb); return -ENOMEM; } |
7a9d40205 Bluetooth: Send H... |
626 |
dr->bRequestType = data->cmdreq_type; |
5e23b923d [Bluetooth] Add g... |
627 628 629 630 631 632 633 634 635 636 637 638 639 640 |
dr->bRequest = 0; dr->wIndex = 0; dr->wValue = 0; dr->wLength = __cpu_to_le16(skb->len); pipe = usb_sndctrlpipe(data->udev, 0x00); usb_fill_control_urb(urb, data->udev, pipe, (void *) dr, skb->data, skb->len, btusb_tx_complete, skb); hdev->stat.cmd_tx++; break; case HCI_ACLDATA_PKT: |
9bfa35fe4 [Bluetooth] Add S... |
641 642 |
if (!data->bulk_tx_ep || hdev->conn_hash.acl_num < 1) return -ENODEV; |
5e23b923d [Bluetooth] Add g... |
643 644 645 646 647 648 649 650 651 652 653 654 655 656 |
urb = usb_alloc_urb(0, GFP_ATOMIC); if (!urb) return -ENOMEM; pipe = usb_sndbulkpipe(data->udev, data->bulk_tx_ep->bEndpointAddress); usb_fill_bulk_urb(urb, data->udev, pipe, skb->data, skb->len, btusb_tx_complete, skb); hdev->stat.acl_tx++; break; case HCI_SCODATA_PKT: |
9bfa35fe4 [Bluetooth] Add S... |
657 658 659 660 661 662 663 664 665 666 667 668 669 |
if (!data->isoc_tx_ep || hdev->conn_hash.sco_num < 1) return -ENODEV; urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_ATOMIC); if (!urb) return -ENOMEM; pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress); urb->dev = data->udev; urb->pipe = pipe; urb->context = skb; |
7bee549e1 Bluetooth: Add US... |
670 |
urb->complete = btusb_isoc_tx_complete; |
9bfa35fe4 [Bluetooth] Add S... |
671 672 673 674 675 676 677 678 |
urb->interval = data->isoc_tx_ep->bInterval; urb->transfer_flags = URB_ISO_ASAP; urb->transfer_buffer = skb->data; urb->transfer_buffer_length = skb->len; __fill_isoc_descriptor(urb, skb->len, le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize)); |
5e23b923d [Bluetooth] Add g... |
679 |
hdev->stat.sco_tx++; |
7bee549e1 Bluetooth: Add US... |
680 |
goto skip_waking; |
5e23b923d [Bluetooth] Add g... |
681 682 683 684 |
default: return -EILSEQ; } |
7bee549e1 Bluetooth: Add US... |
685 686 687 688 689 690 691 692 693 |
err = inc_tx(data); if (err) { usb_anchor_urb(urb, &data->deferred); schedule_work(&data->waker); err = 0; goto done; } skip_waking: |
5e23b923d [Bluetooth] Add g... |
694 695 696 697 698 699 700 |
usb_anchor_urb(urb, &data->tx_anchor); err = usb_submit_urb(urb, GFP_ATOMIC); if (err < 0) { BT_ERR("%s urb %p submission failed", hdev->name, urb); kfree(urb->setup_packet); usb_unanchor_urb(urb); |
7bee549e1 Bluetooth: Add US... |
701 702 |
} else { usb_mark_last_busy(data->udev); |
5e23b923d [Bluetooth] Add g... |
703 704 705 |
} usb_free_urb(urb); |
7bee549e1 Bluetooth: Add US... |
706 |
done: |
5e23b923d [Bluetooth] Add g... |
707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 |
return err; } static void btusb_destruct(struct hci_dev *hdev) { struct btusb_data *data = hdev->driver_data; BT_DBG("%s", hdev->name); kfree(data); } static void btusb_notify(struct hci_dev *hdev, unsigned int evt) { struct btusb_data *data = hdev->driver_data; BT_DBG("%s evt %d", hdev->name, evt); |
43c2e57f9 Bluetooth: Submit... |
724 725 726 |
if (hdev->conn_hash.sco_num != data->sco_num) { data->sco_num = hdev->conn_hash.sco_num; schedule_work(&data->work); |
a780efa81 Bluetooth: Handle... |
727 |
} |
5e23b923d [Bluetooth] Add g... |
728 |
} |
9bfa35fe4 [Bluetooth] Add S... |
729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 |
static int inline __set_isoc_interface(struct hci_dev *hdev, int altsetting) { struct btusb_data *data = hdev->driver_data; struct usb_interface *intf = data->isoc; struct usb_endpoint_descriptor *ep_desc; int i, err; if (!data->isoc) return -ENODEV; err = usb_set_interface(data->udev, 1, altsetting); if (err < 0) { BT_ERR("%s setting interface failed (%d)", hdev->name, -err); return err; } data->isoc_altsetting = altsetting; data->isoc_tx_ep = NULL; data->isoc_rx_ep = NULL; for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) { ep_desc = &intf->cur_altsetting->endpoint[i].desc; if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) { data->isoc_tx_ep = ep_desc; continue; } if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) { data->isoc_rx_ep = ep_desc; continue; } } if (!data->isoc_tx_ep || !data->isoc_rx_ep) { BT_ERR("%s invalid SCO descriptors", hdev->name); return -ENODEV; } return 0; } |
5e23b923d [Bluetooth] Add g... |
771 772 773 774 |
static void btusb_work(struct work_struct *work) { struct btusb_data *data = container_of(work, struct btusb_data, work); struct hci_dev *hdev = data->hdev; |
7bee549e1 Bluetooth: Add US... |
775 |
int err; |
5e23b923d [Bluetooth] Add g... |
776 |
|
9bfa35fe4 [Bluetooth] Add S... |
777 |
if (hdev->conn_hash.sco_num > 0) { |
08b8b6c45 Bluetooth: Move b... |
778 |
if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) { |
7bee549e1 Bluetooth: Add US... |
779 780 781 782 783 784 |
err = usb_autopm_get_interface(data->isoc); if (err < 0) { clear_bit(BTUSB_ISOC_RUNNING, &data->flags); usb_kill_anchored_urbs(&data->isoc_anchor); return; } |
08b8b6c45 Bluetooth: Move b... |
785 |
set_bit(BTUSB_DID_ISO_RESUME, &data->flags); |
7bee549e1 Bluetooth: Add US... |
786 |
} |
9bfa35fe4 [Bluetooth] Add S... |
787 788 789 790 791 792 793 794 795 |
if (data->isoc_altsetting != 2) { clear_bit(BTUSB_ISOC_RUNNING, &data->flags); usb_kill_anchored_urbs(&data->isoc_anchor); if (__set_isoc_interface(hdev, 2) < 0) return; } if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) { |
2eda66f4a Bluetooth: Add fi... |
796 |
if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0) |
9bfa35fe4 [Bluetooth] Add S... |
797 798 |
clear_bit(BTUSB_ISOC_RUNNING, &data->flags); else |
2eda66f4a Bluetooth: Add fi... |
799 |
btusb_submit_isoc_urb(hdev, GFP_KERNEL); |
9bfa35fe4 [Bluetooth] Add S... |
800 801 802 803 804 805 |
} } else { clear_bit(BTUSB_ISOC_RUNNING, &data->flags); usb_kill_anchored_urbs(&data->isoc_anchor); __set_isoc_interface(hdev, 0); |
08b8b6c45 Bluetooth: Move b... |
806 |
if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags)) |
7bee549e1 Bluetooth: Add US... |
807 |
usb_autopm_put_interface(data->isoc); |
5e23b923d [Bluetooth] Add g... |
808 809 |
} } |
7bee549e1 Bluetooth: Add US... |
810 811 812 813 814 815 816 817 818 819 820 |
static void btusb_waker(struct work_struct *work) { struct btusb_data *data = container_of(work, struct btusb_data, waker); int err; err = usb_autopm_get_interface(data->intf); if (err < 0) return; usb_autopm_put_interface(data->intf); } |
5e23b923d [Bluetooth] Add g... |
821 822 823 824 825 826 827 828 829 |
static int btusb_probe(struct usb_interface *intf, const struct usb_device_id *id) { struct usb_endpoint_descriptor *ep_desc; struct btusb_data *data; struct hci_dev *hdev; int i, err; BT_DBG("intf %p id %p", intf, id); |
cfeb41453 [Bluetooth] Add f... |
830 |
/* interface numbers are hardcoded in the spec */ |
5e23b923d [Bluetooth] Add g... |
831 832 833 834 835 836 837 838 839 |
if (intf->cur_altsetting->desc.bInterfaceNumber != 0) return -ENODEV; if (!id->driver_info) { const struct usb_device_id *match; match = usb_match_id(intf, blacklist_table); if (match) id = match; } |
cfeb41453 [Bluetooth] Add f... |
840 841 842 843 844 845 846 847 848 849 850 |
if (id->driver_info == BTUSB_IGNORE) return -ENODEV; if (ignore_dga && id->driver_info & BTUSB_DIGIANSWER) return -ENODEV; if (ignore_csr && id->driver_info & BTUSB_CSR) return -ENODEV; if (ignore_sniffer && id->driver_info & BTUSB_SNIFFER) return -ENODEV; |
5e23b923d [Bluetooth] Add g... |
851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 |
data = kzalloc(sizeof(*data), GFP_KERNEL); if (!data) return -ENOMEM; for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) { ep_desc = &intf->cur_altsetting->endpoint[i].desc; if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) { data->intr_ep = ep_desc; continue; } if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) { data->bulk_tx_ep = ep_desc; continue; } if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) { data->bulk_rx_ep = ep_desc; continue; } } if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep) { kfree(data); return -ENODEV; } |
7a9d40205 Bluetooth: Send H... |
878 |
data->cmdreq_type = USB_TYPE_CLASS; |
5e23b923d [Bluetooth] Add g... |
879 |
data->udev = interface_to_usbdev(intf); |
5fbcd260c [Bluetooth] Fix U... |
880 |
data->intf = intf; |
5e23b923d [Bluetooth] Add g... |
881 882 883 884 |
spin_lock_init(&data->lock); INIT_WORK(&data->work, btusb_work); |
7bee549e1 Bluetooth: Add US... |
885 886 |
INIT_WORK(&data->waker, btusb_waker); spin_lock_init(&data->txlock); |
5e23b923d [Bluetooth] Add g... |
887 888 889 890 |
init_usb_anchor(&data->tx_anchor); init_usb_anchor(&data->intr_anchor); init_usb_anchor(&data->bulk_anchor); |
9bfa35fe4 [Bluetooth] Add S... |
891 |
init_usb_anchor(&data->isoc_anchor); |
7bee549e1 Bluetooth: Add US... |
892 |
init_usb_anchor(&data->deferred); |
5e23b923d [Bluetooth] Add g... |
893 894 895 896 897 898 |
hdev = hci_alloc_dev(); if (!hdev) { kfree(data); return -ENOMEM; } |
c13854cef Bluetooth: Conver... |
899 |
hdev->bus = HCI_USB; |
5e23b923d [Bluetooth] Add g... |
900 901 902 903 904 905 906 907 908 909 910 911 912 913 |
hdev->driver_data = data; data->hdev = hdev; SET_HCIDEV_DEV(hdev, &intf->dev); hdev->open = btusb_open; hdev->close = btusb_close; hdev->flush = btusb_flush; hdev->send = btusb_send_frame; hdev->destruct = btusb_destruct; hdev->notify = btusb_notify; hdev->owner = THIS_MODULE; |
7a9d40205 Bluetooth: Send H... |
914 |
/* Interface numbers are hardcoded in the specification */ |
9bfa35fe4 [Bluetooth] Add S... |
915 |
data->isoc = usb_ifnum_to_if(data->udev, 1); |
7a9d40205 Bluetooth: Send H... |
916 917 |
if (!reset) set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks); |
cfeb41453 [Bluetooth] Add f... |
918 919 920 921 922 |
if (force_scofix || id->driver_info & BTUSB_WRONG_SCO_MTU) { if (!disable_scofix) set_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks); } |
9bfa35fe4 [Bluetooth] Add S... |
923 924 |
if (id->driver_info & BTUSB_BROKEN_ISOC) data->isoc = NULL; |
7a9d40205 Bluetooth: Send H... |
925 926 927 928 929 930 931 932 933 934 935 936 |
if (id->driver_info & BTUSB_DIGIANSWER) { data->cmdreq_type = USB_TYPE_VENDOR; set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks); } if (id->driver_info & BTUSB_CSR) { struct usb_device *udev = data->udev; /* Old firmware would otherwise execute USB reset */ if (le16_to_cpu(udev->descriptor.bcdDevice) < 0x117) set_bit(HCI_QUIRK_NO_RESET, &hdev->quirks); } |
cfeb41453 [Bluetooth] Add f... |
937 |
if (id->driver_info & BTUSB_SNIFFER) { |
9bfa35fe4 [Bluetooth] Add S... |
938 |
struct usb_device *udev = data->udev; |
cfeb41453 [Bluetooth] Add f... |
939 |
|
7a9d40205 Bluetooth: Send H... |
940 |
/* New sniffer firmware has crippled HCI interface */ |
cfeb41453 [Bluetooth] Add f... |
941 942 |
if (le16_to_cpu(udev->descriptor.bcdDevice) > 0x997) set_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks); |
9bfa35fe4 [Bluetooth] Add S... |
943 944 |
data->isoc = NULL; |
cfeb41453 [Bluetooth] Add f... |
945 946 947 948 949 950 951 952 953 954 955 956 |
} if (id->driver_info & BTUSB_BCM92035) { unsigned char cmd[] = { 0x3b, 0xfc, 0x01, 0x00 }; struct sk_buff *skb; skb = bt_skb_alloc(sizeof(cmd), GFP_KERNEL); if (skb) { memcpy(skb_put(skb, sizeof(cmd)), cmd, sizeof(cmd)); skb_queue_tail(&hdev->driver_init, skb); } } |
5e23b923d [Bluetooth] Add g... |
957 |
|
9bfa35fe4 [Bluetooth] Add S... |
958 959 |
if (data->isoc) { err = usb_driver_claim_interface(&btusb_driver, |
5fbcd260c [Bluetooth] Fix U... |
960 |
data->isoc, data); |
9bfa35fe4 [Bluetooth] Add S... |
961 962 963 964 965 966 |
if (err < 0) { hci_free_dev(hdev); kfree(data); return err; } } |
5e23b923d [Bluetooth] Add g... |
967 968 969 970 971 972 973 974 |
err = hci_register_dev(hdev); if (err < 0) { hci_free_dev(hdev); kfree(data); return err; } usb_set_intfdata(intf, data); |
556ea928f Bluetooth: Enable... |
975 |
usb_enable_autosuspend(interface_to_usbdev(intf)); |
5e23b923d [Bluetooth] Add g... |
976 977 978 979 980 981 982 983 984 985 986 987 988 989 |
return 0; } static void btusb_disconnect(struct usb_interface *intf) { struct btusb_data *data = usb_get_intfdata(intf); struct hci_dev *hdev; BT_DBG("intf %p", intf); if (!data) return; hdev = data->hdev; |
5fbcd260c [Bluetooth] Fix U... |
990 |
__hci_dev_hold(hdev); |
9bfa35fe4 [Bluetooth] Add S... |
991 |
|
5fbcd260c [Bluetooth] Fix U... |
992 993 994 995 |
usb_set_intfdata(data->intf, NULL); if (data->isoc) usb_set_intfdata(data->isoc, NULL); |
5e23b923d [Bluetooth] Add g... |
996 997 |
hci_unregister_dev(hdev); |
5fbcd260c [Bluetooth] Fix U... |
998 999 1000 1001 1002 1003 |
if (intf == data->isoc) usb_driver_release_interface(&btusb_driver, data->intf); else if (data->isoc) usb_driver_release_interface(&btusb_driver, data->isoc); __hci_dev_put(hdev); |
5e23b923d [Bluetooth] Add g... |
1004 1005 |
hci_free_dev(hdev); } |
7bee549e1 Bluetooth: Add US... |
1006 |
#ifdef CONFIG_PM |
6a88adf2a Bluetooth: Add su... |
1007 1008 1009 1010 1011 1012 1013 1014 |
static int btusb_suspend(struct usb_interface *intf, pm_message_t message) { struct btusb_data *data = usb_get_intfdata(intf); BT_DBG("intf %p", intf); if (data->suspend_count++) return 0; |
7bee549e1 Bluetooth: Add US... |
1015 |
spin_lock_irq(&data->txlock); |
fb34d5375 USB: remove the a... |
1016 |
if (!((message.event & PM_EVENT_AUTO) && data->tx_in_flight)) { |
7bee549e1 Bluetooth: Add US... |
1017 1018 1019 1020 1021 1022 1023 |
set_bit(BTUSB_SUSPENDING, &data->flags); spin_unlock_irq(&data->txlock); } else { spin_unlock_irq(&data->txlock); data->suspend_count--; return -EBUSY; } |
6a88adf2a Bluetooth: Add su... |
1024 |
cancel_work_sync(&data->work); |
7bee549e1 Bluetooth: Add US... |
1025 |
btusb_stop_traffic(data); |
6a88adf2a Bluetooth: Add su... |
1026 |
usb_kill_anchored_urbs(&data->tx_anchor); |
6a88adf2a Bluetooth: Add su... |
1027 1028 |
return 0; } |
7bee549e1 Bluetooth: Add US... |
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 |
static void play_deferred(struct btusb_data *data) { struct urb *urb; int err; while ((urb = usb_get_from_anchor(&data->deferred))) { err = usb_submit_urb(urb, GFP_ATOMIC); if (err < 0) break; data->tx_in_flight++; } usb_scuttle_anchored_urbs(&data->deferred); } |
6a88adf2a Bluetooth: Add su... |
1043 1044 1045 1046 |
static int btusb_resume(struct usb_interface *intf) { struct btusb_data *data = usb_get_intfdata(intf); struct hci_dev *hdev = data->hdev; |
7bee549e1 Bluetooth: Add US... |
1047 |
int err = 0; |
6a88adf2a Bluetooth: Add su... |
1048 1049 1050 1051 1052 1053 1054 |
BT_DBG("intf %p", intf); if (--data->suspend_count) return 0; if (!test_bit(HCI_RUNNING, &hdev->flags)) |
7bee549e1 Bluetooth: Add US... |
1055 |
goto done; |
6a88adf2a Bluetooth: Add su... |
1056 1057 1058 1059 1060 |
if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) { err = btusb_submit_intr_urb(hdev, GFP_NOIO); if (err < 0) { clear_bit(BTUSB_INTR_RUNNING, &data->flags); |
7bee549e1 Bluetooth: Add US... |
1061 |
goto failed; |
6a88adf2a Bluetooth: Add su... |
1062 1063 1064 1065 |
} } if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) { |
43c2e57f9 Bluetooth: Submit... |
1066 1067 |
err = btusb_submit_bulk_urb(hdev, GFP_NOIO); if (err < 0) { |
6a88adf2a Bluetooth: Add su... |
1068 |
clear_bit(BTUSB_BULK_RUNNING, &data->flags); |
7bee549e1 Bluetooth: Add US... |
1069 1070 1071 1072 |
goto failed; } btusb_submit_bulk_urb(hdev, GFP_NOIO); |
6a88adf2a Bluetooth: Add su... |
1073 1074 1075 1076 1077 1078 1079 1080 |
} if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) { if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0) clear_bit(BTUSB_ISOC_RUNNING, &data->flags); else btusb_submit_isoc_urb(hdev, GFP_NOIO); } |
7bee549e1 Bluetooth: Add US... |
1081 1082 1083 1084 1085 |
spin_lock_irq(&data->txlock); play_deferred(data); clear_bit(BTUSB_SUSPENDING, &data->flags); spin_unlock_irq(&data->txlock); schedule_work(&data->work); |
6a88adf2a Bluetooth: Add su... |
1086 |
return 0; |
7bee549e1 Bluetooth: Add US... |
1087 1088 1089 1090 1091 1092 1093 1094 1095 |
failed: usb_scuttle_anchored_urbs(&data->deferred); done: spin_lock_irq(&data->txlock); clear_bit(BTUSB_SUSPENDING, &data->flags); spin_unlock_irq(&data->txlock); return err; |
6a88adf2a Bluetooth: Add su... |
1096 |
} |
7bee549e1 Bluetooth: Add US... |
1097 |
#endif |
6a88adf2a Bluetooth: Add su... |
1098 |
|
5e23b923d [Bluetooth] Add g... |
1099 1100 1101 1102 |
static struct usb_driver btusb_driver = { .name = "btusb", .probe = btusb_probe, .disconnect = btusb_disconnect, |
7bee549e1 Bluetooth: Add US... |
1103 |
#ifdef CONFIG_PM |
6a88adf2a Bluetooth: Add su... |
1104 1105 |
.suspend = btusb_suspend, .resume = btusb_resume, |
7bee549e1 Bluetooth: Add US... |
1106 |
#endif |
5e23b923d [Bluetooth] Add g... |
1107 |
.id_table = btusb_table, |
7bee549e1 Bluetooth: Add US... |
1108 |
.supports_autosuspend = 1, |
5e23b923d [Bluetooth] Add g... |
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 |
}; static int __init btusb_init(void) { BT_INFO("Generic Bluetooth USB driver ver %s", VERSION); return usb_register(&btusb_driver); } static void __exit btusb_exit(void) { usb_deregister(&btusb_driver); } module_init(btusb_init); module_exit(btusb_exit); |
cfeb41453 [Bluetooth] Add f... |
1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 |
module_param(ignore_dga, bool, 0644); MODULE_PARM_DESC(ignore_dga, "Ignore devices with id 08fd:0001"); module_param(ignore_csr, bool, 0644); MODULE_PARM_DESC(ignore_csr, "Ignore devices with id 0a12:0001"); module_param(ignore_sniffer, bool, 0644); MODULE_PARM_DESC(ignore_sniffer, "Ignore devices with id 0a12:0002"); module_param(disable_scofix, bool, 0644); MODULE_PARM_DESC(disable_scofix, "Disable fixup of wrong SCO buffer size"); module_param(force_scofix, bool, 0644); MODULE_PARM_DESC(force_scofix, "Force fixup of wrong SCO buffers size"); module_param(reset, bool, 0644); MODULE_PARM_DESC(reset, "Send HCI reset command on initialization"); |
5e23b923d [Bluetooth] Add g... |
1142 1143 1144 1145 |
MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>"); MODULE_DESCRIPTION("Generic Bluetooth USB driver ver " VERSION); MODULE_VERSION(VERSION); MODULE_LICENSE("GPL"); |