blob: bcd158f40bb9e4d7a7fa5c167c1281779d60847d [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
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
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 connection handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28
29#include <linux/types.h>
30#include <linux/errno.h>
31#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#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>
Andrei Emeltchenko70f230202010-12-01 16:58:25 +020042#include <linux/uaccess.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070043#include <asm/unaligned.h>
44
45#include <net/bluetooth/bluetooth.h>
46#include <net/bluetooth/hci_core.h>
47
Ville Tervofcd89c02011-02-10 22:38:47 -030048static void hci_le_connect(struct hci_conn *conn)
49{
50 struct hci_dev *hdev = conn->hdev;
51 struct hci_cp_le_create_conn cp;
52
53 conn->state = BT_CONNECT;
54 conn->out = 1;
Vinicius Costa Gomesb92a6222011-02-10 22:38:52 -030055 conn->link_mode |= HCI_LM_MASTER;
Ville Tervofcd89c02011-02-10 22:38:47 -030056
57 memset(&cp, 0, sizeof(cp));
58 cp.scan_interval = cpu_to_le16(0x0004);
59 cp.scan_window = cpu_to_le16(0x0004);
60 bacpy(&cp.peer_addr, &conn->dst);
61 cp.conn_interval_min = cpu_to_le16(0x0008);
62 cp.conn_interval_max = cpu_to_le16(0x0100);
63 cp.supervision_timeout = cpu_to_le16(0x0064);
64 cp.min_ce_len = cpu_to_le16(0x0001);
65 cp.max_ce_len = cpu_to_le16(0x0001);
66
67 hci_send_cmd(hdev, HCI_OP_LE_CREATE_CONN, sizeof(cp), &cp);
68}
69
70static void hci_le_connect_cancel(struct hci_conn *conn)
71{
72 hci_send_cmd(conn->hdev, HCI_OP_LE_CREATE_CONN_CANCEL, 0, NULL);
73}
74
Marcel Holtmann4c67bc72006-10-15 17:30:56 +020075void hci_acl_connect(struct hci_conn *conn)
Linus Torvalds1da177e2005-04-16 15:20:36 -070076{
77 struct hci_dev *hdev = conn->hdev;
78 struct inquiry_entry *ie;
79 struct hci_cp_create_conn cp;
80
81 BT_DBG("%p", conn);
82
83 conn->state = BT_CONNECT;
Marcel Holtmanna8746412008-07-14 20:13:46 +020084 conn->out = 1;
85
Linus Torvalds1da177e2005-04-16 15:20:36 -070086 conn->link_mode = HCI_LM_MASTER;
87
Marcel Holtmann4c67bc72006-10-15 17:30:56 +020088 conn->attempt++;
89
Marcel Holtmanne4e8e372008-07-14 20:13:47 +020090 conn->link_policy = hdev->link_policy;
91
Linus Torvalds1da177e2005-04-16 15:20:36 -070092 memset(&cp, 0, sizeof(cp));
93 bacpy(&cp.bdaddr, &conn->dst);
94 cp.pscan_rep_mode = 0x02;
95
Andrei Emeltchenko70f230202010-12-01 16:58:25 +020096 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
97 if (ie) {
Marcel Holtmann41a96212008-07-14 20:13:48 +020098 if (inquiry_entry_age(ie) <= INQUIRY_ENTRY_AGE_MAX) {
99 cp.pscan_rep_mode = ie->data.pscan_rep_mode;
100 cp.pscan_mode = ie->data.pscan_mode;
101 cp.clock_offset = ie->data.clock_offset |
102 cpu_to_le16(0x8000);
103 }
104
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105 memcpy(conn->dev_class, ie->data.dev_class, 3);
Marcel Holtmann41a96212008-07-14 20:13:48 +0200106 conn->ssp_mode = ie->data.ssp_mode;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 }
108
Marcel Holtmanna8746412008-07-14 20:13:46 +0200109 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 if (lmp_rswitch_capable(hdev) && !(hdev->link_mode & HCI_LM_MASTER))
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200111 cp.role_switch = 0x01;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700112 else
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200113 cp.role_switch = 0x00;
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200114
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200115 hci_send_cmd(hdev, HCI_OP_CREATE_CONN, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116}
117
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200118static void hci_acl_connect_cancel(struct hci_conn *conn)
119{
120 struct hci_cp_create_conn_cancel cp;
121
122 BT_DBG("%p", conn);
123
124 if (conn->hdev->hci_ver < 2)
125 return;
126
127 bacpy(&cp.bdaddr, &conn->dst);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200128 hci_send_cmd(conn->hdev, HCI_OP_CREATE_CONN_CANCEL, sizeof(cp), &cp);
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200129}
130
Linus Torvalds1da177e2005-04-16 15:20:36 -0700131void hci_acl_disconn(struct hci_conn *conn, __u8 reason)
132{
133 struct hci_cp_disconnect cp;
134
135 BT_DBG("%p", conn);
136
137 conn->state = BT_DISCONN;
138
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700139 cp.handle = cpu_to_le16(conn->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 cp.reason = reason;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200141 hci_send_cmd(conn->hdev, HCI_OP_DISCONNECT, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700142}
143
144void hci_add_sco(struct hci_conn *conn, __u16 handle)
145{
146 struct hci_dev *hdev = conn->hdev;
147 struct hci_cp_add_sco cp;
148
149 BT_DBG("%p", conn);
150
151 conn->state = BT_CONNECT;
152 conn->out = 1;
153
Marcel Holtmannefc76882009-02-06 09:13:37 +0100154 conn->attempt++;
155
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700156 cp.handle = cpu_to_le16(handle);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200157 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200159 hci_send_cmd(hdev, HCI_OP_ADD_SCO, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700160}
161
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200162void hci_setup_sync(struct hci_conn *conn, __u16 handle)
163{
164 struct hci_dev *hdev = conn->hdev;
165 struct hci_cp_setup_sync_conn cp;
166
167 BT_DBG("%p", conn);
168
169 conn->state = BT_CONNECT;
170 conn->out = 1;
171
Marcel Holtmannefc76882009-02-06 09:13:37 +0100172 conn->attempt++;
173
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200174 cp.handle = cpu_to_le16(handle);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200175 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200176
177 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
178 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
179 cp.max_latency = cpu_to_le16(0xffff);
180 cp.voice_setting = cpu_to_le16(hdev->voice_setting);
181 cp.retrans_effort = 0xff;
182
183 hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp);
184}
185
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200186void hci_le_conn_update(struct hci_conn *conn, u16 min, u16 max,
187 u16 latency, u16 to_multiplier)
188{
189 struct hci_cp_le_conn_update cp;
190 struct hci_dev *hdev = conn->hdev;
191
192 memset(&cp, 0, sizeof(cp));
193
194 cp.handle = cpu_to_le16(conn->handle);
195 cp.conn_interval_min = cpu_to_le16(min);
196 cp.conn_interval_max = cpu_to_le16(max);
197 cp.conn_latency = cpu_to_le16(latency);
198 cp.supervision_timeout = cpu_to_le16(to_multiplier);
199 cp.min_ce_len = cpu_to_le16(0x0001);
200 cp.max_ce_len = cpu_to_le16(0x0001);
201
202 hci_send_cmd(hdev, HCI_OP_LE_CONN_UPDATE, sizeof(cp), &cp);
203}
204EXPORT_SYMBOL(hci_le_conn_update);
205
Marcel Holtmanne73439d2010-07-26 10:06:00 -0400206/* Device _must_ be locked */
207void hci_sco_setup(struct hci_conn *conn, __u8 status)
208{
209 struct hci_conn *sco = conn->link;
210
211 BT_DBG("%p", conn);
212
213 if (!sco)
214 return;
215
216 if (!status) {
217 if (lmp_esco_capable(conn->hdev))
218 hci_setup_sync(sco, conn->handle);
219 else
220 hci_add_sco(sco, conn->handle);
221 } else {
222 hci_proto_connect_cfm(sco, status);
223 hci_conn_del(sco);
224 }
225}
226
Linus Torvalds1da177e2005-04-16 15:20:36 -0700227static void hci_conn_timeout(unsigned long arg)
228{
Marcel Holtmann04837f62006-07-03 10:02:33 +0200229 struct hci_conn *conn = (void *) arg;
230 struct hci_dev *hdev = conn->hdev;
Marcel Holtmann2950f212009-02-12 14:02:50 +0100231 __u8 reason;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232
233 BT_DBG("conn %p state %d", conn, conn->state);
234
235 if (atomic_read(&conn->refcnt))
236 return;
237
238 hci_dev_lock(hdev);
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200239
240 switch (conn->state) {
241 case BT_CONNECT:
Marcel Holtmann769be972008-07-14 20:13:49 +0200242 case BT_CONNECT2:
Ville Tervofcd89c02011-02-10 22:38:47 -0300243 if (conn->out) {
244 if (conn->type == ACL_LINK)
245 hci_acl_connect_cancel(conn);
246 else if (conn->type == LE_LINK)
247 hci_le_connect_cancel(conn);
248 }
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200249 break;
Marcel Holtmann769be972008-07-14 20:13:49 +0200250 case BT_CONFIG:
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900251 case BT_CONNECTED:
Marcel Holtmann2950f212009-02-12 14:02:50 +0100252 reason = hci_proto_disconn_ind(conn);
253 hci_acl_disconn(conn, reason);
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200254 break;
255 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 conn->state = BT_CLOSED;
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200257 break;
258 }
259
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261}
262
Marcel Holtmann04837f62006-07-03 10:02:33 +0200263static void hci_conn_idle(unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264{
Marcel Holtmann04837f62006-07-03 10:02:33 +0200265 struct hci_conn *conn = (void *) arg;
266
267 BT_DBG("conn %p mode %d", conn, conn->mode);
268
269 hci_conn_enter_sniff_mode(conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270}
271
Johan Hedberg9f616562011-04-28 11:28:54 -0700272static void hci_conn_auto_accept(unsigned long arg)
273{
274 struct hci_conn *conn = (void *) arg;
275 struct hci_dev *hdev = conn->hdev;
276
277 hci_dev_lock(hdev);
278
279 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY, sizeof(conn->dst),
280 &conn->dst);
281
282 hci_dev_unlock(hdev);
283}
284
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285struct hci_conn *hci_conn_add(struct hci_dev *hdev, int type, bdaddr_t *dst)
286{
287 struct hci_conn *conn;
288
289 BT_DBG("%s dst %s", hdev->name, batostr(dst));
290
Marcel Holtmann04837f62006-07-03 10:02:33 +0200291 conn = kzalloc(sizeof(struct hci_conn), GFP_ATOMIC);
292 if (!conn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294
295 bacpy(&conn->dst, dst);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200296 conn->hdev = hdev;
297 conn->type = type;
298 conn->mode = HCI_CM_ACTIVE;
299 conn->state = BT_OPEN;
Andrei Emeltchenko93f19c92009-09-03 12:34:19 +0300300 conn->auth_type = HCI_AT_GENERAL_BONDING;
Johan Hedberg17fa4b92011-01-25 13:28:33 +0200301 conn->io_capability = hdev->io_capability;
Johan Hedberga9583552011-02-19 12:06:01 -0300302 conn->remote_auth = 0xff;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200303 conn->key_type = 0xff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304
Marcel Holtmann04837f62006-07-03 10:02:33 +0200305 conn->power_save = 1;
Marcel Holtmann052b30b2009-04-26 20:01:22 +0200306 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann04837f62006-07-03 10:02:33 +0200307
Marcel Holtmanna8746412008-07-14 20:13:46 +0200308 switch (type) {
309 case ACL_LINK:
310 conn->pkt_type = hdev->pkt_type & ACL_PTYPE_MASK;
311 break;
312 case SCO_LINK:
313 if (lmp_esco_capable(hdev))
Marcel Holtmannefc76882009-02-06 09:13:37 +0100314 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
315 (hdev->esco_type & EDR_ESCO_MASK);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200316 else
317 conn->pkt_type = hdev->pkt_type & SCO_PTYPE_MASK;
318 break;
319 case ESCO_LINK:
Marcel Holtmannefc76882009-02-06 09:13:37 +0100320 conn->pkt_type = hdev->esco_type & ~EDR_ESCO_MASK;
Marcel Holtmanna8746412008-07-14 20:13:46 +0200321 break;
322 }
323
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324 skb_queue_head_init(&conn->data_q);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200325
Pavel Emelyanovb24b8a22008-01-23 21:20:07 -0800326 setup_timer(&conn->disc_timer, hci_conn_timeout, (unsigned long)conn);
327 setup_timer(&conn->idle_timer, hci_conn_idle, (unsigned long)conn);
Johan Hedberg9f616562011-04-28 11:28:54 -0700328 setup_timer(&conn->auto_accept_timer, hci_conn_auto_accept,
329 (unsigned long) conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330
331 atomic_set(&conn->refcnt, 0);
332
333 hci_dev_hold(hdev);
334
335 tasklet_disable(&hdev->tx_task);
336
337 hci_conn_hash_add(hdev, conn);
338 if (hdev->notify)
339 hdev->notify(hdev, HCI_NOTIFY_CONN_ADD);
340
Marcel Holtmann9eba32b2009-08-22 14:19:26 -0700341 atomic_set(&conn->devref, 0);
342
Marcel Holtmanna67e8992009-05-02 18:24:06 -0700343 hci_conn_init_sysfs(conn);
344
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 tasklet_enable(&hdev->tx_task);
346
347 return conn;
348}
349
350int hci_conn_del(struct hci_conn *conn)
351{
352 struct hci_dev *hdev = conn->hdev;
353
354 BT_DBG("%s conn %p handle %d", hdev->name, conn, conn->handle);
355
Marcel Holtmann04837f62006-07-03 10:02:33 +0200356 del_timer(&conn->idle_timer);
357
358 del_timer(&conn->disc_timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359
Johan Hedberg9f616562011-04-28 11:28:54 -0700360 del_timer(&conn->auto_accept_timer);
361
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200362 if (conn->type == ACL_LINK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 struct hci_conn *sco = conn->link;
364 if (sco)
365 sco->link = NULL;
366
367 /* Unacked frames */
368 hdev->acl_cnt += conn->sent;
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300369 } else if (conn->type == LE_LINK) {
370 if (hdev->le_pkts)
371 hdev->le_cnt += conn->sent;
372 else
373 hdev->acl_cnt += conn->sent;
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200374 } else {
375 struct hci_conn *acl = conn->link;
376 if (acl) {
377 acl->link = NULL;
378 hci_conn_put(acl);
379 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 }
381
382 tasklet_disable(&hdev->tx_task);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +0200383
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 hci_conn_hash_del(hdev, conn);
385 if (hdev->notify)
386 hdev->notify(hdev, HCI_NOTIFY_CONN_DEL);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +0200387
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388 tasklet_enable(&hdev->tx_task);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +0200389
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 skb_queue_purge(&conn->data_q);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391
Marcel Holtmann9eba32b2009-08-22 14:19:26 -0700392 hci_conn_put_device(conn);
Dave Young2ae9a6b2009-02-21 16:13:34 +0800393
Marcel Holtmann384943e2009-05-08 18:20:43 -0700394 hci_dev_put(hdev);
395
Tomas Targownik163f4da2011-06-30 16:30:44 -0300396 if (conn->handle == 0)
397 kfree(conn);
398
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399 return 0;
400}
401
402struct hci_dev *hci_get_route(bdaddr_t *dst, bdaddr_t *src)
403{
404 int use_src = bacmp(src, BDADDR_ANY);
405 struct hci_dev *hdev = NULL;
406 struct list_head *p;
407
408 BT_DBG("%s -> %s", batostr(src), batostr(dst));
409
410 read_lock_bh(&hci_dev_list_lock);
411
412 list_for_each(p, &hci_dev_list) {
413 struct hci_dev *d = list_entry(p, struct hci_dev, list);
414
415 if (!test_bit(HCI_UP, &d->flags) || test_bit(HCI_RAW, &d->flags))
416 continue;
417
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900418 /* Simple routing:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 * No source address - find interface with bdaddr != dst
420 * Source address - find interface with bdaddr == src
421 */
422
423 if (use_src) {
424 if (!bacmp(&d->bdaddr, src)) {
425 hdev = d; break;
426 }
427 } else {
428 if (bacmp(&d->bdaddr, dst)) {
429 hdev = d; break;
430 }
431 }
432 }
433
434 if (hdev)
435 hdev = hci_dev_hold(hdev);
436
437 read_unlock_bh(&hci_dev_list_lock);
438 return hdev;
439}
440EXPORT_SYMBOL(hci_get_route);
441
Ville Tervofcd89c02011-02-10 22:38:47 -0300442/* Create SCO, ACL or LE connection.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 * Device _must_ be locked */
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100444struct hci_conn *hci_connect(struct hci_dev *hdev, int type, bdaddr_t *dst, __u8 sec_level, __u8 auth_type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445{
446 struct hci_conn *acl;
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200447 struct hci_conn *sco;
Ville Tervofcd89c02011-02-10 22:38:47 -0300448 struct hci_conn *le;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449
450 BT_DBG("%s dst %s", hdev->name, batostr(dst));
451
Ville Tervofcd89c02011-02-10 22:38:47 -0300452 if (type == LE_LINK) {
453 le = hci_conn_hash_lookup_ba(hdev, LE_LINK, dst);
Anderson Briglia15c47942011-02-21 15:09:23 -0300454 if (le)
Ville Tervo30e76272011-02-22 16:10:53 -0300455 return ERR_PTR(-EBUSY);
Anderson Briglia15c47942011-02-21 15:09:23 -0300456 le = hci_conn_add(hdev, LE_LINK, dst);
Ville Tervofcd89c02011-02-10 22:38:47 -0300457 if (!le)
Ville Tervo30e76272011-02-22 16:10:53 -0300458 return ERR_PTR(-ENOMEM);
Ville Tervofcd89c02011-02-10 22:38:47 -0300459 if (le->state == BT_OPEN)
460 hci_le_connect(le);
461
462 hci_conn_hold(le);
463
464 return le;
465 }
466
Andrei Emeltchenko70f230202010-12-01 16:58:25 +0200467 acl = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst);
468 if (!acl) {
469 acl = hci_conn_add(hdev, ACL_LINK, dst);
470 if (!acl)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 return NULL;
472 }
473
474 hci_conn_hold(acl);
475
Marcel Holtmann09ab6f42008-09-09 07:19:20 +0200476 if (acl->state == BT_OPEN || acl->state == BT_CLOSED) {
Johan Hedberg765c2a92011-01-19 12:06:52 +0530477 acl->sec_level = BT_SECURITY_LOW;
478 acl->pending_sec_level = sec_level;
Marcel Holtmann09ab6f42008-09-09 07:19:20 +0200479 acl->auth_type = auth_type;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480 hci_acl_connect(acl);
Marcel Holtmann09ab6f42008-09-09 07:19:20 +0200481 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200483 if (type == ACL_LINK)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 return acl;
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200485
Andrei Emeltchenko70f230202010-12-01 16:58:25 +0200486 sco = hci_conn_hash_lookup_ba(hdev, type, dst);
487 if (!sco) {
488 sco = hci_conn_add(hdev, type, dst);
489 if (!sco) {
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200490 hci_conn_put(acl);
491 return NULL;
492 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200494
495 acl->link = sco;
496 sco->link = acl;
497
498 hci_conn_hold(sco);
499
500 if (acl->state == BT_CONNECTED &&
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200501 (sco->state == BT_OPEN || sco->state == BT_CLOSED)) {
Nick Pellyc3902162009-11-13 14:16:32 -0800502 acl->power_save = 1;
503 hci_conn_enter_active_mode(acl);
504
Marcel Holtmanne73439d2010-07-26 10:06:00 -0400505 if (test_bit(HCI_CONN_MODE_CHANGE_PEND, &acl->pend)) {
506 /* defer SCO setup until mode change completed */
507 set_bit(HCI_CONN_SCO_SETUP_PEND, &acl->pend);
508 return sco;
509 }
510
511 hci_sco_setup(acl, 0x00);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200512 }
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200513
514 return sco;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700515}
516EXPORT_SYMBOL(hci_connect);
517
Marcel Holtmanne7c29cb2008-09-09 07:19:20 +0200518/* Check link security requirement */
519int hci_conn_check_link_mode(struct hci_conn *conn)
520{
521 BT_DBG("conn %p", conn);
522
523 if (conn->ssp_mode > 0 && conn->hdev->ssp_mode > 0 &&
524 !(conn->link_mode & HCI_LM_ENCRYPT))
525 return 0;
526
527 return 1;
528}
529EXPORT_SYMBOL(hci_conn_check_link_mode);
530
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531/* Authenticate remote device */
Marcel Holtmann0684e5f2009-02-09 02:48:38 +0100532static int hci_conn_auth(struct hci_conn *conn, __u8 sec_level, __u8 auth_type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533{
534 BT_DBG("conn %p", conn);
535
Johan Hedberg765c2a92011-01-19 12:06:52 +0530536 if (conn->pending_sec_level > sec_level)
537 sec_level = conn->pending_sec_level;
538
Marcel Holtmann96a31832009-02-12 16:23:03 +0100539 if (sec_level > conn->sec_level)
Johan Hedberg765c2a92011-01-19 12:06:52 +0530540 conn->pending_sec_level = sec_level;
Marcel Holtmann96a31832009-02-12 16:23:03 +0100541 else if (conn->link_mode & HCI_LM_AUTH)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 return 1;
543
Johan Hedberg65cf6862011-01-19 12:06:49 +0530544 /* Make sure we preserve an existing MITM requirement*/
545 auth_type |= (conn->auth_type & 0x01);
546
Marcel Holtmann96a31832009-02-12 16:23:03 +0100547 conn->auth_type = auth_type;
548
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
550 struct hci_cp_auth_requested cp;
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700551 cp.handle = cpu_to_le16(conn->handle);
Marcel Holtmann40be4922008-07-14 20:13:50 +0200552 hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
553 sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700554 }
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100555
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 return 0;
557}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200559/* Encrypt the the link */
560static void hci_conn_encrypt(struct hci_conn *conn)
561{
562 BT_DBG("conn %p", conn);
563
564 if (!test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
565 struct hci_cp_set_conn_encrypt cp;
566 cp.handle = cpu_to_le16(conn->handle);
567 cp.encrypt = 0x01;
568 hci_send_cmd(conn->hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
569 &cp);
570 }
571}
572
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100573/* Enable security */
Marcel Holtmann0684e5f2009-02-09 02:48:38 +0100574int hci_conn_security(struct hci_conn *conn, __u8 sec_level, __u8 auth_type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575{
576 BT_DBG("conn %p", conn);
577
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200578 /* For sdp we don't need the link key. */
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100579 if (sec_level == BT_SECURITY_SDP)
580 return 1;
581
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200582 /* For non 2.1 devices and low security level we don't need the link
583 key. */
Marcel Holtmann3fdca1e2009-04-28 09:04:55 -0700584 if (sec_level == BT_SECURITY_LOW &&
585 (!conn->ssp_mode || !conn->hdev->ssp_mode))
586 return 1;
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100587
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200588 /* For other security levels we need the link key. */
589 if (!(conn->link_mode & HCI_LM_AUTH))
590 goto auth;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200592 /* An authenticated combination key has sufficient security for any
593 security level. */
594 if (conn->key_type == HCI_LK_AUTH_COMBINATION)
595 goto encrypt;
596
597 /* An unauthenticated combination key has sufficient security for
598 security level 1 and 2. */
599 if (conn->key_type == HCI_LK_UNAUTH_COMBINATION &&
600 (sec_level == BT_SECURITY_MEDIUM ||
601 sec_level == BT_SECURITY_LOW))
602 goto encrypt;
603
604 /* A combination key has always sufficient security for the security
605 levels 1 or 2. High security level requires the combination key
606 is generated using maximum PIN code length (16).
607 For pre 2.1 units. */
608 if (conn->key_type == HCI_LK_COMBINATION &&
609 (sec_level != BT_SECURITY_HIGH ||
610 conn->pin_length == 16))
611 goto encrypt;
612
613auth:
Ilia Kolomisnky33060542011-06-15 06:52:26 +0300614 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700615 return 0;
616
Luiz Augusto von Dentz6fdf6582011-06-13 15:37:35 +0300617 if (!hci_conn_auth(conn, sec_level, auth_type))
618 return 0;
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100619
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200620encrypt:
621 if (conn->link_mode & HCI_LM_ENCRYPT)
622 return 1;
623
624 hci_conn_encrypt(conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 return 0;
626}
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100627EXPORT_SYMBOL(hci_conn_security);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628
Waldemar Rymarkiewiczb3b1b062011-05-06 09:42:31 +0200629/* Check secure link requirement */
630int hci_conn_check_secure(struct hci_conn *conn, __u8 sec_level)
631{
632 BT_DBG("conn %p", conn);
633
634 if (sec_level != BT_SECURITY_HIGH)
635 return 1; /* Accept if non-secure is required */
636
637 if (conn->key_type == HCI_LK_AUTH_COMBINATION ||
638 (conn->key_type == HCI_LK_COMBINATION &&
639 conn->pin_length == 16))
640 return 1;
641
642 return 0; /* Reject not secure link */
643}
644EXPORT_SYMBOL(hci_conn_check_secure);
645
Linus Torvalds1da177e2005-04-16 15:20:36 -0700646/* Change link key */
647int hci_conn_change_link_key(struct hci_conn *conn)
648{
649 BT_DBG("conn %p", conn);
650
651 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
652 struct hci_cp_change_conn_link_key cp;
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700653 cp.handle = cpu_to_le16(conn->handle);
Marcel Holtmann40be4922008-07-14 20:13:50 +0200654 hci_send_cmd(conn->hdev, HCI_OP_CHANGE_CONN_LINK_KEY,
655 sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 }
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100657
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 return 0;
659}
660EXPORT_SYMBOL(hci_conn_change_link_key);
661
662/* Switch role */
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100663int hci_conn_switch_role(struct hci_conn *conn, __u8 role)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664{
665 BT_DBG("conn %p", conn);
666
667 if (!role && conn->link_mode & HCI_LM_MASTER)
668 return 1;
669
670 if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND, &conn->pend)) {
671 struct hci_cp_switch_role cp;
672 bacpy(&cp.bdaddr, &conn->dst);
673 cp.role = role;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200674 hci_send_cmd(conn->hdev, HCI_OP_SWITCH_ROLE, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700675 }
Marcel Holtmann8c1b2352009-01-15 21:58:04 +0100676
Linus Torvalds1da177e2005-04-16 15:20:36 -0700677 return 0;
678}
679EXPORT_SYMBOL(hci_conn_switch_role);
680
Marcel Holtmann04837f62006-07-03 10:02:33 +0200681/* Enter active mode */
682void hci_conn_enter_active_mode(struct hci_conn *conn)
683{
684 struct hci_dev *hdev = conn->hdev;
685
686 BT_DBG("conn %p mode %d", conn, conn->mode);
687
688 if (test_bit(HCI_RAW, &hdev->flags))
689 return;
690
691 if (conn->mode != HCI_CM_SNIFF || !conn->power_save)
692 goto timer;
693
694 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
695 struct hci_cp_exit_sniff_mode cp;
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700696 cp.handle = cpu_to_le16(conn->handle);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200697 hci_send_cmd(hdev, HCI_OP_EXIT_SNIFF_MODE, sizeof(cp), &cp);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200698 }
699
700timer:
701 if (hdev->idle_timeout > 0)
702 mod_timer(&conn->idle_timer,
703 jiffies + msecs_to_jiffies(hdev->idle_timeout));
704}
705
706/* Enter sniff mode */
707void hci_conn_enter_sniff_mode(struct hci_conn *conn)
708{
709 struct hci_dev *hdev = conn->hdev;
710
711 BT_DBG("conn %p mode %d", conn, conn->mode);
712
713 if (test_bit(HCI_RAW, &hdev->flags))
714 return;
715
716 if (!lmp_sniff_capable(hdev) || !lmp_sniff_capable(conn))
717 return;
718
719 if (conn->mode != HCI_CM_ACTIVE || !(conn->link_policy & HCI_LP_SNIFF))
720 return;
721
722 if (lmp_sniffsubr_capable(hdev) && lmp_sniffsubr_capable(conn)) {
723 struct hci_cp_sniff_subrate cp;
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700724 cp.handle = cpu_to_le16(conn->handle);
725 cp.max_latency = cpu_to_le16(0);
726 cp.min_remote_timeout = cpu_to_le16(0);
727 cp.min_local_timeout = cpu_to_le16(0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200728 hci_send_cmd(hdev, HCI_OP_SNIFF_SUBRATE, sizeof(cp), &cp);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200729 }
730
731 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
732 struct hci_cp_sniff_mode cp;
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700733 cp.handle = cpu_to_le16(conn->handle);
734 cp.max_interval = cpu_to_le16(hdev->sniff_max_interval);
735 cp.min_interval = cpu_to_le16(hdev->sniff_min_interval);
736 cp.attempt = cpu_to_le16(4);
737 cp.timeout = cpu_to_le16(1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200738 hci_send_cmd(hdev, HCI_OP_SNIFF_MODE, sizeof(cp), &cp);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200739 }
740}
741
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742/* Drop all connection on the device */
743void hci_conn_hash_flush(struct hci_dev *hdev)
744{
745 struct hci_conn_hash *h = &hdev->conn_hash;
746 struct list_head *p;
747
748 BT_DBG("hdev %s", hdev->name);
749
750 p = h->list.next;
751 while (p != &h->list) {
752 struct hci_conn *c;
753
754 c = list_entry(p, struct hci_conn, list);
755 p = p->next;
756
757 c->state = BT_CLOSED;
758
Marcel Holtmann2950f212009-02-12 14:02:50 +0100759 hci_proto_disconn_cfm(c, 0x16);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700760 hci_conn_del(c);
761 }
762}
763
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200764/* Check pending connect attempts */
765void hci_conn_check_pending(struct hci_dev *hdev)
766{
767 struct hci_conn *conn;
768
769 BT_DBG("hdev %s", hdev->name);
770
771 hci_dev_lock(hdev);
772
773 conn = hci_conn_hash_lookup_state(hdev, ACL_LINK, BT_CONNECT2);
774 if (conn)
775 hci_acl_connect(conn);
776
777 hci_dev_unlock(hdev);
778}
779
Marcel Holtmann9eba32b2009-08-22 14:19:26 -0700780void hci_conn_hold_device(struct hci_conn *conn)
781{
782 atomic_inc(&conn->devref);
783}
784EXPORT_SYMBOL(hci_conn_hold_device);
785
786void hci_conn_put_device(struct hci_conn *conn)
787{
788 if (atomic_dec_and_test(&conn->devref))
789 hci_conn_del_sysfs(conn);
790}
791EXPORT_SYMBOL(hci_conn_put_device);
792
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793int hci_get_conn_list(void __user *arg)
794{
795 struct hci_conn_list_req req, *cl;
796 struct hci_conn_info *ci;
797 struct hci_dev *hdev;
798 struct list_head *p;
799 int n = 0, size, err;
800
801 if (copy_from_user(&req, arg, sizeof(req)))
802 return -EFAULT;
803
804 if (!req.conn_num || req.conn_num > (PAGE_SIZE * 2) / sizeof(*ci))
805 return -EINVAL;
806
807 size = sizeof(req) + req.conn_num * sizeof(*ci);
808
Andrei Emeltchenko70f230202010-12-01 16:58:25 +0200809 cl = kmalloc(size, GFP_KERNEL);
810 if (!cl)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 return -ENOMEM;
812
Andrei Emeltchenko70f230202010-12-01 16:58:25 +0200813 hdev = hci_dev_get(req.dev_id);
814 if (!hdev) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815 kfree(cl);
816 return -ENODEV;
817 }
818
819 ci = cl->conn_info;
820
821 hci_dev_lock_bh(hdev);
822 list_for_each(p, &hdev->conn_hash.list) {
823 register struct hci_conn *c;
824 c = list_entry(p, struct hci_conn, list);
825
826 bacpy(&(ci + n)->bdaddr, &c->dst);
827 (ci + n)->handle = c->handle;
828 (ci + n)->type = c->type;
829 (ci + n)->out = c->out;
830 (ci + n)->state = c->state;
831 (ci + n)->link_mode = c->link_mode;
832 if (++n >= req.conn_num)
833 break;
834 }
835 hci_dev_unlock_bh(hdev);
836
837 cl->dev_id = hdev->id;
838 cl->conn_num = n;
839 size = sizeof(req) + n * sizeof(*ci);
840
841 hci_dev_put(hdev);
842
843 err = copy_to_user(arg, cl, size);
844 kfree(cl);
845
846 return err ? -EFAULT : 0;
847}
848
849int hci_get_conn_info(struct hci_dev *hdev, void __user *arg)
850{
851 struct hci_conn_info_req req;
852 struct hci_conn_info ci;
853 struct hci_conn *conn;
854 char __user *ptr = arg + sizeof(req);
855
856 if (copy_from_user(&req, arg, sizeof(req)))
857 return -EFAULT;
858
859 hci_dev_lock_bh(hdev);
860 conn = hci_conn_hash_lookup_ba(hdev, req.type, &req.bdaddr);
861 if (conn) {
862 bacpy(&ci.bdaddr, &conn->dst);
863 ci.handle = conn->handle;
864 ci.type = conn->type;
865 ci.out = conn->out;
866 ci.state = conn->state;
867 ci.link_mode = conn->link_mode;
868 }
869 hci_dev_unlock_bh(hdev);
870
871 if (!conn)
872 return -ENOENT;
873
874 return copy_to_user(ptr, &ci, sizeof(ci)) ? -EFAULT : 0;
875}
Marcel Holtmann40be4922008-07-14 20:13:50 +0200876
877int hci_get_auth_info(struct hci_dev *hdev, void __user *arg)
878{
879 struct hci_auth_info_req req;
880 struct hci_conn *conn;
881
882 if (copy_from_user(&req, arg, sizeof(req)))
883 return -EFAULT;
884
885 hci_dev_lock_bh(hdev);
886 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &req.bdaddr);
887 if (conn)
888 req.type = conn->auth_type;
889 hci_dev_unlock_bh(hdev);
890
891 if (!conn)
892 return -ENOENT;
893
894 return copy_to_user(arg, &req, sizeof(req)) ? -EFAULT : 0;
895}