Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/mszeredi...
[deliverable/linux.git] / net / bluetooth / hci_conn.c
1 /*
2 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
15 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
18 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
20 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
22 SOFTWARE IS DISCLAIMED.
23 */
24
25 /* Bluetooth HCI connection handling. */
26
27 #include <linux/module.h>
28
29 #include <linux/types.h>
30 #include <linux/errno.h>
31 #include <linux/kernel.h>
32 #include <linux/slab.h>
33 #include <linux/poll.h>
34 #include <linux/fcntl.h>
35 #include <linux/init.h>
36 #include <linux/skbuff.h>
37 #include <linux/interrupt.h>
38 #include <linux/notifier.h>
39 #include <net/sock.h>
40
41 #include <asm/system.h>
42 #include <asm/uaccess.h>
43 #include <asm/unaligned.h>
44
45 #include <net/bluetooth/bluetooth.h>
46 #include <net/bluetooth/hci_core.h>
47
48 void hci_acl_connect(struct hci_conn *conn)
49 {
50 struct hci_dev *hdev = conn->hdev;
51 struct inquiry_entry *ie;
52 struct hci_cp_create_conn cp;
53
54 BT_DBG("%p", conn);
55
56 conn->state = BT_CONNECT;
57 conn->out = 1;
58
59 conn->link_mode = HCI_LM_MASTER;
60
61 conn->attempt++;
62
63 conn->link_policy = hdev->link_policy;
64
65 memset(&cp, 0, sizeof(cp));
66 bacpy(&cp.bdaddr, &conn->dst);
67 cp.pscan_rep_mode = 0x02;
68
69 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
70 if (inquiry_entry_age(ie) <= INQUIRY_ENTRY_AGE_MAX) {
71 cp.pscan_rep_mode = ie->data.pscan_rep_mode;
72 cp.pscan_mode = ie->data.pscan_mode;
73 cp.clock_offset = ie->data.clock_offset |
74 cpu_to_le16(0x8000);
75 }
76
77 memcpy(conn->dev_class, ie->data.dev_class, 3);
78 conn->ssp_mode = ie->data.ssp_mode;
79 }
80
81 cp.pkt_type = cpu_to_le16(conn->pkt_type);
82 if (lmp_rswitch_capable(hdev) && !(hdev->link_mode & HCI_LM_MASTER))
83 cp.role_switch = 0x01;
84 else
85 cp.role_switch = 0x00;
86
87 hci_send_cmd(hdev, HCI_OP_CREATE_CONN, sizeof(cp), &cp);
88 }
89
90 static void hci_acl_connect_cancel(struct hci_conn *conn)
91 {
92 struct hci_cp_create_conn_cancel cp;
93
94 BT_DBG("%p", conn);
95
96 if (conn->hdev->hci_ver < 2)
97 return;
98
99 bacpy(&cp.bdaddr, &conn->dst);
100 hci_send_cmd(conn->hdev, HCI_OP_CREATE_CONN_CANCEL, sizeof(cp), &cp);
101 }
102
103 void hci_acl_disconn(struct hci_conn *conn, __u8 reason)
104 {
105 struct hci_cp_disconnect cp;
106
107 BT_DBG("%p", conn);
108
109 conn->state = BT_DISCONN;
110
111 cp.handle = cpu_to_le16(conn->handle);
112 cp.reason = reason;
113 hci_send_cmd(conn->hdev, HCI_OP_DISCONNECT, sizeof(cp), &cp);
114 }
115
116 void hci_add_sco(struct hci_conn *conn, __u16 handle)
117 {
118 struct hci_dev *hdev = conn->hdev;
119 struct hci_cp_add_sco cp;
120
121 BT_DBG("%p", conn);
122
123 conn->state = BT_CONNECT;
124 conn->out = 1;
125
126 cp.handle = cpu_to_le16(handle);
127 cp.pkt_type = cpu_to_le16(conn->pkt_type);
128
129 hci_send_cmd(hdev, HCI_OP_ADD_SCO, sizeof(cp), &cp);
130 }
131
132 void hci_setup_sync(struct hci_conn *conn, __u16 handle)
133 {
134 struct hci_dev *hdev = conn->hdev;
135 struct hci_cp_setup_sync_conn cp;
136
137 BT_DBG("%p", conn);
138
139 conn->state = BT_CONNECT;
140 conn->out = 1;
141
142 cp.handle = cpu_to_le16(handle);
143 cp.pkt_type = cpu_to_le16(conn->pkt_type);
144
145 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
146 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
147 cp.max_latency = cpu_to_le16(0xffff);
148 cp.voice_setting = cpu_to_le16(hdev->voice_setting);
149 cp.retrans_effort = 0xff;
150
151 hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp);
152 }
153
154 static void hci_conn_timeout(unsigned long arg)
155 {
156 struct hci_conn *conn = (void *) arg;
157 struct hci_dev *hdev = conn->hdev;
158
159 BT_DBG("conn %p state %d", conn, conn->state);
160
161 if (atomic_read(&conn->refcnt))
162 return;
163
164 hci_dev_lock(hdev);
165
166 switch (conn->state) {
167 case BT_CONNECT:
168 case BT_CONNECT2:
169 if (conn->type == ACL_LINK)
170 hci_acl_connect_cancel(conn);
171 else
172 hci_acl_disconn(conn, 0x13);
173 break;
174 case BT_CONFIG:
175 case BT_CONNECTED:
176 hci_acl_disconn(conn, 0x13);
177 break;
178 default:
179 conn->state = BT_CLOSED;
180 break;
181 }
182
183 hci_dev_unlock(hdev);
184 }
185
186 static void hci_conn_idle(unsigned long arg)
187 {
188 struct hci_conn *conn = (void *) arg;
189
190 BT_DBG("conn %p mode %d", conn, conn->mode);
191
192 hci_conn_enter_sniff_mode(conn);
193 }
194
195 struct hci_conn *hci_conn_add(struct hci_dev *hdev, int type, bdaddr_t *dst)
196 {
197 struct hci_conn *conn;
198
199 BT_DBG("%s dst %s", hdev->name, batostr(dst));
200
201 conn = kzalloc(sizeof(struct hci_conn), GFP_ATOMIC);
202 if (!conn)
203 return NULL;
204
205 bacpy(&conn->dst, dst);
206 conn->hdev = hdev;
207 conn->type = type;
208 conn->mode = HCI_CM_ACTIVE;
209 conn->state = BT_OPEN;
210
211 conn->power_save = 1;
212
213 switch (type) {
214 case ACL_LINK:
215 conn->pkt_type = hdev->pkt_type & ACL_PTYPE_MASK;
216 break;
217 case SCO_LINK:
218 if (lmp_esco_capable(hdev))
219 conn->pkt_type = hdev->esco_type & SCO_ESCO_MASK;
220 else
221 conn->pkt_type = hdev->pkt_type & SCO_PTYPE_MASK;
222 break;
223 case ESCO_LINK:
224 conn->pkt_type = hdev->esco_type;
225 break;
226 }
227
228 skb_queue_head_init(&conn->data_q);
229
230 setup_timer(&conn->disc_timer, hci_conn_timeout, (unsigned long)conn);
231 setup_timer(&conn->idle_timer, hci_conn_idle, (unsigned long)conn);
232
233 atomic_set(&conn->refcnt, 0);
234
235 hci_dev_hold(hdev);
236
237 tasklet_disable(&hdev->tx_task);
238
239 hci_conn_hash_add(hdev, conn);
240 if (hdev->notify)
241 hdev->notify(hdev, HCI_NOTIFY_CONN_ADD);
242
243 tasklet_enable(&hdev->tx_task);
244
245 return conn;
246 }
247
248 int hci_conn_del(struct hci_conn *conn)
249 {
250 struct hci_dev *hdev = conn->hdev;
251
252 BT_DBG("%s conn %p handle %d", hdev->name, conn, conn->handle);
253
254 del_timer(&conn->idle_timer);
255
256 del_timer(&conn->disc_timer);
257
258 if (conn->type == ACL_LINK) {
259 struct hci_conn *sco = conn->link;
260 if (sco)
261 sco->link = NULL;
262
263 /* Unacked frames */
264 hdev->acl_cnt += conn->sent;
265 } else {
266 struct hci_conn *acl = conn->link;
267 if (acl) {
268 acl->link = NULL;
269 hci_conn_put(acl);
270 }
271 }
272
273 tasklet_disable(&hdev->tx_task);
274
275 hci_conn_hash_del(hdev, conn);
276 if (hdev->notify)
277 hdev->notify(hdev, HCI_NOTIFY_CONN_DEL);
278
279 tasklet_enable(&hdev->tx_task);
280
281 skb_queue_purge(&conn->data_q);
282
283 return 0;
284 }
285
286 struct hci_dev *hci_get_route(bdaddr_t *dst, bdaddr_t *src)
287 {
288 int use_src = bacmp(src, BDADDR_ANY);
289 struct hci_dev *hdev = NULL;
290 struct list_head *p;
291
292 BT_DBG("%s -> %s", batostr(src), batostr(dst));
293
294 read_lock_bh(&hci_dev_list_lock);
295
296 list_for_each(p, &hci_dev_list) {
297 struct hci_dev *d = list_entry(p, struct hci_dev, list);
298
299 if (!test_bit(HCI_UP, &d->flags) || test_bit(HCI_RAW, &d->flags))
300 continue;
301
302 /* Simple routing:
303 * No source address - find interface with bdaddr != dst
304 * Source address - find interface with bdaddr == src
305 */
306
307 if (use_src) {
308 if (!bacmp(&d->bdaddr, src)) {
309 hdev = d; break;
310 }
311 } else {
312 if (bacmp(&d->bdaddr, dst)) {
313 hdev = d; break;
314 }
315 }
316 }
317
318 if (hdev)
319 hdev = hci_dev_hold(hdev);
320
321 read_unlock_bh(&hci_dev_list_lock);
322 return hdev;
323 }
324 EXPORT_SYMBOL(hci_get_route);
325
326 /* Create SCO or ACL connection.
327 * Device _must_ be locked */
328 struct hci_conn *hci_connect(struct hci_dev *hdev, int type, bdaddr_t *dst, __u8 auth_type)
329 {
330 struct hci_conn *acl;
331 struct hci_conn *sco;
332
333 BT_DBG("%s dst %s", hdev->name, batostr(dst));
334
335 if (!(acl = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst))) {
336 if (!(acl = hci_conn_add(hdev, ACL_LINK, dst)))
337 return NULL;
338 }
339
340 hci_conn_hold(acl);
341
342 if (acl->state == BT_OPEN || acl->state == BT_CLOSED) {
343 acl->auth_type = auth_type;
344 hci_acl_connect(acl);
345 }
346
347 if (type == ACL_LINK)
348 return acl;
349
350 if (!(sco = hci_conn_hash_lookup_ba(hdev, type, dst))) {
351 if (!(sco = hci_conn_add(hdev, type, dst))) {
352 hci_conn_put(acl);
353 return NULL;
354 }
355 }
356
357 acl->link = sco;
358 sco->link = acl;
359
360 hci_conn_hold(sco);
361
362 if (acl->state == BT_CONNECTED &&
363 (sco->state == BT_OPEN || sco->state == BT_CLOSED)) {
364 if (lmp_esco_capable(hdev))
365 hci_setup_sync(sco, acl->handle);
366 else
367 hci_add_sco(sco, acl->handle);
368 }
369
370 return sco;
371 }
372 EXPORT_SYMBOL(hci_connect);
373
374 /* Check link security requirement */
375 int hci_conn_check_link_mode(struct hci_conn *conn)
376 {
377 BT_DBG("conn %p", conn);
378
379 if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0 &&
380 !(conn->link_mode & HCI_LM_ENCRYPT))
381 return 0;
382
383 return 1;
384 }
385 EXPORT_SYMBOL(hci_conn_check_link_mode);
386
387 /* Authenticate remote device */
388 int hci_conn_auth(struct hci_conn *conn)
389 {
390 BT_DBG("conn %p", conn);
391
392 if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0) {
393 if (!(conn->auth_type & 0x01)) {
394 conn->auth_type |= 0x01;
395 conn->link_mode &= ~HCI_LM_AUTH;
396 }
397 }
398
399 if (conn->link_mode & HCI_LM_AUTH)
400 return 1;
401
402 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
403 struct hci_cp_auth_requested cp;
404 cp.handle = cpu_to_le16(conn->handle);
405 hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
406 sizeof(cp), &cp);
407 }
408 return 0;
409 }
410 EXPORT_SYMBOL(hci_conn_auth);
411
412 /* Enable encryption */
413 int hci_conn_encrypt(struct hci_conn *conn)
414 {
415 BT_DBG("conn %p", conn);
416
417 if (conn->link_mode & HCI_LM_ENCRYPT)
418 return hci_conn_auth(conn);
419
420 if (test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend))
421 return 0;
422
423 if (hci_conn_auth(conn)) {
424 struct hci_cp_set_conn_encrypt cp;
425 cp.handle = cpu_to_le16(conn->handle);
426 cp.encrypt = 1;
427 hci_send_cmd(conn->hdev, HCI_OP_SET_CONN_ENCRYPT,
428 sizeof(cp), &cp);
429 }
430 return 0;
431 }
432 EXPORT_SYMBOL(hci_conn_encrypt);
433
434 /* Change link key */
435 int hci_conn_change_link_key(struct hci_conn *conn)
436 {
437 BT_DBG("conn %p", conn);
438
439 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
440 struct hci_cp_change_conn_link_key cp;
441 cp.handle = cpu_to_le16(conn->handle);
442 hci_send_cmd(conn->hdev, HCI_OP_CHANGE_CONN_LINK_KEY,
443 sizeof(cp), &cp);
444 }
445 return 0;
446 }
447 EXPORT_SYMBOL(hci_conn_change_link_key);
448
449 /* Switch role */
450 int hci_conn_switch_role(struct hci_conn *conn, uint8_t role)
451 {
452 BT_DBG("conn %p", conn);
453
454 if (!role && conn->link_mode & HCI_LM_MASTER)
455 return 1;
456
457 if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND, &conn->pend)) {
458 struct hci_cp_switch_role cp;
459 bacpy(&cp.bdaddr, &conn->dst);
460 cp.role = role;
461 hci_send_cmd(conn->hdev, HCI_OP_SWITCH_ROLE, sizeof(cp), &cp);
462 }
463 return 0;
464 }
465 EXPORT_SYMBOL(hci_conn_switch_role);
466
467 /* Enter active mode */
468 void hci_conn_enter_active_mode(struct hci_conn *conn)
469 {
470 struct hci_dev *hdev = conn->hdev;
471
472 BT_DBG("conn %p mode %d", conn, conn->mode);
473
474 if (test_bit(HCI_RAW, &hdev->flags))
475 return;
476
477 if (conn->mode != HCI_CM_SNIFF || !conn->power_save)
478 goto timer;
479
480 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
481 struct hci_cp_exit_sniff_mode cp;
482 cp.handle = cpu_to_le16(conn->handle);
483 hci_send_cmd(hdev, HCI_OP_EXIT_SNIFF_MODE, sizeof(cp), &cp);
484 }
485
486 timer:
487 if (hdev->idle_timeout > 0)
488 mod_timer(&conn->idle_timer,
489 jiffies + msecs_to_jiffies(hdev->idle_timeout));
490 }
491
492 /* Enter sniff mode */
493 void hci_conn_enter_sniff_mode(struct hci_conn *conn)
494 {
495 struct hci_dev *hdev = conn->hdev;
496
497 BT_DBG("conn %p mode %d", conn, conn->mode);
498
499 if (test_bit(HCI_RAW, &hdev->flags))
500 return;
501
502 if (!lmp_sniff_capable(hdev) || !lmp_sniff_capable(conn))
503 return;
504
505 if (conn->mode != HCI_CM_ACTIVE || !(conn->link_policy & HCI_LP_SNIFF))
506 return;
507
508 if (lmp_sniffsubr_capable(hdev) && lmp_sniffsubr_capable(conn)) {
509 struct hci_cp_sniff_subrate cp;
510 cp.handle = cpu_to_le16(conn->handle);
511 cp.max_latency = cpu_to_le16(0);
512 cp.min_remote_timeout = cpu_to_le16(0);
513 cp.min_local_timeout = cpu_to_le16(0);
514 hci_send_cmd(hdev, HCI_OP_SNIFF_SUBRATE, sizeof(cp), &cp);
515 }
516
517 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
518 struct hci_cp_sniff_mode cp;
519 cp.handle = cpu_to_le16(conn->handle);
520 cp.max_interval = cpu_to_le16(hdev->sniff_max_interval);
521 cp.min_interval = cpu_to_le16(hdev->sniff_min_interval);
522 cp.attempt = cpu_to_le16(4);
523 cp.timeout = cpu_to_le16(1);
524 hci_send_cmd(hdev, HCI_OP_SNIFF_MODE, sizeof(cp), &cp);
525 }
526 }
527
528 /* Drop all connection on the device */
529 void hci_conn_hash_flush(struct hci_dev *hdev)
530 {
531 struct hci_conn_hash *h = &hdev->conn_hash;
532 struct list_head *p;
533
534 BT_DBG("hdev %s", hdev->name);
535
536 p = h->list.next;
537 while (p != &h->list) {
538 struct hci_conn *c;
539
540 c = list_entry(p, struct hci_conn, list);
541 p = p->next;
542
543 c->state = BT_CLOSED;
544
545 hci_conn_del_sysfs(c);
546
547 hci_proto_disconn_ind(c, 0x16);
548 hci_conn_del(c);
549 }
550 }
551
552 /* Check pending connect attempts */
553 void hci_conn_check_pending(struct hci_dev *hdev)
554 {
555 struct hci_conn *conn;
556
557 BT_DBG("hdev %s", hdev->name);
558
559 hci_dev_lock(hdev);
560
561 conn = hci_conn_hash_lookup_state(hdev, ACL_LINK, BT_CONNECT2);
562 if (conn)
563 hci_acl_connect(conn);
564
565 hci_dev_unlock(hdev);
566 }
567
568 int hci_get_conn_list(void __user *arg)
569 {
570 struct hci_conn_list_req req, *cl;
571 struct hci_conn_info *ci;
572 struct hci_dev *hdev;
573 struct list_head *p;
574 int n = 0, size, err;
575
576 if (copy_from_user(&req, arg, sizeof(req)))
577 return -EFAULT;
578
579 if (!req.conn_num || req.conn_num > (PAGE_SIZE * 2) / sizeof(*ci))
580 return -EINVAL;
581
582 size = sizeof(req) + req.conn_num * sizeof(*ci);
583
584 if (!(cl = kmalloc(size, GFP_KERNEL)))
585 return -ENOMEM;
586
587 if (!(hdev = hci_dev_get(req.dev_id))) {
588 kfree(cl);
589 return -ENODEV;
590 }
591
592 ci = cl->conn_info;
593
594 hci_dev_lock_bh(hdev);
595 list_for_each(p, &hdev->conn_hash.list) {
596 register struct hci_conn *c;
597 c = list_entry(p, struct hci_conn, list);
598
599 bacpy(&(ci + n)->bdaddr, &c->dst);
600 (ci + n)->handle = c->handle;
601 (ci + n)->type = c->type;
602 (ci + n)->out = c->out;
603 (ci + n)->state = c->state;
604 (ci + n)->link_mode = c->link_mode;
605 if (++n >= req.conn_num)
606 break;
607 }
608 hci_dev_unlock_bh(hdev);
609
610 cl->dev_id = hdev->id;
611 cl->conn_num = n;
612 size = sizeof(req) + n * sizeof(*ci);
613
614 hci_dev_put(hdev);
615
616 err = copy_to_user(arg, cl, size);
617 kfree(cl);
618
619 return err ? -EFAULT : 0;
620 }
621
622 int hci_get_conn_info(struct hci_dev *hdev, void __user *arg)
623 {
624 struct hci_conn_info_req req;
625 struct hci_conn_info ci;
626 struct hci_conn *conn;
627 char __user *ptr = arg + sizeof(req);
628
629 if (copy_from_user(&req, arg, sizeof(req)))
630 return -EFAULT;
631
632 hci_dev_lock_bh(hdev);
633 conn = hci_conn_hash_lookup_ba(hdev, req.type, &req.bdaddr);
634 if (conn) {
635 bacpy(&ci.bdaddr, &conn->dst);
636 ci.handle = conn->handle;
637 ci.type = conn->type;
638 ci.out = conn->out;
639 ci.state = conn->state;
640 ci.link_mode = conn->link_mode;
641 }
642 hci_dev_unlock_bh(hdev);
643
644 if (!conn)
645 return -ENOENT;
646
647 return copy_to_user(ptr, &ci, sizeof(ci)) ? -EFAULT : 0;
648 }
649
650 int hci_get_auth_info(struct hci_dev *hdev, void __user *arg)
651 {
652 struct hci_auth_info_req req;
653 struct hci_conn *conn;
654
655 if (copy_from_user(&req, arg, sizeof(req)))
656 return -EFAULT;
657
658 hci_dev_lock_bh(hdev);
659 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &req.bdaddr);
660 if (conn)
661 req.type = conn->auth_type;
662 hci_dev_unlock_bh(hdev);
663
664 if (!conn)
665 return -ENOENT;
666
667 return copy_to_user(arg, &req, sizeof(req)) ? -EFAULT : 0;
668 }
This page took 0.113523 seconds and 6 git commands to generate.