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 /* Even though we hold a reference to the hdev, many other
182 * things might get cleaned up meanwhile, including the hdev's
183 * own workqueue, so we can't use that for scheduling.
185 schedule_work(&conn
->le_scan_cleanup
);
188 static void hci_acl_create_connection(struct hci_conn
*conn
)
190 struct hci_dev
*hdev
= conn
->hdev
;
191 struct inquiry_entry
*ie
;
192 struct hci_cp_create_conn cp
;
194 BT_DBG("hcon %p", conn
);
196 conn
->state
= BT_CONNECT
;
198 conn
->role
= HCI_ROLE_MASTER
;
202 conn
->link_policy
= hdev
->link_policy
;
204 memset(&cp
, 0, sizeof(cp
));
205 bacpy(&cp
.bdaddr
, &conn
->dst
);
206 cp
.pscan_rep_mode
= 0x02;
208 ie
= hci_inquiry_cache_lookup(hdev
, &conn
->dst
);
210 if (inquiry_entry_age(ie
) <= INQUIRY_ENTRY_AGE_MAX
) {
211 cp
.pscan_rep_mode
= ie
->data
.pscan_rep_mode
;
212 cp
.pscan_mode
= ie
->data
.pscan_mode
;
213 cp
.clock_offset
= ie
->data
.clock_offset
|
217 memcpy(conn
->dev_class
, ie
->data
.dev_class
, 3);
218 if (ie
->data
.ssp_mode
> 0)
219 set_bit(HCI_CONN_SSP_ENABLED
, &conn
->flags
);
222 cp
.pkt_type
= cpu_to_le16(conn
->pkt_type
);
223 if (lmp_rswitch_capable(hdev
) && !(hdev
->link_mode
& HCI_LM_MASTER
))
224 cp
.role_switch
= 0x01;
226 cp
.role_switch
= 0x00;
228 hci_send_cmd(hdev
, HCI_OP_CREATE_CONN
, sizeof(cp
), &cp
);
231 int hci_disconnect(struct hci_conn
*conn
, __u8 reason
)
233 BT_DBG("hcon %p", conn
);
235 /* When we are master of an established connection and it enters
236 * the disconnect timeout, then go ahead and try to read the
237 * current clock offset. Processing of the result is done
238 * within the event handling and hci_clock_offset_evt function.
240 if (conn
->type
== ACL_LINK
&& conn
->role
== HCI_ROLE_MASTER
&&
241 (conn
->state
== BT_CONNECTED
|| conn
->state
== BT_CONFIG
)) {
242 struct hci_dev
*hdev
= conn
->hdev
;
243 struct hci_cp_read_clock_offset clkoff_cp
;
245 clkoff_cp
.handle
= cpu_to_le16(conn
->handle
);
246 hci_send_cmd(hdev
, HCI_OP_READ_CLOCK_OFFSET
, sizeof(clkoff_cp
),
250 return hci_abort_conn(conn
, reason
);
253 static void hci_add_sco(struct hci_conn
*conn
, __u16 handle
)
255 struct hci_dev
*hdev
= conn
->hdev
;
256 struct hci_cp_add_sco cp
;
258 BT_DBG("hcon %p", conn
);
260 conn
->state
= BT_CONNECT
;
265 cp
.handle
= cpu_to_le16(handle
);
266 cp
.pkt_type
= cpu_to_le16(conn
->pkt_type
);
268 hci_send_cmd(hdev
, HCI_OP_ADD_SCO
, sizeof(cp
), &cp
);
271 bool hci_setup_sync(struct hci_conn
*conn
, __u16 handle
)
273 struct hci_dev
*hdev
= conn
->hdev
;
274 struct hci_cp_setup_sync_conn cp
;
275 const struct sco_param
*param
;
277 BT_DBG("hcon %p", conn
);
279 conn
->state
= BT_CONNECT
;
284 cp
.handle
= cpu_to_le16(handle
);
286 cp
.tx_bandwidth
= cpu_to_le32(0x00001f40);
287 cp
.rx_bandwidth
= cpu_to_le32(0x00001f40);
288 cp
.voice_setting
= cpu_to_le16(conn
->setting
);
290 switch (conn
->setting
& SCO_AIRMODE_MASK
) {
291 case SCO_AIRMODE_TRANSP
:
292 if (conn
->attempt
> ARRAY_SIZE(esco_param_msbc
))
294 param
= &esco_param_msbc
[conn
->attempt
- 1];
296 case SCO_AIRMODE_CVSD
:
297 if (lmp_esco_capable(conn
->link
)) {
298 if (conn
->attempt
> ARRAY_SIZE(esco_param_cvsd
))
300 param
= &esco_param_cvsd
[conn
->attempt
- 1];
302 if (conn
->attempt
> ARRAY_SIZE(sco_param_cvsd
))
304 param
= &sco_param_cvsd
[conn
->attempt
- 1];
311 cp
.retrans_effort
= param
->retrans_effort
;
312 cp
.pkt_type
= __cpu_to_le16(param
->pkt_type
);
313 cp
.max_latency
= __cpu_to_le16(param
->max_latency
);
315 if (hci_send_cmd(hdev
, HCI_OP_SETUP_SYNC_CONN
, sizeof(cp
), &cp
) < 0)
321 u8
hci_le_conn_update(struct hci_conn
*conn
, u16 min
, u16 max
, u16 latency
,
324 struct hci_dev
*hdev
= conn
->hdev
;
325 struct hci_conn_params
*params
;
326 struct hci_cp_le_conn_update cp
;
330 params
= hci_conn_params_lookup(hdev
, &conn
->dst
, conn
->dst_type
);
332 params
->conn_min_interval
= min
;
333 params
->conn_max_interval
= max
;
334 params
->conn_latency
= latency
;
335 params
->supervision_timeout
= to_multiplier
;
338 hci_dev_unlock(hdev
);
340 memset(&cp
, 0, sizeof(cp
));
341 cp
.handle
= cpu_to_le16(conn
->handle
);
342 cp
.conn_interval_min
= cpu_to_le16(min
);
343 cp
.conn_interval_max
= cpu_to_le16(max
);
344 cp
.conn_latency
= cpu_to_le16(latency
);
345 cp
.supervision_timeout
= cpu_to_le16(to_multiplier
);
346 cp
.min_ce_len
= cpu_to_le16(0x0000);
347 cp
.max_ce_len
= cpu_to_le16(0x0000);
349 hci_send_cmd(hdev
, HCI_OP_LE_CONN_UPDATE
, sizeof(cp
), &cp
);
357 void hci_le_start_enc(struct hci_conn
*conn
, __le16 ediv
, __le64 rand
,
358 __u8 ltk
[16], __u8 key_size
)
360 struct hci_dev
*hdev
= conn
->hdev
;
361 struct hci_cp_le_start_enc cp
;
363 BT_DBG("hcon %p", conn
);
365 memset(&cp
, 0, sizeof(cp
));
367 cp
.handle
= cpu_to_le16(conn
->handle
);
370 memcpy(cp
.ltk
, ltk
, key_size
);
372 hci_send_cmd(hdev
, HCI_OP_LE_START_ENC
, sizeof(cp
), &cp
);
375 /* Device _must_ be locked */
376 void hci_sco_setup(struct hci_conn
*conn
, __u8 status
)
378 struct hci_conn
*sco
= conn
->link
;
383 BT_DBG("hcon %p", conn
);
386 if (lmp_esco_capable(conn
->hdev
))
387 hci_setup_sync(sco
, conn
->handle
);
389 hci_add_sco(sco
, conn
->handle
);
391 hci_connect_cfm(sco
, status
);
396 static void hci_conn_timeout(struct work_struct
*work
)
398 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
400 int refcnt
= atomic_read(&conn
->refcnt
);
402 BT_DBG("hcon %p state %s", conn
, state_to_string(conn
->state
));
406 /* FIXME: It was observed that in pairing failed scenario, refcnt
407 * drops below 0. Probably this is because l2cap_conn_del calls
408 * l2cap_chan_del for each channel, and inside l2cap_chan_del conn is
409 * dropped. After that loop hci_chan_del is called which also drops
410 * conn. For now make sure that ACL is alive if refcnt is higher then 0,
416 /* LE connections in scanning state need special handling */
417 if (conn
->state
== BT_CONNECT
&& conn
->type
== LE_LINK
&&
418 test_bit(HCI_CONN_SCANNING
, &conn
->flags
)) {
419 hci_connect_le_scan_remove(conn
);
423 hci_abort_conn(conn
, hci_proto_disconn_ind(conn
));
426 /* Enter sniff mode */
427 static void hci_conn_idle(struct work_struct
*work
)
429 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
431 struct hci_dev
*hdev
= conn
->hdev
;
433 BT_DBG("hcon %p mode %d", conn
, conn
->mode
);
435 if (!lmp_sniff_capable(hdev
) || !lmp_sniff_capable(conn
))
438 if (conn
->mode
!= HCI_CM_ACTIVE
|| !(conn
->link_policy
& HCI_LP_SNIFF
))
441 if (lmp_sniffsubr_capable(hdev
) && lmp_sniffsubr_capable(conn
)) {
442 struct hci_cp_sniff_subrate cp
;
443 cp
.handle
= cpu_to_le16(conn
->handle
);
444 cp
.max_latency
= cpu_to_le16(0);
445 cp
.min_remote_timeout
= cpu_to_le16(0);
446 cp
.min_local_timeout
= cpu_to_le16(0);
447 hci_send_cmd(hdev
, HCI_OP_SNIFF_SUBRATE
, sizeof(cp
), &cp
);
450 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND
, &conn
->flags
)) {
451 struct hci_cp_sniff_mode cp
;
452 cp
.handle
= cpu_to_le16(conn
->handle
);
453 cp
.max_interval
= cpu_to_le16(hdev
->sniff_max_interval
);
454 cp
.min_interval
= cpu_to_le16(hdev
->sniff_min_interval
);
455 cp
.attempt
= cpu_to_le16(4);
456 cp
.timeout
= cpu_to_le16(1);
457 hci_send_cmd(hdev
, HCI_OP_SNIFF_MODE
, sizeof(cp
), &cp
);
461 static void hci_conn_auto_accept(struct work_struct
*work
)
463 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
464 auto_accept_work
.work
);
466 hci_send_cmd(conn
->hdev
, HCI_OP_USER_CONFIRM_REPLY
, sizeof(conn
->dst
),
470 static void le_conn_timeout(struct work_struct
*work
)
472 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
473 le_conn_timeout
.work
);
474 struct hci_dev
*hdev
= conn
->hdev
;
478 /* We could end up here due to having done directed advertising,
479 * so clean up the state if necessary. This should however only
480 * happen with broken hardware or if low duty cycle was used
481 * (which doesn't have a timeout of its own).
483 if (conn
->role
== HCI_ROLE_SLAVE
) {
485 hci_send_cmd(hdev
, HCI_OP_LE_SET_ADV_ENABLE
, sizeof(enable
),
487 hci_le_conn_failed(conn
, HCI_ERROR_ADVERTISING_TIMEOUT
);
491 hci_abort_conn(conn
, HCI_ERROR_REMOTE_USER_TERM
);
494 struct hci_conn
*hci_conn_add(struct hci_dev
*hdev
, int type
, bdaddr_t
*dst
,
497 struct hci_conn
*conn
;
499 BT_DBG("%s dst %pMR", hdev
->name
, dst
);
501 conn
= kzalloc(sizeof(*conn
), GFP_KERNEL
);
505 bacpy(&conn
->dst
, dst
);
506 bacpy(&conn
->src
, &hdev
->bdaddr
);
510 conn
->mode
= HCI_CM_ACTIVE
;
511 conn
->state
= BT_OPEN
;
512 conn
->auth_type
= HCI_AT_GENERAL_BONDING
;
513 conn
->io_capability
= hdev
->io_capability
;
514 conn
->remote_auth
= 0xff;
515 conn
->key_type
= 0xff;
516 conn
->rssi
= HCI_RSSI_INVALID
;
517 conn
->tx_power
= HCI_TX_POWER_INVALID
;
518 conn
->max_tx_power
= HCI_TX_POWER_INVALID
;
520 set_bit(HCI_CONN_POWER_SAVE
, &conn
->flags
);
521 conn
->disc_timeout
= HCI_DISCONN_TIMEOUT
;
523 if (conn
->role
== HCI_ROLE_MASTER
)
528 conn
->pkt_type
= hdev
->pkt_type
& ACL_PTYPE_MASK
;
531 /* conn->src should reflect the local identity address */
532 hci_copy_identity_address(hdev
, &conn
->src
, &conn
->src_type
);
535 if (lmp_esco_capable(hdev
))
536 conn
->pkt_type
= (hdev
->esco_type
& SCO_ESCO_MASK
) |
537 (hdev
->esco_type
& EDR_ESCO_MASK
);
539 conn
->pkt_type
= hdev
->pkt_type
& SCO_PTYPE_MASK
;
542 conn
->pkt_type
= hdev
->esco_type
& ~EDR_ESCO_MASK
;
546 skb_queue_head_init(&conn
->data_q
);
548 INIT_LIST_HEAD(&conn
->chan_list
);
550 INIT_DELAYED_WORK(&conn
->disc_work
, hci_conn_timeout
);
551 INIT_DELAYED_WORK(&conn
->auto_accept_work
, hci_conn_auto_accept
);
552 INIT_DELAYED_WORK(&conn
->idle_work
, hci_conn_idle
);
553 INIT_DELAYED_WORK(&conn
->le_conn_timeout
, le_conn_timeout
);
554 INIT_WORK(&conn
->le_scan_cleanup
, le_scan_cleanup
);
556 atomic_set(&conn
->refcnt
, 0);
560 hci_conn_hash_add(hdev
, conn
);
562 hdev
->notify(hdev
, HCI_NOTIFY_CONN_ADD
);
564 hci_conn_init_sysfs(conn
);
569 int hci_conn_del(struct hci_conn
*conn
)
571 struct hci_dev
*hdev
= conn
->hdev
;
573 BT_DBG("%s hcon %p handle %d", hdev
->name
, conn
, conn
->handle
);
575 cancel_delayed_work_sync(&conn
->disc_work
);
576 cancel_delayed_work_sync(&conn
->auto_accept_work
);
577 cancel_delayed_work_sync(&conn
->idle_work
);
579 if (conn
->type
== ACL_LINK
) {
580 struct hci_conn
*sco
= conn
->link
;
585 hdev
->acl_cnt
+= conn
->sent
;
586 } else if (conn
->type
== LE_LINK
) {
587 cancel_delayed_work(&conn
->le_conn_timeout
);
590 hdev
->le_cnt
+= conn
->sent
;
592 hdev
->acl_cnt
+= conn
->sent
;
594 struct hci_conn
*acl
= conn
->link
;
602 amp_mgr_put(conn
->amp_mgr
);
604 skb_queue_purge(&conn
->data_q
);
606 /* Remove the connection from the list and cleanup its remaining
607 * state. This is a separate function since for some cases like
608 * BT_CONNECT_SCAN we *only* want the cleanup part without the
609 * rest of hci_conn_del.
611 hci_conn_cleanup(conn
);
616 struct hci_dev
*hci_get_route(bdaddr_t
*dst
, bdaddr_t
*src
)
618 int use_src
= bacmp(src
, BDADDR_ANY
);
619 struct hci_dev
*hdev
= NULL
, *d
;
621 BT_DBG("%pMR -> %pMR", src
, dst
);
623 read_lock(&hci_dev_list_lock
);
625 list_for_each_entry(d
, &hci_dev_list
, list
) {
626 if (!test_bit(HCI_UP
, &d
->flags
) ||
627 hci_dev_test_flag(d
, HCI_USER_CHANNEL
) ||
628 d
->dev_type
!= HCI_BREDR
)
632 * No source address - find interface with bdaddr != dst
633 * Source address - find interface with bdaddr == src
637 if (!bacmp(&d
->bdaddr
, src
)) {
641 if (bacmp(&d
->bdaddr
, dst
)) {
648 hdev
= hci_dev_hold(hdev
);
650 read_unlock(&hci_dev_list_lock
);
653 EXPORT_SYMBOL(hci_get_route
);
655 /* This function requires the caller holds hdev->lock */
656 void hci_le_conn_failed(struct hci_conn
*conn
, u8 status
)
658 struct hci_dev
*hdev
= conn
->hdev
;
659 struct hci_conn_params
*params
;
661 params
= hci_pend_le_action_lookup(&hdev
->pend_le_conns
, &conn
->dst
,
663 if (params
&& params
->conn
) {
664 hci_conn_drop(params
->conn
);
665 hci_conn_put(params
->conn
);
669 conn
->state
= BT_CLOSED
;
671 mgmt_connect_failed(hdev
, &conn
->dst
, conn
->type
, conn
->dst_type
,
674 hci_connect_cfm(conn
, status
);
678 /* Since we may have temporarily stopped the background scanning in
679 * favor of connection establishment, we should restart it.
681 hci_update_background_scan(hdev
);
683 /* Re-enable advertising in case this was a failed connection
684 * attempt as a peripheral.
686 mgmt_reenable_advertising(hdev
);
689 static void create_le_conn_complete(struct hci_dev
*hdev
, u8 status
, u16 opcode
)
691 struct hci_conn
*conn
;
695 conn
= hci_lookup_le_connect(hdev
);
698 hci_connect_le_scan_cleanup(conn
);
702 BT_ERR("HCI request failed to create LE connection: status 0x%2.2x",
708 hci_le_conn_failed(conn
, status
);
711 hci_dev_unlock(hdev
);
714 static void hci_req_add_le_create_conn(struct hci_request
*req
,
715 struct hci_conn
*conn
)
717 struct hci_cp_le_create_conn cp
;
718 struct hci_dev
*hdev
= conn
->hdev
;
721 memset(&cp
, 0, sizeof(cp
));
723 /* Update random address, but set require_privacy to false so
724 * that we never connect with an non-resolvable address.
726 if (hci_update_random_address(req
, false, &own_addr_type
))
729 cp
.scan_interval
= cpu_to_le16(hdev
->le_scan_interval
);
730 cp
.scan_window
= cpu_to_le16(hdev
->le_scan_window
);
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
);