blob: 4917919d86a6b251ddb35027571c46c6add6fcb0 [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (C) 2000-2001 Qualcomm Incorporated
4
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI core. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28#include <linux/kmod.h>
29
30#include <linux/types.h>
31#include <linux/errno.h>
32#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/sched.h>
34#include <linux/slab.h>
35#include <linux/poll.h>
36#include <linux/fcntl.h>
37#include <linux/init.h>
38#include <linux/skbuff.h>
39#include <linux/interrupt.h>
40#include <linux/notifier.h>
41#include <net/sock.h>
42
43#include <asm/system.h>
44#include <asm/uaccess.h>
45#include <asm/unaligned.h>
46
47#include <net/bluetooth/bluetooth.h>
48#include <net/bluetooth/hci_core.h>
49
50#ifndef CONFIG_BT_HCI_CORE_DEBUG
51#undef BT_DBG
52#define BT_DBG(D...)
53#endif
54
55static void hci_cmd_task(unsigned long arg);
56static void hci_rx_task(unsigned long arg);
57static void hci_tx_task(unsigned long arg);
58static void hci_notify(struct hci_dev *hdev, int event);
59
60static DEFINE_RWLOCK(hci_task_lock);
61
62/* HCI device list */
63LIST_HEAD(hci_dev_list);
64DEFINE_RWLOCK(hci_dev_list_lock);
65
66/* HCI callback list */
67LIST_HEAD(hci_cb_list);
68DEFINE_RWLOCK(hci_cb_list_lock);
69
70/* HCI protocols */
71#define HCI_MAX_PROTO 2
72struct hci_proto *hci_proto[HCI_MAX_PROTO];
73
74/* HCI notifiers list */
Alan Sterne041c682006-03-27 01:16:30 -080075static ATOMIC_NOTIFIER_HEAD(hci_notifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -070076
77/* ---- HCI notifications ---- */
78
79int hci_register_notifier(struct notifier_block *nb)
80{
Alan Sterne041c682006-03-27 01:16:30 -080081 return atomic_notifier_chain_register(&hci_notifier, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -070082}
83
84int hci_unregister_notifier(struct notifier_block *nb)
85{
Alan Sterne041c682006-03-27 01:16:30 -080086 return atomic_notifier_chain_unregister(&hci_notifier, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -070087}
88
Marcel Holtmann65164552005-10-28 19:20:48 +020089static void hci_notify(struct hci_dev *hdev, int event)
Linus Torvalds1da177e2005-04-16 15:20:36 -070090{
Alan Sterne041c682006-03-27 01:16:30 -080091 atomic_notifier_call_chain(&hci_notifier, event, hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070092}
93
94/* ---- HCI requests ---- */
95
96void hci_req_complete(struct hci_dev *hdev, int result)
97{
98 BT_DBG("%s result 0x%2.2x", hdev->name, result);
99
100 if (hdev->req_status == HCI_REQ_PEND) {
101 hdev->req_result = result;
102 hdev->req_status = HCI_REQ_DONE;
103 wake_up_interruptible(&hdev->req_wait_q);
104 }
105}
106
107static void hci_req_cancel(struct hci_dev *hdev, int err)
108{
109 BT_DBG("%s err 0x%2.2x", hdev->name, err);
110
111 if (hdev->req_status == HCI_REQ_PEND) {
112 hdev->req_result = err;
113 hdev->req_status = HCI_REQ_CANCELED;
114 wake_up_interruptible(&hdev->req_wait_q);
115 }
116}
117
118/* Execute request and wait for completion. */
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900119static int __hci_request(struct hci_dev *hdev, void (*req)(struct hci_dev *hdev, unsigned long opt),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120 unsigned long opt, __u32 timeout)
121{
122 DECLARE_WAITQUEUE(wait, current);
123 int err = 0;
124
125 BT_DBG("%s start", hdev->name);
126
127 hdev->req_status = HCI_REQ_PEND;
128
129 add_wait_queue(&hdev->req_wait_q, &wait);
130 set_current_state(TASK_INTERRUPTIBLE);
131
132 req(hdev, opt);
133 schedule_timeout(timeout);
134
135 remove_wait_queue(&hdev->req_wait_q, &wait);
136
137 if (signal_pending(current))
138 return -EINTR;
139
140 switch (hdev->req_status) {
141 case HCI_REQ_DONE:
142 err = -bt_err(hdev->req_result);
143 break;
144
145 case HCI_REQ_CANCELED:
146 err = -hdev->req_result;
147 break;
148
149 default:
150 err = -ETIMEDOUT;
151 break;
152 };
153
154 hdev->req_status = hdev->req_result = 0;
155
156 BT_DBG("%s end: err %d", hdev->name, err);
157
158 return err;
159}
160
161static inline int hci_request(struct hci_dev *hdev, void (*req)(struct hci_dev *hdev, unsigned long opt),
162 unsigned long opt, __u32 timeout)
163{
164 int ret;
165
166 /* Serialize all requests */
167 hci_req_lock(hdev);
168 ret = __hci_request(hdev, req, opt, timeout);
169 hci_req_unlock(hdev);
170
171 return ret;
172}
173
174static void hci_reset_req(struct hci_dev *hdev, unsigned long opt)
175{
176 BT_DBG("%s %ld", hdev->name, opt);
177
178 /* Reset device */
179 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_RESET, 0, NULL);
180}
181
182static void hci_init_req(struct hci_dev *hdev, unsigned long opt)
183{
184 struct sk_buff *skb;
Marcel Holtmann1ebb9252005-11-08 09:57:21 -0800185 __le16 param;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
187 BT_DBG("%s %ld", hdev->name, opt);
188
189 /* Driver initialization */
190
191 /* Special commands */
192 while ((skb = skb_dequeue(&hdev->driver_init))) {
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700193 bt_cb(skb)->pkt_type = HCI_COMMAND_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 skb->dev = (void *) hdev;
195 skb_queue_tail(&hdev->cmd_q, skb);
196 hci_sched_cmd(hdev);
197 }
198 skb_queue_purge(&hdev->driver_init);
199
200 /* Mandatory initialization */
201
202 /* Reset */
203 if (test_bit(HCI_QUIRK_RESET_ON_INIT, &hdev->quirks))
204 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_RESET, 0, NULL);
205
206 /* Read Local Supported Features */
207 hci_send_cmd(hdev, OGF_INFO_PARAM, OCF_READ_LOCAL_FEATURES, 0, NULL);
208
Marcel Holtmann1143e5a2006-09-23 09:57:20 +0200209 /* Read Local Version */
210 hci_send_cmd(hdev, OGF_INFO_PARAM, OCF_READ_LOCAL_VERSION, 0, NULL);
211
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212 /* Read Buffer Size (ACL mtu, max pkt, etc.) */
213 hci_send_cmd(hdev, OGF_INFO_PARAM, OCF_READ_BUFFER_SIZE, 0, NULL);
214
215#if 0
216 /* Host buffer size */
217 {
218 struct hci_cp_host_buffer_size cp;
219 cp.acl_mtu = __cpu_to_le16(HCI_MAX_ACL_SIZE);
220 cp.sco_mtu = HCI_MAX_SCO_SIZE;
221 cp.acl_max_pkt = __cpu_to_le16(0xffff);
222 cp.sco_max_pkt = __cpu_to_le16(0xffff);
223 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_HOST_BUFFER_SIZE, sizeof(cp), &cp);
224 }
225#endif
226
227 /* Read BD Address */
228 hci_send_cmd(hdev, OGF_INFO_PARAM, OCF_READ_BD_ADDR, 0, NULL);
229
230 /* Read Voice Setting */
231 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_READ_VOICE_SETTING, 0, NULL);
232
233 /* Optional initialization */
234
235 /* Clear Event Filters */
236 {
237 struct hci_cp_set_event_flt cp;
238 cp.flt_type = HCI_FLT_CLEAR_ALL;
239 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_SET_EVENT_FLT, sizeof(cp), &cp);
240 }
241
242 /* Page timeout ~20 secs */
243 param = __cpu_to_le16(0x8000);
244 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_WRITE_PG_TIMEOUT, 2, &param);
245
246 /* Connection accept timeout ~20 secs */
247 param = __cpu_to_le16(0x7d00);
248 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_WRITE_CA_TIMEOUT, 2, &param);
249}
250
251static void hci_scan_req(struct hci_dev *hdev, unsigned long opt)
252{
253 __u8 scan = opt;
254
255 BT_DBG("%s %x", hdev->name, scan);
256
257 /* Inquiry and Page scans */
258 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_WRITE_SCAN_ENABLE, 1, &scan);
259}
260
261static void hci_auth_req(struct hci_dev *hdev, unsigned long opt)
262{
263 __u8 auth = opt;
264
265 BT_DBG("%s %x", hdev->name, auth);
266
267 /* Authentication */
268 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_WRITE_AUTH_ENABLE, 1, &auth);
269}
270
271static void hci_encrypt_req(struct hci_dev *hdev, unsigned long opt)
272{
273 __u8 encrypt = opt;
274
275 BT_DBG("%s %x", hdev->name, encrypt);
276
277 /* Authentication */
278 hci_send_cmd(hdev, OGF_HOST_CTL, OCF_WRITE_ENCRYPT_MODE, 1, &encrypt);
279}
280
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900281/* Get HCI device by index.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 * Device is held on return. */
283struct hci_dev *hci_dev_get(int index)
284{
285 struct hci_dev *hdev = NULL;
286 struct list_head *p;
287
288 BT_DBG("%d", index);
289
290 if (index < 0)
291 return NULL;
292
293 read_lock(&hci_dev_list_lock);
294 list_for_each(p, &hci_dev_list) {
295 struct hci_dev *d = list_entry(p, struct hci_dev, list);
296 if (d->id == index) {
297 hdev = hci_dev_hold(d);
298 break;
299 }
300 }
301 read_unlock(&hci_dev_list_lock);
302 return hdev;
303}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304
305/* ---- Inquiry support ---- */
306static void inquiry_cache_flush(struct hci_dev *hdev)
307{
308 struct inquiry_cache *cache = &hdev->inq_cache;
309 struct inquiry_entry *next = cache->list, *e;
310
311 BT_DBG("cache %p", cache);
312
313 cache->list = NULL;
314 while ((e = next)) {
315 next = e->next;
316 kfree(e);
317 }
318}
319
320struct inquiry_entry *hci_inquiry_cache_lookup(struct hci_dev *hdev, bdaddr_t *bdaddr)
321{
322 struct inquiry_cache *cache = &hdev->inq_cache;
323 struct inquiry_entry *e;
324
325 BT_DBG("cache %p, %s", cache, batostr(bdaddr));
326
327 for (e = cache->list; e; e = e->next)
328 if (!bacmp(&e->data.bdaddr, bdaddr))
329 break;
330 return e;
331}
332
333void hci_inquiry_cache_update(struct hci_dev *hdev, struct inquiry_data *data)
334{
335 struct inquiry_cache *cache = &hdev->inq_cache;
336 struct inquiry_entry *e;
337
338 BT_DBG("cache %p, %s", cache, batostr(&data->bdaddr));
339
340 if (!(e = hci_inquiry_cache_lookup(hdev, &data->bdaddr))) {
341 /* Entry not in the cache. Add new one. */
Marcel Holtmann25ea6db2006-07-06 15:40:09 +0200342 if (!(e = kzalloc(sizeof(struct inquiry_entry), GFP_ATOMIC)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 e->next = cache->list;
345 cache->list = e;
346 }
347
348 memcpy(&e->data, data, sizeof(*data));
349 e->timestamp = jiffies;
350 cache->timestamp = jiffies;
351}
352
353static int inquiry_cache_dump(struct hci_dev *hdev, int num, __u8 *buf)
354{
355 struct inquiry_cache *cache = &hdev->inq_cache;
356 struct inquiry_info *info = (struct inquiry_info *) buf;
357 struct inquiry_entry *e;
358 int copied = 0;
359
360 for (e = cache->list; e && copied < num; e = e->next, copied++) {
361 struct inquiry_data *data = &e->data;
362 bacpy(&info->bdaddr, &data->bdaddr);
363 info->pscan_rep_mode = data->pscan_rep_mode;
364 info->pscan_period_mode = data->pscan_period_mode;
365 info->pscan_mode = data->pscan_mode;
366 memcpy(info->dev_class, data->dev_class, 3);
367 info->clock_offset = data->clock_offset;
368 info++;
369 }
370
371 BT_DBG("cache %p, copied %d", cache, copied);
372 return copied;
373}
374
375static void hci_inq_req(struct hci_dev *hdev, unsigned long opt)
376{
377 struct hci_inquiry_req *ir = (struct hci_inquiry_req *) opt;
378 struct hci_cp_inquiry cp;
379
380 BT_DBG("%s", hdev->name);
381
382 if (test_bit(HCI_INQUIRY, &hdev->flags))
383 return;
384
385 /* Start Inquiry */
386 memcpy(&cp.lap, &ir->lap, 3);
387 cp.length = ir->length;
388 cp.num_rsp = ir->num_rsp;
389 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_INQUIRY, sizeof(cp), &cp);
390}
391
392int hci_inquiry(void __user *arg)
393{
394 __u8 __user *ptr = arg;
395 struct hci_inquiry_req ir;
396 struct hci_dev *hdev;
397 int err = 0, do_inquiry = 0, max_rsp;
398 long timeo;
399 __u8 *buf;
400
401 if (copy_from_user(&ir, ptr, sizeof(ir)))
402 return -EFAULT;
403
404 if (!(hdev = hci_dev_get(ir.dev_id)))
405 return -ENODEV;
406
407 hci_dev_lock_bh(hdev);
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900408 if (inquiry_cache_age(hdev) > INQUIRY_CACHE_AGE_MAX ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409 inquiry_cache_empty(hdev) ||
410 ir.flags & IREQ_CACHE_FLUSH) {
411 inquiry_cache_flush(hdev);
412 do_inquiry = 1;
413 }
414 hci_dev_unlock_bh(hdev);
415
Marcel Holtmann04837f62006-07-03 10:02:33 +0200416 timeo = ir.length * msecs_to_jiffies(2000);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700417 if (do_inquiry && (err = hci_request(hdev, hci_inq_req, (unsigned long)&ir, timeo)) < 0)
418 goto done;
419
420 /* for unlimited number of responses we will use buffer with 255 entries */
421 max_rsp = (ir.num_rsp == 0) ? 255 : ir.num_rsp;
422
423 /* cache_dump can't sleep. Therefore we allocate temp buffer and then
424 * copy it to the user space.
425 */
426 if (!(buf = kmalloc(sizeof(struct inquiry_info) * max_rsp, GFP_KERNEL))) {
427 err = -ENOMEM;
428 goto done;
429 }
430
431 hci_dev_lock_bh(hdev);
432 ir.num_rsp = inquiry_cache_dump(hdev, max_rsp, buf);
433 hci_dev_unlock_bh(hdev);
434
435 BT_DBG("num_rsp %d", ir.num_rsp);
436
437 if (!copy_to_user(ptr, &ir, sizeof(ir))) {
438 ptr += sizeof(ir);
439 if (copy_to_user(ptr, buf, sizeof(struct inquiry_info) *
440 ir.num_rsp))
441 err = -EFAULT;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900442 } else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 err = -EFAULT;
444
445 kfree(buf);
446
447done:
448 hci_dev_put(hdev);
449 return err;
450}
451
452/* ---- HCI ioctl helpers ---- */
453
454int hci_dev_open(__u16 dev)
455{
456 struct hci_dev *hdev;
457 int ret = 0;
458
459 if (!(hdev = hci_dev_get(dev)))
460 return -ENODEV;
461
462 BT_DBG("%s %p", hdev->name, hdev);
463
464 hci_req_lock(hdev);
465
466 if (test_bit(HCI_UP, &hdev->flags)) {
467 ret = -EALREADY;
468 goto done;
469 }
470
471 if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks))
472 set_bit(HCI_RAW, &hdev->flags);
473
474 if (hdev->open(hdev)) {
475 ret = -EIO;
476 goto done;
477 }
478
479 if (!test_bit(HCI_RAW, &hdev->flags)) {
480 atomic_set(&hdev->cmd_cnt, 1);
481 set_bit(HCI_INIT, &hdev->flags);
482
483 //__hci_request(hdev, hci_reset_req, 0, HZ);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200484 ret = __hci_request(hdev, hci_init_req, 0,
485 msecs_to_jiffies(HCI_INIT_TIMEOUT));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700486
487 clear_bit(HCI_INIT, &hdev->flags);
488 }
489
490 if (!ret) {
491 hci_dev_hold(hdev);
492 set_bit(HCI_UP, &hdev->flags);
493 hci_notify(hdev, HCI_DEV_UP);
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900494 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700495 /* Init failed, cleanup */
496 tasklet_kill(&hdev->rx_task);
497 tasklet_kill(&hdev->tx_task);
498 tasklet_kill(&hdev->cmd_task);
499
500 skb_queue_purge(&hdev->cmd_q);
501 skb_queue_purge(&hdev->rx_q);
502
503 if (hdev->flush)
504 hdev->flush(hdev);
505
506 if (hdev->sent_cmd) {
507 kfree_skb(hdev->sent_cmd);
508 hdev->sent_cmd = NULL;
509 }
510
511 hdev->close(hdev);
512 hdev->flags = 0;
513 }
514
515done:
516 hci_req_unlock(hdev);
517 hci_dev_put(hdev);
518 return ret;
519}
520
521static int hci_dev_do_close(struct hci_dev *hdev)
522{
523 BT_DBG("%s %p", hdev->name, hdev);
524
525 hci_req_cancel(hdev, ENODEV);
526 hci_req_lock(hdev);
527
528 if (!test_and_clear_bit(HCI_UP, &hdev->flags)) {
529 hci_req_unlock(hdev);
530 return 0;
531 }
532
533 /* Kill RX and TX tasks */
534 tasklet_kill(&hdev->rx_task);
535 tasklet_kill(&hdev->tx_task);
536
537 hci_dev_lock_bh(hdev);
538 inquiry_cache_flush(hdev);
539 hci_conn_hash_flush(hdev);
540 hci_dev_unlock_bh(hdev);
541
542 hci_notify(hdev, HCI_DEV_DOWN);
543
544 if (hdev->flush)
545 hdev->flush(hdev);
546
547 /* Reset device */
548 skb_queue_purge(&hdev->cmd_q);
549 atomic_set(&hdev->cmd_cnt, 1);
550 if (!test_bit(HCI_RAW, &hdev->flags)) {
551 set_bit(HCI_INIT, &hdev->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200552 __hci_request(hdev, hci_reset_req, 0,
553 msecs_to_jiffies(250));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554 clear_bit(HCI_INIT, &hdev->flags);
555 }
556
557 /* Kill cmd task */
558 tasklet_kill(&hdev->cmd_task);
559
560 /* Drop queues */
561 skb_queue_purge(&hdev->rx_q);
562 skb_queue_purge(&hdev->cmd_q);
563 skb_queue_purge(&hdev->raw_q);
564
565 /* Drop last sent command */
566 if (hdev->sent_cmd) {
567 kfree_skb(hdev->sent_cmd);
568 hdev->sent_cmd = NULL;
569 }
570
571 /* After this point our queues are empty
572 * and no tasks are scheduled. */
573 hdev->close(hdev);
574
575 /* Clear flags */
576 hdev->flags = 0;
577
578 hci_req_unlock(hdev);
579
580 hci_dev_put(hdev);
581 return 0;
582}
583
584int hci_dev_close(__u16 dev)
585{
586 struct hci_dev *hdev;
587 int err;
588
589 if (!(hdev = hci_dev_get(dev)))
590 return -ENODEV;
591 err = hci_dev_do_close(hdev);
592 hci_dev_put(hdev);
593 return err;
594}
595
596int hci_dev_reset(__u16 dev)
597{
598 struct hci_dev *hdev;
599 int ret = 0;
600
601 if (!(hdev = hci_dev_get(dev)))
602 return -ENODEV;
603
604 hci_req_lock(hdev);
605 tasklet_disable(&hdev->tx_task);
606
607 if (!test_bit(HCI_UP, &hdev->flags))
608 goto done;
609
610 /* Drop queues */
611 skb_queue_purge(&hdev->rx_q);
612 skb_queue_purge(&hdev->cmd_q);
613
614 hci_dev_lock_bh(hdev);
615 inquiry_cache_flush(hdev);
616 hci_conn_hash_flush(hdev);
617 hci_dev_unlock_bh(hdev);
618
619 if (hdev->flush)
620 hdev->flush(hdev);
621
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900622 atomic_set(&hdev->cmd_cnt, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 hdev->acl_cnt = 0; hdev->sco_cnt = 0;
624
625 if (!test_bit(HCI_RAW, &hdev->flags))
Marcel Holtmann04837f62006-07-03 10:02:33 +0200626 ret = __hci_request(hdev, hci_reset_req, 0,
627 msecs_to_jiffies(HCI_INIT_TIMEOUT));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628
629done:
630 tasklet_enable(&hdev->tx_task);
631 hci_req_unlock(hdev);
632 hci_dev_put(hdev);
633 return ret;
634}
635
636int hci_dev_reset_stat(__u16 dev)
637{
638 struct hci_dev *hdev;
639 int ret = 0;
640
641 if (!(hdev = hci_dev_get(dev)))
642 return -ENODEV;
643
644 memset(&hdev->stat, 0, sizeof(struct hci_dev_stats));
645
646 hci_dev_put(hdev);
647
648 return ret;
649}
650
651int hci_dev_cmd(unsigned int cmd, void __user *arg)
652{
653 struct hci_dev *hdev;
654 struct hci_dev_req dr;
655 int err = 0;
656
657 if (copy_from_user(&dr, arg, sizeof(dr)))
658 return -EFAULT;
659
660 if (!(hdev = hci_dev_get(dr.dev_id)))
661 return -ENODEV;
662
663 switch (cmd) {
664 case HCISETAUTH:
Marcel Holtmann04837f62006-07-03 10:02:33 +0200665 err = hci_request(hdev, hci_auth_req, dr.dev_opt,
666 msecs_to_jiffies(HCI_INIT_TIMEOUT));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700667 break;
668
669 case HCISETENCRYPT:
670 if (!lmp_encrypt_capable(hdev)) {
671 err = -EOPNOTSUPP;
672 break;
673 }
674
675 if (!test_bit(HCI_AUTH, &hdev->flags)) {
676 /* Auth must be enabled first */
Marcel Holtmann04837f62006-07-03 10:02:33 +0200677 err = hci_request(hdev, hci_auth_req, dr.dev_opt,
678 msecs_to_jiffies(HCI_INIT_TIMEOUT));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 if (err)
680 break;
681 }
682
Marcel Holtmann04837f62006-07-03 10:02:33 +0200683 err = hci_request(hdev, hci_encrypt_req, dr.dev_opt,
684 msecs_to_jiffies(HCI_INIT_TIMEOUT));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685 break;
686
687 case HCISETSCAN:
Marcel Holtmann04837f62006-07-03 10:02:33 +0200688 err = hci_request(hdev, hci_scan_req, dr.dev_opt,
689 msecs_to_jiffies(HCI_INIT_TIMEOUT));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690 break;
691
692 case HCISETPTYPE:
693 hdev->pkt_type = (__u16) dr.dev_opt;
694 break;
695
696 case HCISETLINKPOL:
697 hdev->link_policy = (__u16) dr.dev_opt;
698 break;
699
700 case HCISETLINKMODE:
701 hdev->link_mode = ((__u16) dr.dev_opt) & (HCI_LM_MASTER | HCI_LM_ACCEPT);
702 break;
703
704 case HCISETACLMTU:
705 hdev->acl_mtu = *((__u16 *)&dr.dev_opt + 1);
706 hdev->acl_pkts = *((__u16 *)&dr.dev_opt + 0);
707 break;
708
709 case HCISETSCOMTU:
710 hdev->sco_mtu = *((__u16 *)&dr.dev_opt + 1);
711 hdev->sco_pkts = *((__u16 *)&dr.dev_opt + 0);
712 break;
713
714 default:
715 err = -EINVAL;
716 break;
717 }
718 hci_dev_put(hdev);
719 return err;
720}
721
722int hci_get_dev_list(void __user *arg)
723{
724 struct hci_dev_list_req *dl;
725 struct hci_dev_req *dr;
726 struct list_head *p;
727 int n = 0, size, err;
728 __u16 dev_num;
729
730 if (get_user(dev_num, (__u16 __user *) arg))
731 return -EFAULT;
732
733 if (!dev_num || dev_num > (PAGE_SIZE * 2) / sizeof(*dr))
734 return -EINVAL;
735
736 size = sizeof(*dl) + dev_num * sizeof(*dr);
737
738 if (!(dl = kmalloc(size, GFP_KERNEL)))
739 return -ENOMEM;
740
741 dr = dl->dev_req;
742
743 read_lock_bh(&hci_dev_list_lock);
744 list_for_each(p, &hci_dev_list) {
745 struct hci_dev *hdev;
746 hdev = list_entry(p, struct hci_dev, list);
747 (dr + n)->dev_id = hdev->id;
748 (dr + n)->dev_opt = hdev->flags;
749 if (++n >= dev_num)
750 break;
751 }
752 read_unlock_bh(&hci_dev_list_lock);
753
754 dl->dev_num = n;
755 size = sizeof(*dl) + n * sizeof(*dr);
756
757 err = copy_to_user(arg, dl, size);
758 kfree(dl);
759
760 return err ? -EFAULT : 0;
761}
762
763int hci_get_dev_info(void __user *arg)
764{
765 struct hci_dev *hdev;
766 struct hci_dev_info di;
767 int err = 0;
768
769 if (copy_from_user(&di, arg, sizeof(di)))
770 return -EFAULT;
771
772 if (!(hdev = hci_dev_get(di.dev_id)))
773 return -ENODEV;
774
775 strcpy(di.name, hdev->name);
776 di.bdaddr = hdev->bdaddr;
777 di.type = hdev->type;
778 di.flags = hdev->flags;
779 di.pkt_type = hdev->pkt_type;
780 di.acl_mtu = hdev->acl_mtu;
781 di.acl_pkts = hdev->acl_pkts;
782 di.sco_mtu = hdev->sco_mtu;
783 di.sco_pkts = hdev->sco_pkts;
784 di.link_policy = hdev->link_policy;
785 di.link_mode = hdev->link_mode;
786
787 memcpy(&di.stat, &hdev->stat, sizeof(di.stat));
788 memcpy(&di.features, &hdev->features, sizeof(di.features));
789
790 if (copy_to_user(arg, &di, sizeof(di)))
791 err = -EFAULT;
792
793 hci_dev_put(hdev);
794
795 return err;
796}
797
798/* ---- Interface to HCI drivers ---- */
799
800/* Alloc HCI device */
801struct hci_dev *hci_alloc_dev(void)
802{
803 struct hci_dev *hdev;
804
Marcel Holtmann25ea6db2006-07-06 15:40:09 +0200805 hdev = kzalloc(sizeof(struct hci_dev), GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700806 if (!hdev)
807 return NULL;
808
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 skb_queue_head_init(&hdev->driver_init);
810
811 return hdev;
812}
813EXPORT_SYMBOL(hci_alloc_dev);
814
815/* Free HCI device */
816void hci_free_dev(struct hci_dev *hdev)
817{
818 skb_queue_purge(&hdev->driver_init);
819
Marcel Holtmanna91f2e32006-07-03 10:02:41 +0200820 /* will free via device release */
821 put_device(&hdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700822}
823EXPORT_SYMBOL(hci_free_dev);
824
825/* Register HCI device */
826int hci_register_dev(struct hci_dev *hdev)
827{
828 struct list_head *head = &hci_dev_list, *p;
829 int id = 0;
830
831 BT_DBG("%p name %s type %d owner %p", hdev, hdev->name, hdev->type, hdev->owner);
832
833 if (!hdev->open || !hdev->close || !hdev->destruct)
834 return -EINVAL;
835
836 write_lock_bh(&hci_dev_list_lock);
837
838 /* Find first available device id */
839 list_for_each(p, &hci_dev_list) {
840 if (list_entry(p, struct hci_dev, list)->id != id)
841 break;
842 head = p; id++;
843 }
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900844
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845 sprintf(hdev->name, "hci%d", id);
846 hdev->id = id;
847 list_add(&hdev->list, head);
848
849 atomic_set(&hdev->refcnt, 1);
850 spin_lock_init(&hdev->lock);
851
852 hdev->flags = 0;
853 hdev->pkt_type = (HCI_DM1 | HCI_DH1 | HCI_HV1);
854 hdev->link_mode = (HCI_LM_ACCEPT);
855
Marcel Holtmann04837f62006-07-03 10:02:33 +0200856 hdev->idle_timeout = 0;
857 hdev->sniff_max_interval = 800;
858 hdev->sniff_min_interval = 80;
859
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860 tasklet_init(&hdev->cmd_task, hci_cmd_task,(unsigned long) hdev);
861 tasklet_init(&hdev->rx_task, hci_rx_task, (unsigned long) hdev);
862 tasklet_init(&hdev->tx_task, hci_tx_task, (unsigned long) hdev);
863
864 skb_queue_head_init(&hdev->rx_q);
865 skb_queue_head_init(&hdev->cmd_q);
866 skb_queue_head_init(&hdev->raw_q);
867
868 init_waitqueue_head(&hdev->req_wait_q);
869 init_MUTEX(&hdev->req_lock);
870
871 inquiry_cache_init(hdev);
872
873 hci_conn_hash_init(hdev);
874
875 memset(&hdev->stat, 0, sizeof(struct hci_dev_stats));
876
877 atomic_set(&hdev->promisc, 0);
878
879 write_unlock_bh(&hci_dev_list_lock);
880
881 hci_register_sysfs(hdev);
882
883 hci_notify(hdev, HCI_DEV_REG);
884
885 return id;
886}
887EXPORT_SYMBOL(hci_register_dev);
888
889/* Unregister HCI device */
890int hci_unregister_dev(struct hci_dev *hdev)
891{
892 BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type);
893
894 hci_unregister_sysfs(hdev);
895
896 write_lock_bh(&hci_dev_list_lock);
897 list_del(&hdev->list);
898 write_unlock_bh(&hci_dev_list_lock);
899
900 hci_dev_do_close(hdev);
901
902 hci_notify(hdev, HCI_DEV_UNREG);
903
904 __hci_dev_put(hdev);
905 return 0;
906}
907EXPORT_SYMBOL(hci_unregister_dev);
908
909/* Suspend HCI device */
910int hci_suspend_dev(struct hci_dev *hdev)
911{
912 hci_notify(hdev, HCI_DEV_SUSPEND);
913 return 0;
914}
915EXPORT_SYMBOL(hci_suspend_dev);
916
917/* Resume HCI device */
918int hci_resume_dev(struct hci_dev *hdev)
919{
920 hci_notify(hdev, HCI_DEV_RESUME);
921 return 0;
922}
923EXPORT_SYMBOL(hci_resume_dev);
924
925/* ---- Interface to upper protocols ---- */
926
927/* Register/Unregister protocols.
928 * hci_task_lock is used to ensure that no tasks are running. */
929int hci_register_proto(struct hci_proto *hp)
930{
931 int err = 0;
932
933 BT_DBG("%p name %s id %d", hp, hp->name, hp->id);
934
935 if (hp->id >= HCI_MAX_PROTO)
936 return -EINVAL;
937
938 write_lock_bh(&hci_task_lock);
939
940 if (!hci_proto[hp->id])
941 hci_proto[hp->id] = hp;
942 else
943 err = -EEXIST;
944
945 write_unlock_bh(&hci_task_lock);
946
947 return err;
948}
949EXPORT_SYMBOL(hci_register_proto);
950
951int hci_unregister_proto(struct hci_proto *hp)
952{
953 int err = 0;
954
955 BT_DBG("%p name %s id %d", hp, hp->name, hp->id);
956
957 if (hp->id >= HCI_MAX_PROTO)
958 return -EINVAL;
959
960 write_lock_bh(&hci_task_lock);
961
962 if (hci_proto[hp->id])
963 hci_proto[hp->id] = NULL;
964 else
965 err = -ENOENT;
966
967 write_unlock_bh(&hci_task_lock);
968
969 return err;
970}
971EXPORT_SYMBOL(hci_unregister_proto);
972
973int hci_register_cb(struct hci_cb *cb)
974{
975 BT_DBG("%p name %s", cb, cb->name);
976
977 write_lock_bh(&hci_cb_list_lock);
978 list_add(&cb->list, &hci_cb_list);
979 write_unlock_bh(&hci_cb_list_lock);
980
981 return 0;
982}
983EXPORT_SYMBOL(hci_register_cb);
984
985int hci_unregister_cb(struct hci_cb *cb)
986{
987 BT_DBG("%p name %s", cb, cb->name);
988
989 write_lock_bh(&hci_cb_list_lock);
990 list_del(&cb->list);
991 write_unlock_bh(&hci_cb_list_lock);
992
993 return 0;
994}
995EXPORT_SYMBOL(hci_unregister_cb);
996
997static int hci_send_frame(struct sk_buff *skb)
998{
999 struct hci_dev *hdev = (struct hci_dev *) skb->dev;
1000
1001 if (!hdev) {
1002 kfree_skb(skb);
1003 return -ENODEV;
1004 }
1005
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001006 BT_DBG("%s type %d len %d", hdev->name, bt_cb(skb)->pkt_type, skb->len);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001007
1008 if (atomic_read(&hdev->promisc)) {
1009 /* Time stamp */
Patrick McHardya61bbcf2005-08-14 17:24:31 -07001010 __net_timestamp(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001011
1012 hci_send_to_sock(hdev, skb);
1013 }
1014
1015 /* Get rid of skb owner, prior to sending to the driver. */
1016 skb_orphan(skb);
1017
1018 return hdev->send(skb);
1019}
1020
1021/* Send HCI command */
1022int hci_send_cmd(struct hci_dev *hdev, __u16 ogf, __u16 ocf, __u32 plen, void *param)
1023{
1024 int len = HCI_COMMAND_HDR_SIZE + plen;
1025 struct hci_command_hdr *hdr;
1026 struct sk_buff *skb;
1027
1028 BT_DBG("%s ogf 0x%x ocf 0x%x plen %d", hdev->name, ogf, ocf, plen);
1029
1030 skb = bt_skb_alloc(len, GFP_ATOMIC);
1031 if (!skb) {
1032 BT_ERR("%s Can't allocate memory for HCI command", hdev->name);
1033 return -ENOMEM;
1034 }
1035
1036 hdr = (struct hci_command_hdr *) skb_put(skb, HCI_COMMAND_HDR_SIZE);
1037 hdr->opcode = __cpu_to_le16(hci_opcode_pack(ogf, ocf));
1038 hdr->plen = plen;
1039
1040 if (plen)
1041 memcpy(skb_put(skb, plen), param, plen);
1042
1043 BT_DBG("skb len %d", skb->len);
1044
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001045 bt_cb(skb)->pkt_type = HCI_COMMAND_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001046 skb->dev = (void *) hdev;
1047 skb_queue_tail(&hdev->cmd_q, skb);
1048 hci_sched_cmd(hdev);
1049
1050 return 0;
1051}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001052
1053/* Get data from the previously sent command */
1054void *hci_sent_cmd_data(struct hci_dev *hdev, __u16 ogf, __u16 ocf)
1055{
1056 struct hci_command_hdr *hdr;
1057
1058 if (!hdev->sent_cmd)
1059 return NULL;
1060
1061 hdr = (void *) hdev->sent_cmd->data;
1062
1063 if (hdr->opcode != __cpu_to_le16(hci_opcode_pack(ogf, ocf)))
1064 return NULL;
1065
1066 BT_DBG("%s ogf 0x%x ocf 0x%x", hdev->name, ogf, ocf);
1067
1068 return hdev->sent_cmd->data + HCI_COMMAND_HDR_SIZE;
1069}
1070
1071/* Send ACL data */
1072static void hci_add_acl_hdr(struct sk_buff *skb, __u16 handle, __u16 flags)
1073{
1074 struct hci_acl_hdr *hdr;
1075 int len = skb->len;
1076
1077 hdr = (struct hci_acl_hdr *) skb_push(skb, HCI_ACL_HDR_SIZE);
1078 hdr->handle = __cpu_to_le16(hci_handle_pack(handle, flags));
1079 hdr->dlen = __cpu_to_le16(len);
1080
1081 skb->h.raw = (void *) hdr;
1082}
1083
1084int hci_send_acl(struct hci_conn *conn, struct sk_buff *skb, __u16 flags)
1085{
1086 struct hci_dev *hdev = conn->hdev;
1087 struct sk_buff *list;
1088
1089 BT_DBG("%s conn %p flags 0x%x", hdev->name, conn, flags);
1090
1091 skb->dev = (void *) hdev;
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001092 bt_cb(skb)->pkt_type = HCI_ACLDATA_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093 hci_add_acl_hdr(skb, conn->handle, flags | ACL_START);
1094
1095 if (!(list = skb_shinfo(skb)->frag_list)) {
1096 /* Non fragmented */
1097 BT_DBG("%s nonfrag skb %p len %d", hdev->name, skb, skb->len);
1098
1099 skb_queue_tail(&conn->data_q, skb);
1100 } else {
1101 /* Fragmented */
1102 BT_DBG("%s frag %p len %d", hdev->name, skb, skb->len);
1103
1104 skb_shinfo(skb)->frag_list = NULL;
1105
1106 /* Queue all fragments atomically */
1107 spin_lock_bh(&conn->data_q.lock);
1108
1109 __skb_queue_tail(&conn->data_q, skb);
1110 do {
1111 skb = list; list = list->next;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001112
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113 skb->dev = (void *) hdev;
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001114 bt_cb(skb)->pkt_type = HCI_ACLDATA_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001115 hci_add_acl_hdr(skb, conn->handle, flags | ACL_CONT);
1116
1117 BT_DBG("%s frag %p len %d", hdev->name, skb, skb->len);
1118
1119 __skb_queue_tail(&conn->data_q, skb);
1120 } while (list);
1121
1122 spin_unlock_bh(&conn->data_q.lock);
1123 }
1124
1125 hci_sched_tx(hdev);
1126 return 0;
1127}
1128EXPORT_SYMBOL(hci_send_acl);
1129
1130/* Send SCO data */
1131int hci_send_sco(struct hci_conn *conn, struct sk_buff *skb)
1132{
1133 struct hci_dev *hdev = conn->hdev;
1134 struct hci_sco_hdr hdr;
1135
1136 BT_DBG("%s len %d", hdev->name, skb->len);
1137
1138 if (skb->len > hdev->sco_mtu) {
1139 kfree_skb(skb);
1140 return -EINVAL;
1141 }
1142
1143 hdr.handle = __cpu_to_le16(conn->handle);
1144 hdr.dlen = skb->len;
1145
1146 skb->h.raw = skb_push(skb, HCI_SCO_HDR_SIZE);
1147 memcpy(skb->h.raw, &hdr, HCI_SCO_HDR_SIZE);
1148
1149 skb->dev = (void *) hdev;
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001150 bt_cb(skb)->pkt_type = HCI_SCODATA_PKT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001151 skb_queue_tail(&conn->data_q, skb);
1152 hci_sched_tx(hdev);
1153 return 0;
1154}
1155EXPORT_SYMBOL(hci_send_sco);
1156
1157/* ---- HCI TX task (outgoing data) ---- */
1158
1159/* HCI Connection scheduler */
1160static inline struct hci_conn *hci_low_sent(struct hci_dev *hdev, __u8 type, int *quote)
1161{
1162 struct hci_conn_hash *h = &hdev->conn_hash;
1163 struct hci_conn *conn = NULL;
1164 int num = 0, min = ~0;
1165 struct list_head *p;
1166
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001167 /* We don't have to lock device here. Connections are always
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168 * added and removed with TX task disabled. */
1169 list_for_each(p, &h->list) {
1170 struct hci_conn *c;
1171 c = list_entry(p, struct hci_conn, list);
1172
1173 if (c->type != type || c->state != BT_CONNECTED
1174 || skb_queue_empty(&c->data_q))
1175 continue;
1176 num++;
1177
1178 if (c->sent < min) {
1179 min = c->sent;
1180 conn = c;
1181 }
1182 }
1183
1184 if (conn) {
1185 int cnt = (type == ACL_LINK ? hdev->acl_cnt : hdev->sco_cnt);
1186 int q = cnt / num;
1187 *quote = q ? q : 1;
1188 } else
1189 *quote = 0;
1190
1191 BT_DBG("conn %p quote %d", conn, *quote);
1192 return conn;
1193}
1194
1195static inline void hci_acl_tx_to(struct hci_dev *hdev)
1196{
1197 struct hci_conn_hash *h = &hdev->conn_hash;
1198 struct list_head *p;
1199 struct hci_conn *c;
1200
1201 BT_ERR("%s ACL tx timeout", hdev->name);
1202
1203 /* Kill stalled connections */
1204 list_for_each(p, &h->list) {
1205 c = list_entry(p, struct hci_conn, list);
1206 if (c->type == ACL_LINK && c->sent) {
1207 BT_ERR("%s killing stalled ACL connection %s",
1208 hdev->name, batostr(&c->dst));
1209 hci_acl_disconn(c, 0x13);
1210 }
1211 }
1212}
1213
1214static inline void hci_sched_acl(struct hci_dev *hdev)
1215{
1216 struct hci_conn *conn;
1217 struct sk_buff *skb;
1218 int quote;
1219
1220 BT_DBG("%s", hdev->name);
1221
1222 if (!test_bit(HCI_RAW, &hdev->flags)) {
1223 /* ACL tx timeout must be longer than maximum
1224 * link supervision timeout (40.9 seconds) */
1225 if (!hdev->acl_cnt && (jiffies - hdev->acl_last_tx) > (HZ * 45))
1226 hci_acl_tx_to(hdev);
1227 }
1228
1229 while (hdev->acl_cnt && (conn = hci_low_sent(hdev, ACL_LINK, &quote))) {
1230 while (quote-- && (skb = skb_dequeue(&conn->data_q))) {
1231 BT_DBG("skb %p len %d", skb, skb->len);
Marcel Holtmann04837f62006-07-03 10:02:33 +02001232
1233 hci_conn_enter_active_mode(conn);
1234
Linus Torvalds1da177e2005-04-16 15:20:36 -07001235 hci_send_frame(skb);
1236 hdev->acl_last_tx = jiffies;
1237
1238 hdev->acl_cnt--;
1239 conn->sent++;
1240 }
1241 }
1242}
1243
1244/* Schedule SCO */
1245static inline void hci_sched_sco(struct hci_dev *hdev)
1246{
1247 struct hci_conn *conn;
1248 struct sk_buff *skb;
1249 int quote;
1250
1251 BT_DBG("%s", hdev->name);
1252
1253 while (hdev->sco_cnt && (conn = hci_low_sent(hdev, SCO_LINK, &quote))) {
1254 while (quote-- && (skb = skb_dequeue(&conn->data_q))) {
1255 BT_DBG("skb %p len %d", skb, skb->len);
1256 hci_send_frame(skb);
1257
1258 conn->sent++;
1259 if (conn->sent == ~0)
1260 conn->sent = 0;
1261 }
1262 }
1263}
1264
1265static void hci_tx_task(unsigned long arg)
1266{
1267 struct hci_dev *hdev = (struct hci_dev *) arg;
1268 struct sk_buff *skb;
1269
1270 read_lock(&hci_task_lock);
1271
1272 BT_DBG("%s acl %d sco %d", hdev->name, hdev->acl_cnt, hdev->sco_cnt);
1273
1274 /* Schedule queues and send stuff to HCI driver */
1275
1276 hci_sched_acl(hdev);
1277
1278 hci_sched_sco(hdev);
1279
1280 /* Send next queued raw (unknown type) packet */
1281 while ((skb = skb_dequeue(&hdev->raw_q)))
1282 hci_send_frame(skb);
1283
1284 read_unlock(&hci_task_lock);
1285}
1286
1287/* ----- HCI RX task (incoming data proccessing) ----- */
1288
1289/* ACL data packet */
1290static inline void hci_acldata_packet(struct hci_dev *hdev, struct sk_buff *skb)
1291{
1292 struct hci_acl_hdr *hdr = (void *) skb->data;
1293 struct hci_conn *conn;
1294 __u16 handle, flags;
1295
1296 skb_pull(skb, HCI_ACL_HDR_SIZE);
1297
1298 handle = __le16_to_cpu(hdr->handle);
1299 flags = hci_flags(handle);
1300 handle = hci_handle(handle);
1301
1302 BT_DBG("%s len %d handle 0x%x flags 0x%x", hdev->name, skb->len, handle, flags);
1303
1304 hdev->stat.acl_rx++;
1305
1306 hci_dev_lock(hdev);
1307 conn = hci_conn_hash_lookup_handle(hdev, handle);
1308 hci_dev_unlock(hdev);
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001309
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310 if (conn) {
1311 register struct hci_proto *hp;
1312
Marcel Holtmann04837f62006-07-03 10:02:33 +02001313 hci_conn_enter_active_mode(conn);
1314
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315 /* Send to upper protocol */
1316 if ((hp = hci_proto[HCI_PROTO_L2CAP]) && hp->recv_acldata) {
1317 hp->recv_acldata(conn, skb, flags);
1318 return;
1319 }
1320 } else {
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001321 BT_ERR("%s ACL packet for unknown connection handle %d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001322 hdev->name, handle);
1323 }
1324
1325 kfree_skb(skb);
1326}
1327
1328/* SCO data packet */
1329static inline void hci_scodata_packet(struct hci_dev *hdev, struct sk_buff *skb)
1330{
1331 struct hci_sco_hdr *hdr = (void *) skb->data;
1332 struct hci_conn *conn;
1333 __u16 handle;
1334
1335 skb_pull(skb, HCI_SCO_HDR_SIZE);
1336
1337 handle = __le16_to_cpu(hdr->handle);
1338
1339 BT_DBG("%s len %d handle 0x%x", hdev->name, skb->len, handle);
1340
1341 hdev->stat.sco_rx++;
1342
1343 hci_dev_lock(hdev);
1344 conn = hci_conn_hash_lookup_handle(hdev, handle);
1345 hci_dev_unlock(hdev);
1346
1347 if (conn) {
1348 register struct hci_proto *hp;
1349
1350 /* Send to upper protocol */
1351 if ((hp = hci_proto[HCI_PROTO_SCO]) && hp->recv_scodata) {
1352 hp->recv_scodata(conn, skb);
1353 return;
1354 }
1355 } else {
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001356 BT_ERR("%s SCO packet for unknown connection handle %d",
Linus Torvalds1da177e2005-04-16 15:20:36 -07001357 hdev->name, handle);
1358 }
1359
1360 kfree_skb(skb);
1361}
1362
Marcel Holtmann65164552005-10-28 19:20:48 +02001363static void hci_rx_task(unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001364{
1365 struct hci_dev *hdev = (struct hci_dev *) arg;
1366 struct sk_buff *skb;
1367
1368 BT_DBG("%s", hdev->name);
1369
1370 read_lock(&hci_task_lock);
1371
1372 while ((skb = skb_dequeue(&hdev->rx_q))) {
1373 if (atomic_read(&hdev->promisc)) {
1374 /* Send copy to the sockets */
1375 hci_send_to_sock(hdev, skb);
1376 }
1377
1378 if (test_bit(HCI_RAW, &hdev->flags)) {
1379 kfree_skb(skb);
1380 continue;
1381 }
1382
1383 if (test_bit(HCI_INIT, &hdev->flags)) {
1384 /* Don't process data packets in this states. */
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001385 switch (bt_cb(skb)->pkt_type) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001386 case HCI_ACLDATA_PKT:
1387 case HCI_SCODATA_PKT:
1388 kfree_skb(skb);
1389 continue;
1390 };
1391 }
1392
1393 /* Process frame */
Marcel Holtmann0d48d932005-08-09 20:30:28 -07001394 switch (bt_cb(skb)->pkt_type) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001395 case HCI_EVENT_PKT:
1396 hci_event_packet(hdev, skb);
1397 break;
1398
1399 case HCI_ACLDATA_PKT:
1400 BT_DBG("%s ACL data packet", hdev->name);
1401 hci_acldata_packet(hdev, skb);
1402 break;
1403
1404 case HCI_SCODATA_PKT:
1405 BT_DBG("%s SCO data packet", hdev->name);
1406 hci_scodata_packet(hdev, skb);
1407 break;
1408
1409 default:
1410 kfree_skb(skb);
1411 break;
1412 }
1413 }
1414
1415 read_unlock(&hci_task_lock);
1416}
1417
1418static void hci_cmd_task(unsigned long arg)
1419{
1420 struct hci_dev *hdev = (struct hci_dev *) arg;
1421 struct sk_buff *skb;
1422
1423 BT_DBG("%s cmd %d", hdev->name, atomic_read(&hdev->cmd_cnt));
1424
1425 if (!atomic_read(&hdev->cmd_cnt) && (jiffies - hdev->cmd_last_tx) > HZ) {
1426 BT_ERR("%s command tx timeout", hdev->name);
1427 atomic_set(&hdev->cmd_cnt, 1);
1428 }
1429
1430 /* Send queued commands */
1431 if (atomic_read(&hdev->cmd_cnt) && (skb = skb_dequeue(&hdev->cmd_q))) {
1432 if (hdev->sent_cmd)
1433 kfree_skb(hdev->sent_cmd);
1434
1435 if ((hdev->sent_cmd = skb_clone(skb, GFP_ATOMIC))) {
1436 atomic_dec(&hdev->cmd_cnt);
1437 hci_send_frame(skb);
1438 hdev->cmd_last_tx = jiffies;
1439 } else {
1440 skb_queue_head(&hdev->cmd_q, skb);
1441 hci_sched_cmd(hdev);
1442 }
1443 }
1444}