2 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
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;
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.
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.
25 /* Bluetooth HCI connection handling. */
27 #include <linux/export.h>
28 #include <linux/debugfs.h>
30 #include <net/bluetooth/bluetooth.h>
31 #include <net/bluetooth/hci_core.h>
32 #include <net/bluetooth/l2cap.h>
34 #include "hci_request.h"
44 static const struct sco_param esco_param_cvsd[] = {
45 { EDR_ESCO_MASK & ~ESCO_2EV3, 0x000a, 0x01 }, /* S3 */
46 { EDR_ESCO_MASK & ~ESCO_2EV3, 0x0007, 0x01 }, /* S2 */
47 { EDR_ESCO_MASK | ESCO_EV3, 0x0007, 0x01 }, /* S1 */
48 { EDR_ESCO_MASK | ESCO_HV3, 0xffff, 0x01 }, /* D1 */
49 { EDR_ESCO_MASK | ESCO_HV1, 0xffff, 0x01 }, /* D0 */
52 static const struct sco_param sco_param_cvsd[] = {
53 { EDR_ESCO_MASK | ESCO_HV3, 0xffff, 0xff }, /* D1 */
54 { EDR_ESCO_MASK | ESCO_HV1, 0xffff, 0xff }, /* D0 */
57 static const struct sco_param esco_param_msbc[] = {
58 { EDR_ESCO_MASK & ~ESCO_2EV3, 0x000d, 0x02 }, /* T2 */
59 { EDR_ESCO_MASK | ESCO_EV3, 0x0008, 0x02 }, /* T1 */
62 /* This function requires the caller holds hdev->lock */
63 static void hci_connect_le_scan_cleanup(struct hci_conn *conn)
65 struct hci_conn_params *params;
66 struct hci_dev *hdev = conn->hdev;
72 bdaddr_type = conn->dst_type;
74 /* Check if we need to convert to identity address */
75 irk = hci_get_irk(hdev, bdaddr, bdaddr_type);
77 bdaddr = &irk->bdaddr;
78 bdaddr_type = irk->addr_type;
81 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, bdaddr,
83 if (!params || !params->explicit_connect)
86 /* The connection attempt was doing scan for new RPA, and is
87 * in scan phase. If params are not associated with any other
88 * autoconnect action, remove them completely. If they are, just unmark
89 * them as waiting for connection, by clearing explicit_connect field.
91 params->explicit_connect = false;
93 list_del_init(¶ms->action);
95 switch (params->auto_connect) {
96 case HCI_AUTO_CONN_EXPLICIT:
97 hci_conn_params_del(hdev, bdaddr, bdaddr_type);
98 /* return instead of break to avoid duplicate scan update */
100 case HCI_AUTO_CONN_DIRECT:
101 case HCI_AUTO_CONN_ALWAYS:
102 list_add(¶ms->action, &hdev->pend_le_conns);
104 case HCI_AUTO_CONN_REPORT:
105 list_add(¶ms->action, &hdev->pend_le_reports);
111 hci_update_background_scan(hdev);
114 static void hci_conn_cleanup(struct hci_conn *conn)
116 struct hci_dev *hdev = conn->hdev;
118 if (test_bit(HCI_CONN_PARAM_REMOVAL_PEND, &conn->flags))
119 hci_conn_params_del(conn->hdev, &conn->dst, conn->dst_type);
121 hci_chan_list_flush(conn);
123 hci_conn_hash_del(hdev, conn);
126 hdev->notify(hdev, HCI_NOTIFY_CONN_DEL);
128 hci_conn_del_sysfs(conn);
130 debugfs_remove_recursive(conn->debugfs);
137 static void le_scan_cleanup(struct work_struct *work)
139 struct hci_conn *conn = container_of(work, struct hci_conn,
141 struct hci_dev *hdev = conn->hdev;
142 struct hci_conn *c = NULL;
144 BT_DBG("%s hcon %p", hdev->name, conn);
148 /* Check that the hci_conn is still around */
150 list_for_each_entry_rcu(c, &hdev->conn_hash.list, list) {
157 hci_connect_le_scan_cleanup(conn);
158 hci_conn_cleanup(conn);
161 hci_dev_unlock(hdev);
166 static void hci_connect_le_scan_remove(struct hci_conn *conn)
168 BT_DBG("%s hcon %p", conn->hdev->name, conn);
170 /* We can't call hci_conn_del/hci_conn_cleanup here since that
171 * could deadlock with another hci_conn_del() call that's holding
172 * hci_dev_lock and doing cancel_delayed_work_sync(&conn->disc_work).
173 * Instead, grab temporary extra references to the hci_dev and
174 * hci_conn and perform the necessary cleanup in a separate work
178 hci_dev_hold(conn->hdev);
181 schedule_work(&conn->le_scan_cleanup);
184 static void hci_acl_create_connection(struct hci_conn *conn)
186 struct hci_dev *hdev = conn->hdev;
187 struct inquiry_entry *ie;
188 struct hci_cp_create_conn cp;
190 BT_DBG("hcon %p", conn);
192 conn->state = BT_CONNECT;
194 conn->role = HCI_ROLE_MASTER;
198 conn->link_policy = hdev->link_policy;
200 memset(&cp, 0, sizeof(cp));
201 bacpy(&cp.bdaddr, &conn->dst);
202 cp.pscan_rep_mode = 0x02;
204 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
206 if (inquiry_entry_age(ie) <= INQUIRY_ENTRY_AGE_MAX) {
207 cp.pscan_rep_mode = ie->data.pscan_rep_mode;
208 cp.pscan_mode = ie->data.pscan_mode;
209 cp.clock_offset = ie->data.clock_offset |
213 memcpy(conn->dev_class, ie->data.dev_class, 3);
214 if (ie->data.ssp_mode > 0)
215 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
218 cp.pkt_type = cpu_to_le16(conn->pkt_type);
219 if (lmp_rswitch_capable(hdev) && !(hdev->link_mode & HCI_LM_MASTER))
220 cp.role_switch = 0x01;
222 cp.role_switch = 0x00;
224 hci_send_cmd(hdev, HCI_OP_CREATE_CONN, sizeof(cp), &cp);
227 int hci_disconnect(struct hci_conn *conn, __u8 reason)
229 BT_DBG("hcon %p", conn);
231 /* When we are master of an established connection and it enters
232 * the disconnect timeout, then go ahead and try to read the
233 * current clock offset. Processing of the result is done
234 * within the event handling and hci_clock_offset_evt function.
236 if (conn->type == ACL_LINK && conn->role == HCI_ROLE_MASTER &&
237 (conn->state == BT_CONNECTED || conn->state == BT_CONFIG)) {
238 struct hci_dev *hdev = conn->hdev;
239 struct hci_cp_read_clock_offset clkoff_cp;
241 clkoff_cp.handle = cpu_to_le16(conn->handle);
242 hci_send_cmd(hdev, HCI_OP_READ_CLOCK_OFFSET, sizeof(clkoff_cp),
246 return hci_abort_conn(conn, reason);
249 static void hci_add_sco(struct hci_conn *conn, __u16 handle)
251 struct hci_dev *hdev = conn->hdev;
252 struct hci_cp_add_sco cp;
254 BT_DBG("hcon %p", conn);
256 conn->state = BT_CONNECT;
261 cp.handle = cpu_to_le16(handle);
262 cp.pkt_type = cpu_to_le16(conn->pkt_type);
264 hci_send_cmd(hdev, HCI_OP_ADD_SCO, sizeof(cp), &cp);
267 bool hci_setup_sync(struct hci_conn *conn, __u16 handle)
269 struct hci_dev *hdev = conn->hdev;
270 struct hci_cp_setup_sync_conn cp;
271 const struct sco_param *param;
273 BT_DBG("hcon %p", conn);
275 conn->state = BT_CONNECT;
280 cp.handle = cpu_to_le16(handle);
282 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
283 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
284 cp.voice_setting = cpu_to_le16(conn->setting);
286 switch (conn->setting & SCO_AIRMODE_MASK) {
287 case SCO_AIRMODE_TRANSP:
288 if (conn->attempt > ARRAY_SIZE(esco_param_msbc))
290 param = &esco_param_msbc[conn->attempt - 1];
292 case SCO_AIRMODE_CVSD:
293 if (lmp_esco_capable(conn->link)) {
294 if (conn->attempt > ARRAY_SIZE(esco_param_cvsd))
296 param = &esco_param_cvsd[conn->attempt - 1];
298 if (conn->attempt > ARRAY_SIZE(sco_param_cvsd))
300 param = &sco_param_cvsd[conn->attempt - 1];
307 cp.retrans_effort = param->retrans_effort;
308 cp.pkt_type = __cpu_to_le16(param->pkt_type);
309 cp.max_latency = __cpu_to_le16(param->max_latency);
311 if (hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp) < 0)
317 u8 hci_le_conn_update(struct hci_conn *conn, u16 min, u16 max, u16 latency,
320 struct hci_dev *hdev = conn->hdev;
321 struct hci_conn_params *params;
322 struct hci_cp_le_conn_update cp;
326 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
328 params->conn_min_interval = min;
329 params->conn_max_interval = max;
330 params->conn_latency = latency;
331 params->supervision_timeout = to_multiplier;
334 hci_dev_unlock(hdev);
336 memset(&cp, 0, sizeof(cp));
337 cp.handle = cpu_to_le16(conn->handle);
338 cp.conn_interval_min = cpu_to_le16(min);
339 cp.conn_interval_max = cpu_to_le16(max);
340 cp.conn_latency = cpu_to_le16(latency);
341 cp.supervision_timeout = cpu_to_le16(to_multiplier);
342 cp.min_ce_len = cpu_to_le16(0x0000);
343 cp.max_ce_len = cpu_to_le16(0x0000);
345 hci_send_cmd(hdev, HCI_OP_LE_CONN_UPDATE, sizeof(cp), &cp);
353 void hci_le_start_enc(struct hci_conn *conn, __le16 ediv, __le64 rand,
354 __u8 ltk[16], __u8 key_size)
356 struct hci_dev *hdev = conn->hdev;
357 struct hci_cp_le_start_enc cp;
359 BT_DBG("hcon %p", conn);
361 memset(&cp, 0, sizeof(cp));
363 cp.handle = cpu_to_le16(conn->handle);
366 memcpy(cp.ltk, ltk, key_size);
368 hci_send_cmd(hdev, HCI_OP_LE_START_ENC, sizeof(cp), &cp);
371 /* Device _must_ be locked */
372 void hci_sco_setup(struct hci_conn *conn, __u8 status)
374 struct hci_conn *sco = conn->link;
379 BT_DBG("hcon %p", conn);
382 if (lmp_esco_capable(conn->hdev))
383 hci_setup_sync(sco, conn->handle);
385 hci_add_sco(sco, conn->handle);
387 hci_connect_cfm(sco, status);
392 static void hci_conn_timeout(struct work_struct *work)
394 struct hci_conn *conn = container_of(work, struct hci_conn,
396 int refcnt = atomic_read(&conn->refcnt);
398 BT_DBG("hcon %p state %s", conn, state_to_string(conn->state));
402 /* FIXME: It was observed that in pairing failed scenario, refcnt
403 * drops below 0. Probably this is because l2cap_conn_del calls
404 * l2cap_chan_del for each channel, and inside l2cap_chan_del conn is
405 * dropped. After that loop hci_chan_del is called which also drops
406 * conn. For now make sure that ACL is alive if refcnt is higher then 0,
412 /* LE connections in scanning state need special handling */
413 if (conn->state == BT_CONNECT && conn->type == LE_LINK &&
414 test_bit(HCI_CONN_SCANNING, &conn->flags)) {
415 hci_connect_le_scan_remove(conn);
419 hci_abort_conn(conn, hci_proto_disconn_ind(conn));
422 /* Enter sniff mode */
423 static void hci_conn_idle(struct work_struct *work)
425 struct hci_conn *conn = container_of(work, struct hci_conn,
427 struct hci_dev *hdev = conn->hdev;
429 BT_DBG("hcon %p mode %d", conn, conn->mode);
431 if (!lmp_sniff_capable(hdev) || !lmp_sniff_capable(conn))
434 if (conn->mode != HCI_CM_ACTIVE || !(conn->link_policy & HCI_LP_SNIFF))
437 if (lmp_sniffsubr_capable(hdev) && lmp_sniffsubr_capable(conn)) {
438 struct hci_cp_sniff_subrate cp;
439 cp.handle = cpu_to_le16(conn->handle);
440 cp.max_latency = cpu_to_le16(0);
441 cp.min_remote_timeout = cpu_to_le16(0);
442 cp.min_local_timeout = cpu_to_le16(0);
443 hci_send_cmd(hdev, HCI_OP_SNIFF_SUBRATE, sizeof(cp), &cp);
446 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags)) {
447 struct hci_cp_sniff_mode cp;
448 cp.handle = cpu_to_le16(conn->handle);
449 cp.max_interval = cpu_to_le16(hdev->sniff_max_interval);
450 cp.min_interval = cpu_to_le16(hdev->sniff_min_interval);
451 cp.attempt = cpu_to_le16(4);
452 cp.timeout = cpu_to_le16(1);
453 hci_send_cmd(hdev, HCI_OP_SNIFF_MODE, sizeof(cp), &cp);
457 static void hci_conn_auto_accept(struct work_struct *work)
459 struct hci_conn *conn = container_of(work, struct hci_conn,
460 auto_accept_work.work);
462 hci_send_cmd(conn->hdev, HCI_OP_USER_CONFIRM_REPLY, sizeof(conn->dst),
466 static void le_conn_timeout(struct work_struct *work)
468 struct hci_conn *conn = container_of(work, struct hci_conn,
469 le_conn_timeout.work);
470 struct hci_dev *hdev = conn->hdev;
474 /* We could end up here due to having done directed advertising,
475 * so clean up the state if necessary. This should however only
476 * happen with broken hardware or if low duty cycle was used
477 * (which doesn't have a timeout of its own).
479 if (conn->role == HCI_ROLE_SLAVE) {
481 hci_send_cmd(hdev, HCI_OP_LE_SET_ADV_ENABLE, sizeof(enable),
483 hci_le_conn_failed(conn, HCI_ERROR_ADVERTISING_TIMEOUT);
487 hci_abort_conn(conn, HCI_ERROR_REMOTE_USER_TERM);
490 struct hci_conn *hci_conn_add(struct hci_dev *hdev, int type, bdaddr_t *dst,
493 struct hci_conn *conn;
495 BT_DBG("%s dst %pMR", hdev->name, dst);
497 conn = kzalloc(sizeof(*conn), GFP_KERNEL);
501 bacpy(&conn->dst, dst);
502 bacpy(&conn->src, &hdev->bdaddr);
506 conn->mode = HCI_CM_ACTIVE;
507 conn->state = BT_OPEN;
508 conn->auth_type = HCI_AT_GENERAL_BONDING;
509 conn->io_capability = hdev->io_capability;
510 conn->remote_auth = 0xff;
511 conn->key_type = 0xff;
512 conn->rssi = HCI_RSSI_INVALID;
513 conn->tx_power = HCI_TX_POWER_INVALID;
514 conn->max_tx_power = HCI_TX_POWER_INVALID;
516 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
517 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
519 if (conn->role == HCI_ROLE_MASTER)
524 conn->pkt_type = hdev->pkt_type & ACL_PTYPE_MASK;
527 /* conn->src should reflect the local identity address */
528 hci_copy_identity_address(hdev, &conn->src, &conn->src_type);
531 if (lmp_esco_capable(hdev))
532 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
533 (hdev->esco_type & EDR_ESCO_MASK);
535 conn->pkt_type = hdev->pkt_type & SCO_PTYPE_MASK;
538 conn->pkt_type = hdev->esco_type & ~EDR_ESCO_MASK;
542 skb_queue_head_init(&conn->data_q);
544 INIT_LIST_HEAD(&conn->chan_list);
546 INIT_DELAYED_WORK(&conn->disc_work, hci_conn_timeout);
547 INIT_DELAYED_WORK(&conn->auto_accept_work, hci_conn_auto_accept);
548 INIT_DELAYED_WORK(&conn->idle_work, hci_conn_idle);
549 INIT_DELAYED_WORK(&conn->le_conn_timeout, le_conn_timeout);
550 INIT_WORK(&conn->le_scan_cleanup, le_scan_cleanup);
552 atomic_set(&conn->refcnt, 0);
556 hci_conn_hash_add(hdev, conn);
558 hdev->notify(hdev, HCI_NOTIFY_CONN_ADD);
560 hci_conn_init_sysfs(conn);
565 int hci_conn_del(struct hci_conn *conn)
567 struct hci_dev *hdev = conn->hdev;
569 BT_DBG("%s hcon %p handle %d", hdev->name, conn, conn->handle);
571 cancel_delayed_work_sync(&conn->disc_work);
572 cancel_delayed_work_sync(&conn->auto_accept_work);
573 cancel_delayed_work_sync(&conn->idle_work);
575 if (conn->type == ACL_LINK) {
576 struct hci_conn *sco = conn->link;
581 hdev->acl_cnt += conn->sent;
582 } else if (conn->type == LE_LINK) {
583 cancel_delayed_work(&conn->le_conn_timeout);
586 hdev->le_cnt += conn->sent;
588 hdev->acl_cnt += conn->sent;
590 struct hci_conn *acl = conn->link;
598 amp_mgr_put(conn->amp_mgr);
600 skb_queue_purge(&conn->data_q);
602 /* Remove the connection from the list and cleanup its remaining
603 * state. This is a separate function since for some cases like
604 * BT_CONNECT_SCAN we *only* want the cleanup part without the
605 * rest of hci_conn_del.
607 hci_conn_cleanup(conn);
612 struct hci_dev *hci_get_route(bdaddr_t *dst, bdaddr_t *src)
614 int use_src = bacmp(src, BDADDR_ANY);
615 struct hci_dev *hdev = NULL, *d;
617 BT_DBG("%pMR -> %pMR", src, dst);
619 read_lock(&hci_dev_list_lock);
621 list_for_each_entry(d, &hci_dev_list, list) {
622 if (!test_bit(HCI_UP, &d->flags) ||
623 hci_dev_test_flag(d, HCI_USER_CHANNEL) ||
624 d->dev_type != HCI_BREDR)
628 * No source address - find interface with bdaddr != dst
629 * Source address - find interface with bdaddr == src
633 if (!bacmp(&d->bdaddr, src)) {
637 if (bacmp(&d->bdaddr, dst)) {
644 hdev = hci_dev_hold(hdev);
646 read_unlock(&hci_dev_list_lock);
649 EXPORT_SYMBOL(hci_get_route);
651 /* This function requires the caller holds hdev->lock */
652 void hci_le_conn_failed(struct hci_conn *conn, u8 status)
654 struct hci_dev *hdev = conn->hdev;
655 struct hci_conn_params *params;
657 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
659 if (params && params->conn) {
660 hci_conn_drop(params->conn);
661 hci_conn_put(params->conn);
665 conn->state = BT_CLOSED;
667 mgmt_connect_failed(hdev, &conn->dst, conn->type, conn->dst_type,
670 hci_connect_cfm(conn, status);
674 /* Since we may have temporarily stopped the background scanning in
675 * favor of connection establishment, we should restart it.
677 hci_update_background_scan(hdev);
679 /* Re-enable advertising in case this was a failed connection
680 * attempt as a peripheral.
682 mgmt_reenable_advertising(hdev);
685 static void create_le_conn_complete(struct hci_dev *hdev, u8 status, u16 opcode)
687 struct hci_conn *conn;
691 conn = hci_lookup_le_connect(hdev);
694 hci_connect_le_scan_cleanup(conn);
698 BT_ERR("HCI request failed to create LE connection: status 0x%2.2x",
704 hci_le_conn_failed(conn, status);
707 hci_dev_unlock(hdev);
710 static void hci_req_add_le_create_conn(struct hci_request *req,
711 struct hci_conn *conn)
713 struct hci_cp_le_create_conn cp;
714 struct hci_dev *hdev = conn->hdev;
717 memset(&cp, 0, sizeof(cp));
719 /* Update random address, but set require_privacy to false so
720 * that we never connect with an non-resolvable address.
722 if (hci_update_random_address(req, false, &own_addr_type))
725 /* Set window to be the same value as the interval to enable
726 * continuous scanning.
728 cp.scan_interval = cpu_to_le16(hdev->le_scan_interval);
729 cp.scan_window = cp.scan_interval;
731 bacpy(&cp.peer_addr, &conn->dst);
732 cp.peer_addr_type = conn->dst_type;
733 cp.own_address_type = own_addr_type;
734 cp.conn_interval_min = cpu_to_le16(conn->le_conn_min_interval);
735 cp.conn_interval_max = cpu_to_le16(conn->le_conn_max_interval);
736 cp.conn_latency = cpu_to_le16(conn->le_conn_latency);
737 cp.supervision_timeout = cpu_to_le16(conn->le_supv_timeout);
738 cp.min_ce_len = cpu_to_le16(0x0000);
739 cp.max_ce_len = cpu_to_le16(0x0000);
741 hci_req_add(req, HCI_OP_LE_CREATE_CONN, sizeof(cp), &cp);
743 conn->state = BT_CONNECT;
744 clear_bit(HCI_CONN_SCANNING, &conn->flags);
747 static void hci_req_directed_advertising(struct hci_request *req,
748 struct hci_conn *conn)
750 struct hci_dev *hdev = req->hdev;
751 struct hci_cp_le_set_adv_param cp;
755 /* Clear the HCI_LE_ADV bit temporarily so that the
756 * hci_update_random_address knows that it's safe to go ahead
757 * and write a new random address. The flag will be set back on
758 * as soon as the SET_ADV_ENABLE HCI command completes.
760 hci_dev_clear_flag(hdev, HCI_LE_ADV);
762 /* Set require_privacy to false so that the remote device has a
763 * chance of identifying us.
765 if (hci_update_random_address(req, false, &own_addr_type) < 0)
768 memset(&cp, 0, sizeof(cp));
769 cp.type = LE_ADV_DIRECT_IND;
770 cp.own_address_type = own_addr_type;
771 cp.direct_addr_type = conn->dst_type;
772 bacpy(&cp.direct_addr, &conn->dst);
773 cp.channel_map = hdev->le_adv_channel_map;
775 hci_req_add(req, HCI_OP_LE_SET_ADV_PARAM, sizeof(cp), &cp);
778 hci_req_add(req, HCI_OP_LE_SET_ADV_ENABLE, sizeof(enable), &enable);
780 conn->state = BT_CONNECT;
783 struct hci_conn *hci_connect_le(struct hci_dev *hdev, bdaddr_t *dst,
784 u8 dst_type, u8 sec_level, u16 conn_timeout,
787 struct hci_conn_params *params;
788 struct hci_conn *conn, *conn_unfinished;
790 struct hci_request req;
793 /* Let's make sure that le is enabled.*/
794 if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) {
795 if (lmp_le_capable(hdev))
796 return ERR_PTR(-ECONNREFUSED);
798 return ERR_PTR(-EOPNOTSUPP);
801 /* Some devices send ATT messages as soon as the physical link is
802 * established. To be able to handle these ATT messages, the user-
803 * space first establishes the connection and then starts the pairing
806 * So if a hci_conn object already exists for the following connection
807 * attempt, we simply update pending_sec_level and auth_type fields
808 * and return the object found.
810 conn = hci_conn_hash_lookup_le(hdev, dst, dst_type);
811 conn_unfinished = NULL;
813 if (conn->state == BT_CONNECT &&
814 test_bit(HCI_CONN_SCANNING, &conn->flags)) {
815 BT_DBG("will continue unfinished conn %pMR", dst);
816 conn_unfinished = conn;
818 if (conn->pending_sec_level < sec_level)
819 conn->pending_sec_level = sec_level;
824 /* Since the controller supports only one LE connection attempt at a
825 * time, we return -EBUSY if there is any connection attempt running.
827 if (hci_lookup_le_connect(hdev))
828 return ERR_PTR(-EBUSY);
830 /* When given an identity address with existing identity
831 * resolving key, the connection needs to be established
832 * to a resolvable random address.
834 * Storing the resolvable random address is required here
835 * to handle connection failures. The address will later
836 * be resolved back into the original identity address
837 * from the connect request.
839 irk = hci_find_irk_by_addr(hdev, dst, dst_type);
840 if (irk && bacmp(&irk->rpa, BDADDR_ANY)) {
842 dst_type = ADDR_LE_DEV_RANDOM;
845 if (conn_unfinished) {
846 conn = conn_unfinished;
847 bacpy(&conn->dst, dst);
849 conn = hci_conn_add(hdev, LE_LINK, dst, role);
853 return ERR_PTR(-ENOMEM);
855 conn->dst_type = dst_type;
856 conn->sec_level = BT_SECURITY_LOW;
857 conn->conn_timeout = conn_timeout;
859 if (!conn_unfinished)
860 conn->pending_sec_level = sec_level;
862 hci_req_init(&req, hdev);
864 /* Disable advertising if we're active. For master role
865 * connections most controllers will refuse to connect if
866 * advertising is enabled, and for slave role connections we
867 * anyway have to disable it in order to start directed
870 if (hci_dev_test_flag(hdev, HCI_LE_ADV)) {
872 hci_req_add(&req, HCI_OP_LE_SET_ADV_ENABLE, sizeof(enable),
876 /* If requested to connect as slave use directed advertising */
877 if (conn->role == HCI_ROLE_SLAVE) {
878 /* If we're active scanning most controllers are unable
879 * to initiate advertising. Simply reject the attempt.
881 if (hci_dev_test_flag(hdev, HCI_LE_SCAN) &&
882 hdev->le_scan_type == LE_SCAN_ACTIVE) {
883 skb_queue_purge(&req.cmd_q);
885 return ERR_PTR(-EBUSY);
888 hci_req_directed_advertising(&req, conn);
892 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
894 conn->le_conn_min_interval = params->conn_min_interval;
895 conn->le_conn_max_interval = params->conn_max_interval;
896 conn->le_conn_latency = params->conn_latency;
897 conn->le_supv_timeout = params->supervision_timeout;
899 conn->le_conn_min_interval = hdev->le_conn_min_interval;
900 conn->le_conn_max_interval = hdev->le_conn_max_interval;
901 conn->le_conn_latency = hdev->le_conn_latency;
902 conn->le_supv_timeout = hdev->le_supv_timeout;
905 /* If controller is scanning, we stop it since some controllers are
906 * not able to scan and connect at the same time. Also set the
907 * HCI_LE_SCAN_INTERRUPTED flag so that the command complete
908 * handler for scan disabling knows to set the correct discovery
911 if (hci_dev_test_flag(hdev, HCI_LE_SCAN)) {
912 hci_req_add_le_scan_disable(&req);
913 hci_dev_set_flag(hdev, HCI_LE_SCAN_INTERRUPTED);
916 hci_req_add_le_create_conn(&req, conn);
919 err = hci_req_run(&req, create_le_conn_complete);
926 /* If this is continuation of connect started by hci_connect_le_scan,
927 * it already called hci_conn_hold and calling it again would mess the
930 if (!conn_unfinished)
936 static void hci_connect_le_scan_complete(struct hci_dev *hdev, u8 status,
939 struct hci_conn *conn;
944 BT_ERR("Failed to add device to auto conn whitelist: status 0x%2.2x",
949 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
951 hci_le_conn_failed(conn, status);
953 hci_dev_unlock(hdev);
956 static bool is_connected(struct hci_dev *hdev, bdaddr_t *addr, u8 type)
958 struct hci_conn *conn;
960 conn = hci_conn_hash_lookup_le(hdev, addr, type);
964 if (conn->state != BT_CONNECTED)
970 /* This function requires the caller holds hdev->lock */
971 static int hci_explicit_conn_params_set(struct hci_request *req,
972 bdaddr_t *addr, u8 addr_type)
974 struct hci_dev *hdev = req->hdev;
975 struct hci_conn_params *params;
977 if (is_connected(hdev, addr, addr_type))
980 params = hci_conn_params_lookup(hdev, addr, addr_type);
982 params = hci_conn_params_add(hdev, addr, addr_type);
986 /* If we created new params, mark them to be deleted in
987 * hci_connect_le_scan_cleanup. It's different case than
988 * existing disabled params, those will stay after cleanup.
990 params->auto_connect = HCI_AUTO_CONN_EXPLICIT;
993 /* We're trying to connect, so make sure params are at pend_le_conns */
994 if (params->auto_connect == HCI_AUTO_CONN_DISABLED ||
995 params->auto_connect == HCI_AUTO_CONN_REPORT ||
996 params->auto_connect == HCI_AUTO_CONN_EXPLICIT) {
997 list_del_init(¶ms->action);
998 list_add(¶ms->action, &hdev->pend_le_conns);
1001 params->explicit_connect = true;
1002 __hci_update_background_scan(req);
1004 BT_DBG("addr %pMR (type %u) auto_connect %u", addr, addr_type,
1005 params->auto_connect);
1010 /* This function requires the caller holds hdev->lock */
1011 struct hci_conn *hci_connect_le_scan(struct hci_dev *hdev, bdaddr_t *dst,
1012 u8 dst_type, u8 sec_level,
1013 u16 conn_timeout, u8 role)
1015 struct hci_conn *conn;
1016 struct hci_request req;
1019 /* Let's make sure that le is enabled.*/
1020 if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) {
1021 if (lmp_le_capable(hdev))
1022 return ERR_PTR(-ECONNREFUSED);
1024 return ERR_PTR(-EOPNOTSUPP);
1027 /* Some devices send ATT messages as soon as the physical link is
1028 * established. To be able to handle these ATT messages, the user-
1029 * space first establishes the connection and then starts the pairing
1032 * So if a hci_conn object already exists for the following connection
1033 * attempt, we simply update pending_sec_level and auth_type fields
1034 * and return the object found.
1036 conn = hci_conn_hash_lookup_le(hdev, dst, dst_type);
1038 if (conn->pending_sec_level < sec_level)
1039 conn->pending_sec_level = sec_level;
1043 BT_DBG("requesting refresh of dst_addr");
1045 conn = hci_conn_add(hdev, LE_LINK, dst, role);
1047 return ERR_PTR(-ENOMEM);
1049 hci_req_init(&req, hdev);
1051 if (hci_explicit_conn_params_set(&req, dst, dst_type) < 0)
1052 return ERR_PTR(-EBUSY);
1054 conn->state = BT_CONNECT;
1055 set_bit(HCI_CONN_SCANNING, &conn->flags);
1057 err = hci_req_run(&req, hci_connect_le_scan_complete);
1058 if (err && err != -ENODATA) {
1060 return ERR_PTR(err);
1063 conn->dst_type = dst_type;
1064 conn->sec_level = BT_SECURITY_LOW;
1065 conn->pending_sec_level = sec_level;
1066 conn->conn_timeout = conn_timeout;
1069 hci_conn_hold(conn);
1073 struct hci_conn *hci_connect_acl(struct hci_dev *hdev, bdaddr_t *dst,
1074 u8 sec_level, u8 auth_type)
1076 struct hci_conn *acl;
1078 if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) {
1079 if (lmp_bredr_capable(hdev))
1080 return ERR_PTR(-ECONNREFUSED);
1082 return ERR_PTR(-EOPNOTSUPP);
1085 acl = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst);
1087 acl = hci_conn_add(hdev, ACL_LINK, dst, HCI_ROLE_MASTER);
1089 return ERR_PTR(-ENOMEM);
1094 if (acl->state == BT_OPEN || acl->state == BT_CLOSED) {
1095 acl->sec_level = BT_SECURITY_LOW;
1096 acl->pending_sec_level = sec_level;
1097 acl->auth_type = auth_type;
1098 hci_acl_create_connection(acl);
1104 struct hci_conn *hci_connect_sco(struct hci_dev *hdev, int type, bdaddr_t *dst,
1107 struct hci_conn *acl;
1108 struct hci_conn *sco;
1110 acl = hci_connect_acl(hdev, dst, BT_SECURITY_LOW, HCI_AT_NO_BONDING);
1114 sco = hci_conn_hash_lookup_ba(hdev, type, dst);
1116 sco = hci_conn_add(hdev, type, dst, HCI_ROLE_MASTER);
1119 return ERR_PTR(-ENOMEM);
1128 sco->setting = setting;
1130 if (acl->state == BT_CONNECTED &&
1131 (sco->state == BT_OPEN || sco->state == BT_CLOSED)) {
1132 set_bit(HCI_CONN_POWER_SAVE, &acl->flags);
1133 hci_conn_enter_active_mode(acl, BT_POWER_FORCE_ACTIVE_ON);
1135 if (test_bit(HCI_CONN_MODE_CHANGE_PEND, &acl->flags)) {
1136 /* defer SCO setup until mode change completed */
1137 set_bit(HCI_CONN_SCO_SETUP_PEND, &acl->flags);
1141 hci_sco_setup(acl, 0x00);
1147 /* Check link security requirement */
1148 int hci_conn_check_link_mode(struct hci_conn *conn)
1150 BT_DBG("hcon %p", conn);
1152 /* In Secure Connections Only mode, it is required that Secure
1153 * Connections is used and the link is encrypted with AES-CCM
1154 * using a P-256 authenticated combination key.
1156 if (hci_dev_test_flag(conn->hdev, HCI_SC_ONLY)) {
1157 if (!hci_conn_sc_enabled(conn) ||
1158 !test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
1159 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)
1163 if (hci_conn_ssp_enabled(conn) &&
1164 !test_bit(HCI_CONN_ENCRYPT, &conn->flags))
1170 /* Authenticate remote device */
1171 static int hci_conn_auth(struct hci_conn *conn, __u8 sec_level, __u8 auth_type)
1173 BT_DBG("hcon %p", conn);
1175 if (conn->pending_sec_level > sec_level)
1176 sec_level = conn->pending_sec_level;
1178 if (sec_level > conn->sec_level)
1179 conn->pending_sec_level = sec_level;
1180 else if (test_bit(HCI_CONN_AUTH, &conn->flags))
1183 /* Make sure we preserve an existing MITM requirement*/
1184 auth_type |= (conn->auth_type & 0x01);
1186 conn->auth_type = auth_type;
1188 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
1189 struct hci_cp_auth_requested cp;
1191 cp.handle = cpu_to_le16(conn->handle);
1192 hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
1195 /* If we're already encrypted set the REAUTH_PEND flag,
1196 * otherwise set the ENCRYPT_PEND.
1198 if (test_bit(HCI_CONN_ENCRYPT, &conn->flags))
1199 set_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
1201 set_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
1207 /* Encrypt the the link */
1208 static void hci_conn_encrypt(struct hci_conn *conn)
1210 BT_DBG("hcon %p", conn);
1212 if (!test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
1213 struct hci_cp_set_conn_encrypt cp;
1214 cp.handle = cpu_to_le16(conn->handle);
1216 hci_send_cmd(conn->hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1221 /* Enable security */
1222 int hci_conn_security(struct hci_conn *conn, __u8 sec_level, __u8 auth_type,
1225 BT_DBG("hcon %p", conn);
1227 if (conn->type == LE_LINK)
1228 return smp_conn_security(conn, sec_level);
1230 /* For sdp we don't need the link key. */
1231 if (sec_level == BT_SECURITY_SDP)
1234 /* For non 2.1 devices and low security level we don't need the link
1236 if (sec_level == BT_SECURITY_LOW && !hci_conn_ssp_enabled(conn))
1239 /* For other security levels we need the link key. */
1240 if (!test_bit(HCI_CONN_AUTH, &conn->flags))
1243 /* An authenticated FIPS approved combination key has sufficient
1244 * security for security level 4. */
1245 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256 &&
1246 sec_level == BT_SECURITY_FIPS)
1249 /* An authenticated combination key has sufficient security for
1250 security level 3. */
1251 if ((conn->key_type == HCI_LK_AUTH_COMBINATION_P192 ||
1252 conn->key_type == HCI_LK_AUTH_COMBINATION_P256) &&
1253 sec_level == BT_SECURITY_HIGH)
1256 /* An unauthenticated combination key has sufficient security for
1257 security level 1 and 2. */
1258 if ((conn->key_type == HCI_LK_UNAUTH_COMBINATION_P192 ||
1259 conn->key_type == HCI_LK_UNAUTH_COMBINATION_P256) &&
1260 (sec_level == BT_SECURITY_MEDIUM || sec_level == BT_SECURITY_LOW))
1263 /* A combination key has always sufficient security for the security
1264 levels 1 or 2. High security level requires the combination key
1265 is generated using maximum PIN code length (16).
1266 For pre 2.1 units. */
1267 if (conn->key_type == HCI_LK_COMBINATION &&
1268 (sec_level == BT_SECURITY_MEDIUM || sec_level == BT_SECURITY_LOW ||
1269 conn->pin_length == 16))
1273 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags))
1277 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
1279 if (!hci_conn_auth(conn, sec_level, auth_type))
1283 if (test_bit(HCI_CONN_ENCRYPT, &conn->flags))
1286 hci_conn_encrypt(conn);
1289 EXPORT_SYMBOL(hci_conn_security);
1291 /* Check secure link requirement */
1292 int hci_conn_check_secure(struct hci_conn *conn, __u8 sec_level)
1294 BT_DBG("hcon %p", conn);
1296 /* Accept if non-secure or higher security level is required */
1297 if (sec_level != BT_SECURITY_HIGH && sec_level != BT_SECURITY_FIPS)
1300 /* Accept if secure or higher security level is already present */
1301 if (conn->sec_level == BT_SECURITY_HIGH ||
1302 conn->sec_level == BT_SECURITY_FIPS)
1305 /* Reject not secure link */
1308 EXPORT_SYMBOL(hci_conn_check_secure);
1311 int hci_conn_switch_role(struct hci_conn *conn, __u8 role)
1313 BT_DBG("hcon %p", conn);
1315 if (role == conn->role)
1318 if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND, &conn->flags)) {
1319 struct hci_cp_switch_role cp;
1320 bacpy(&cp.bdaddr, &conn->dst);
1322 hci_send_cmd(conn->hdev, HCI_OP_SWITCH_ROLE, sizeof(cp), &cp);
1327 EXPORT_SYMBOL(hci_conn_switch_role);
1329 /* Enter active mode */
1330 void hci_conn_enter_active_mode(struct hci_conn *conn, __u8 force_active)
1332 struct hci_dev *hdev = conn->hdev;
1334 BT_DBG("hcon %p mode %d", conn, conn->mode);
1336 if (conn->mode != HCI_CM_SNIFF)
1339 if (!test_bit(HCI_CONN_POWER_SAVE, &conn->flags) && !force_active)
1342 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags)) {
1343 struct hci_cp_exit_sniff_mode cp;
1344 cp.handle = cpu_to_le16(conn->handle);
1345 hci_send_cmd(hdev, HCI_OP_EXIT_SNIFF_MODE, sizeof(cp), &cp);
1349 if (hdev->idle_timeout > 0)
1350 queue_delayed_work(hdev->workqueue, &conn->idle_work,
1351 msecs_to_jiffies(hdev->idle_timeout));
1354 /* Drop all connection on the device */
1355 void hci_conn_hash_flush(struct hci_dev *hdev)
1357 struct hci_conn_hash *h = &hdev->conn_hash;
1358 struct hci_conn *c, *n;
1360 BT_DBG("hdev %s", hdev->name);
1362 list_for_each_entry_safe(c, n, &h->list, list) {
1363 c->state = BT_CLOSED;
1365 hci_disconn_cfm(c, HCI_ERROR_LOCAL_HOST_TERM);
1370 /* Check pending connect attempts */
1371 void hci_conn_check_pending(struct hci_dev *hdev)
1373 struct hci_conn *conn;
1375 BT_DBG("hdev %s", hdev->name);
1379 conn = hci_conn_hash_lookup_state(hdev, ACL_LINK, BT_CONNECT2);
1381 hci_acl_create_connection(conn);
1383 hci_dev_unlock(hdev);
1386 static u32 get_link_mode(struct hci_conn *conn)
1390 if (conn->role == HCI_ROLE_MASTER)
1391 link_mode |= HCI_LM_MASTER;
1393 if (test_bit(HCI_CONN_ENCRYPT, &conn->flags))
1394 link_mode |= HCI_LM_ENCRYPT;
1396 if (test_bit(HCI_CONN_AUTH, &conn->flags))
1397 link_mode |= HCI_LM_AUTH;
1399 if (test_bit(HCI_CONN_SECURE, &conn->flags))
1400 link_mode |= HCI_LM_SECURE;
1402 if (test_bit(HCI_CONN_FIPS, &conn->flags))
1403 link_mode |= HCI_LM_FIPS;
1408 int hci_get_conn_list(void __user *arg)
1411 struct hci_conn_list_req req, *cl;
1412 struct hci_conn_info *ci;
1413 struct hci_dev *hdev;
1414 int n = 0, size, err;
1416 if (copy_from_user(&req, arg, sizeof(req)))
1419 if (!req.conn_num || req.conn_num > (PAGE_SIZE * 2) / sizeof(*ci))
1422 size = sizeof(req) + req.conn_num * sizeof(*ci);
1424 cl = kmalloc(size, GFP_KERNEL);
1428 hdev = hci_dev_get(req.dev_id);
1437 list_for_each_entry(c, &hdev->conn_hash.list, list) {
1438 bacpy(&(ci + n)->bdaddr, &c->dst);
1439 (ci + n)->handle = c->handle;
1440 (ci + n)->type = c->type;
1441 (ci + n)->out = c->out;
1442 (ci + n)->state = c->state;
1443 (ci + n)->link_mode = get_link_mode(c);
1444 if (++n >= req.conn_num)
1447 hci_dev_unlock(hdev);
1449 cl->dev_id = hdev->id;
1451 size = sizeof(req) + n * sizeof(*ci);
1455 err = copy_to_user(arg, cl, size);
1458 return err ? -EFAULT : 0;
1461 int hci_get_conn_info(struct hci_dev *hdev, void __user *arg)
1463 struct hci_conn_info_req req;
1464 struct hci_conn_info ci;
1465 struct hci_conn *conn;
1466 char __user *ptr = arg + sizeof(req);
1468 if (copy_from_user(&req, arg, sizeof(req)))
1472 conn = hci_conn_hash_lookup_ba(hdev, req.type, &req.bdaddr);
1474 bacpy(&ci.bdaddr, &conn->dst);
1475 ci.handle = conn->handle;
1476 ci.type = conn->type;
1478 ci.state = conn->state;
1479 ci.link_mode = get_link_mode(conn);
1481 hci_dev_unlock(hdev);
1486 return copy_to_user(ptr, &ci, sizeof(ci)) ? -EFAULT : 0;
1489 int hci_get_auth_info(struct hci_dev *hdev, void __user *arg)
1491 struct hci_auth_info_req req;
1492 struct hci_conn *conn;
1494 if (copy_from_user(&req, arg, sizeof(req)))
1498 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &req.bdaddr);
1500 req.type = conn->auth_type;
1501 hci_dev_unlock(hdev);
1506 return copy_to_user(arg, &req, sizeof(req)) ? -EFAULT : 0;
1509 struct hci_chan *hci_chan_create(struct hci_conn *conn)
1511 struct hci_dev *hdev = conn->hdev;
1512 struct hci_chan *chan;
1514 BT_DBG("%s hcon %p", hdev->name, conn);
1516 if (test_bit(HCI_CONN_DROP, &conn->flags)) {
1517 BT_DBG("Refusing to create new hci_chan");
1521 chan = kzalloc(sizeof(*chan), GFP_KERNEL);
1525 chan->conn = hci_conn_get(conn);
1526 skb_queue_head_init(&chan->data_q);
1527 chan->state = BT_CONNECTED;
1529 list_add_rcu(&chan->list, &conn->chan_list);
1534 void hci_chan_del(struct hci_chan *chan)
1536 struct hci_conn *conn = chan->conn;
1537 struct hci_dev *hdev = conn->hdev;
1539 BT_DBG("%s hcon %p chan %p", hdev->name, conn, chan);
1541 list_del_rcu(&chan->list);
1545 /* Prevent new hci_chan's to be created for this hci_conn */
1546 set_bit(HCI_CONN_DROP, &conn->flags);
1550 skb_queue_purge(&chan->data_q);
1554 void hci_chan_list_flush(struct hci_conn *conn)
1556 struct hci_chan *chan, *n;
1558 BT_DBG("hcon %p", conn);
1560 list_for_each_entry_safe(chan, n, &conn->chan_list, list)
1564 static struct hci_chan *__hci_chan_lookup_handle(struct hci_conn *hcon,
1567 struct hci_chan *hchan;
1569 list_for_each_entry(hchan, &hcon->chan_list, list) {
1570 if (hchan->handle == handle)
1577 struct hci_chan *hci_chan_lookup_handle(struct hci_dev *hdev, __u16 handle)
1579 struct hci_conn_hash *h = &hdev->conn_hash;
1580 struct hci_conn *hcon;
1581 struct hci_chan *hchan = NULL;
1585 list_for_each_entry_rcu(hcon, &h->list, list) {
1586 hchan = __hci_chan_lookup_handle(hcon, handle);