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 static void hci_le_create_connection_cancel(struct hci_conn
*conn
)
64 hci_send_cmd(conn
->hdev
, HCI_OP_LE_CREATE_CONN_CANCEL
, 0, NULL
);
67 /* This function requires the caller holds hdev->lock */
68 static void hci_connect_le_scan_cleanup(struct hci_conn
*conn
)
70 struct hci_conn_params
*params
;
76 bdaddr_type
= conn
->dst_type
;
78 /* Check if we need to convert to identity address */
79 irk
= hci_get_irk(conn
->hdev
, bdaddr
, bdaddr_type
);
81 bdaddr
= &irk
->bdaddr
;
82 bdaddr_type
= irk
->addr_type
;
85 params
= hci_explicit_connect_lookup(conn
->hdev
, bdaddr
, bdaddr_type
);
89 /* The connection attempt was doing scan for new RPA, and is
90 * in scan phase. If params are not associated with any other
91 * autoconnect action, remove them completely. If they are, just unmark
92 * them as waiting for connection, by clearing explicit_connect field.
94 params
->explicit_connect
= false;
96 list_del_init(¶ms
->action
);
98 switch (params
->auto_connect
) {
99 case HCI_AUTO_CONN_EXPLICIT
:
100 hci_conn_params_del(conn
->hdev
, bdaddr
, bdaddr_type
);
101 /* return instead of break to avoid duplicate scan update */
103 case HCI_AUTO_CONN_DIRECT
:
104 case HCI_AUTO_CONN_ALWAYS
:
105 list_add(¶ms
->action
, &conn
->hdev
->pend_le_conns
);
107 case HCI_AUTO_CONN_REPORT
:
108 list_add(¶ms
->action
, &conn
->hdev
->pend_le_reports
);
114 hci_update_background_scan(conn
->hdev
);
117 static void hci_conn_cleanup(struct hci_conn
*conn
)
119 struct hci_dev
*hdev
= conn
->hdev
;
121 if (test_bit(HCI_CONN_PARAM_REMOVAL_PEND
, &conn
->flags
))
122 hci_conn_params_del(conn
->hdev
, &conn
->dst
, conn
->dst_type
);
124 hci_chan_list_flush(conn
);
126 hci_conn_hash_del(hdev
, conn
);
129 hdev
->notify(hdev
, HCI_NOTIFY_CONN_DEL
);
131 hci_conn_del_sysfs(conn
);
133 debugfs_remove_recursive(conn
->debugfs
);
140 /* This function requires the caller holds hdev->lock */
141 static void hci_connect_le_scan_remove(struct hci_conn
*conn
)
143 hci_connect_le_scan_cleanup(conn
);
145 /* We can't call hci_conn_del here since that would deadlock
146 * with trying to call cancel_delayed_work_sync(&conn->disc_work).
147 * Instead, call just hci_conn_cleanup() which contains the bare
148 * minimum cleanup operations needed for a connection in this
151 hci_conn_cleanup(conn
);
154 static void hci_acl_create_connection(struct hci_conn
*conn
)
156 struct hci_dev
*hdev
= conn
->hdev
;
157 struct inquiry_entry
*ie
;
158 struct hci_cp_create_conn cp
;
160 BT_DBG("hcon %p", conn
);
162 conn
->state
= BT_CONNECT
;
164 conn
->role
= HCI_ROLE_MASTER
;
168 conn
->link_policy
= hdev
->link_policy
;
170 memset(&cp
, 0, sizeof(cp
));
171 bacpy(&cp
.bdaddr
, &conn
->dst
);
172 cp
.pscan_rep_mode
= 0x02;
174 ie
= hci_inquiry_cache_lookup(hdev
, &conn
->dst
);
176 if (inquiry_entry_age(ie
) <= INQUIRY_ENTRY_AGE_MAX
) {
177 cp
.pscan_rep_mode
= ie
->data
.pscan_rep_mode
;
178 cp
.pscan_mode
= ie
->data
.pscan_mode
;
179 cp
.clock_offset
= ie
->data
.clock_offset
|
183 memcpy(conn
->dev_class
, ie
->data
.dev_class
, 3);
184 if (ie
->data
.ssp_mode
> 0)
185 set_bit(HCI_CONN_SSP_ENABLED
, &conn
->flags
);
188 cp
.pkt_type
= cpu_to_le16(conn
->pkt_type
);
189 if (lmp_rswitch_capable(hdev
) && !(hdev
->link_mode
& HCI_LM_MASTER
))
190 cp
.role_switch
= 0x01;
192 cp
.role_switch
= 0x00;
194 hci_send_cmd(hdev
, HCI_OP_CREATE_CONN
, sizeof(cp
), &cp
);
197 static void hci_acl_create_connection_cancel(struct hci_conn
*conn
)
199 struct hci_cp_create_conn_cancel cp
;
201 BT_DBG("hcon %p", conn
);
203 if (conn
->hdev
->hci_ver
< BLUETOOTH_VER_1_2
)
206 bacpy(&cp
.bdaddr
, &conn
->dst
);
207 hci_send_cmd(conn
->hdev
, HCI_OP_CREATE_CONN_CANCEL
, sizeof(cp
), &cp
);
210 static void hci_reject_sco(struct hci_conn
*conn
)
212 struct hci_cp_reject_sync_conn_req cp
;
214 cp
.reason
= HCI_ERROR_REJ_LIMITED_RESOURCES
;
215 bacpy(&cp
.bdaddr
, &conn
->dst
);
217 hci_send_cmd(conn
->hdev
, HCI_OP_REJECT_SYNC_CONN_REQ
, sizeof(cp
), &cp
);
220 int hci_disconnect(struct hci_conn
*conn
, __u8 reason
)
222 struct hci_cp_disconnect cp
;
224 BT_DBG("hcon %p", conn
);
226 /* When we are master of an established connection and it enters
227 * the disconnect timeout, then go ahead and try to read the
228 * current clock offset. Processing of the result is done
229 * within the event handling and hci_clock_offset_evt function.
231 if (conn
->type
== ACL_LINK
&& conn
->role
== HCI_ROLE_MASTER
) {
232 struct hci_dev
*hdev
= conn
->hdev
;
233 struct hci_cp_read_clock_offset clkoff_cp
;
235 clkoff_cp
.handle
= cpu_to_le16(conn
->handle
);
236 hci_send_cmd(hdev
, HCI_OP_READ_CLOCK_OFFSET
, sizeof(clkoff_cp
),
240 conn
->state
= BT_DISCONN
;
242 cp
.handle
= cpu_to_le16(conn
->handle
);
244 return hci_send_cmd(conn
->hdev
, HCI_OP_DISCONNECT
, sizeof(cp
), &cp
);
247 static void hci_amp_disconn(struct hci_conn
*conn
)
249 struct hci_cp_disconn_phy_link cp
;
251 BT_DBG("hcon %p", conn
);
253 conn
->state
= BT_DISCONN
;
255 cp
.phy_handle
= HCI_PHY_HANDLE(conn
->handle
);
256 cp
.reason
= hci_proto_disconn_ind(conn
);
257 hci_send_cmd(conn
->hdev
, HCI_OP_DISCONN_PHY_LINK
,
261 static void hci_add_sco(struct hci_conn
*conn
, __u16 handle
)
263 struct hci_dev
*hdev
= conn
->hdev
;
264 struct hci_cp_add_sco cp
;
266 BT_DBG("hcon %p", conn
);
268 conn
->state
= BT_CONNECT
;
273 cp
.handle
= cpu_to_le16(handle
);
274 cp
.pkt_type
= cpu_to_le16(conn
->pkt_type
);
276 hci_send_cmd(hdev
, HCI_OP_ADD_SCO
, sizeof(cp
), &cp
);
279 bool hci_setup_sync(struct hci_conn
*conn
, __u16 handle
)
281 struct hci_dev
*hdev
= conn
->hdev
;
282 struct hci_cp_setup_sync_conn cp
;
283 const struct sco_param
*param
;
285 BT_DBG("hcon %p", conn
);
287 conn
->state
= BT_CONNECT
;
292 cp
.handle
= cpu_to_le16(handle
);
294 cp
.tx_bandwidth
= cpu_to_le32(0x00001f40);
295 cp
.rx_bandwidth
= cpu_to_le32(0x00001f40);
296 cp
.voice_setting
= cpu_to_le16(conn
->setting
);
298 switch (conn
->setting
& SCO_AIRMODE_MASK
) {
299 case SCO_AIRMODE_TRANSP
:
300 if (conn
->attempt
> ARRAY_SIZE(esco_param_msbc
))
302 param
= &esco_param_msbc
[conn
->attempt
- 1];
304 case SCO_AIRMODE_CVSD
:
305 if (lmp_esco_capable(conn
->link
)) {
306 if (conn
->attempt
> ARRAY_SIZE(esco_param_cvsd
))
308 param
= &esco_param_cvsd
[conn
->attempt
- 1];
310 if (conn
->attempt
> ARRAY_SIZE(sco_param_cvsd
))
312 param
= &sco_param_cvsd
[conn
->attempt
- 1];
319 cp
.retrans_effort
= param
->retrans_effort
;
320 cp
.pkt_type
= __cpu_to_le16(param
->pkt_type
);
321 cp
.max_latency
= __cpu_to_le16(param
->max_latency
);
323 if (hci_send_cmd(hdev
, HCI_OP_SETUP_SYNC_CONN
, sizeof(cp
), &cp
) < 0)
329 u8
hci_le_conn_update(struct hci_conn
*conn
, u16 min
, u16 max
, u16 latency
,
332 struct hci_dev
*hdev
= conn
->hdev
;
333 struct hci_conn_params
*params
;
334 struct hci_cp_le_conn_update cp
;
338 params
= hci_conn_params_lookup(hdev
, &conn
->dst
, conn
->dst_type
);
340 params
->conn_min_interval
= min
;
341 params
->conn_max_interval
= max
;
342 params
->conn_latency
= latency
;
343 params
->supervision_timeout
= to_multiplier
;
346 hci_dev_unlock(hdev
);
348 memset(&cp
, 0, sizeof(cp
));
349 cp
.handle
= cpu_to_le16(conn
->handle
);
350 cp
.conn_interval_min
= cpu_to_le16(min
);
351 cp
.conn_interval_max
= cpu_to_le16(max
);
352 cp
.conn_latency
= cpu_to_le16(latency
);
353 cp
.supervision_timeout
= cpu_to_le16(to_multiplier
);
354 cp
.min_ce_len
= cpu_to_le16(0x0000);
355 cp
.max_ce_len
= cpu_to_le16(0x0000);
357 hci_send_cmd(hdev
, HCI_OP_LE_CONN_UPDATE
, sizeof(cp
), &cp
);
365 void hci_le_start_enc(struct hci_conn
*conn
, __le16 ediv
, __le64 rand
,
366 __u8 ltk
[16], __u8 key_size
)
368 struct hci_dev
*hdev
= conn
->hdev
;
369 struct hci_cp_le_start_enc cp
;
371 BT_DBG("hcon %p", conn
);
373 memset(&cp
, 0, sizeof(cp
));
375 cp
.handle
= cpu_to_le16(conn
->handle
);
378 memcpy(cp
.ltk
, ltk
, key_size
);
380 hci_send_cmd(hdev
, HCI_OP_LE_START_ENC
, sizeof(cp
), &cp
);
383 /* Device _must_ be locked */
384 void hci_sco_setup(struct hci_conn
*conn
, __u8 status
)
386 struct hci_conn
*sco
= conn
->link
;
391 BT_DBG("hcon %p", conn
);
394 if (lmp_esco_capable(conn
->hdev
))
395 hci_setup_sync(sco
, conn
->handle
);
397 hci_add_sco(sco
, conn
->handle
);
399 hci_connect_cfm(sco
, status
);
404 static void hci_conn_timeout(struct work_struct
*work
)
406 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
408 int refcnt
= atomic_read(&conn
->refcnt
);
410 BT_DBG("hcon %p state %s", conn
, state_to_string(conn
->state
));
414 /* FIXME: It was observed that in pairing failed scenario, refcnt
415 * drops below 0. Probably this is because l2cap_conn_del calls
416 * l2cap_chan_del for each channel, and inside l2cap_chan_del conn is
417 * dropped. After that loop hci_chan_del is called which also drops
418 * conn. For now make sure that ACL is alive if refcnt is higher then 0,
424 switch (conn
->state
) {
428 if (conn
->type
== ACL_LINK
)
429 hci_acl_create_connection_cancel(conn
);
430 else if (conn
->type
== LE_LINK
) {
431 if (test_bit(HCI_CONN_SCANNING
, &conn
->flags
))
432 hci_connect_le_scan_remove(conn
);
434 hci_le_create_connection_cancel(conn
);
436 } else if (conn
->type
== SCO_LINK
|| conn
->type
== ESCO_LINK
) {
437 hci_reject_sco(conn
);
442 if (conn
->type
== AMP_LINK
) {
443 hci_amp_disconn(conn
);
445 __u8 reason
= hci_proto_disconn_ind(conn
);
446 hci_disconnect(conn
, reason
);
450 conn
->state
= BT_CLOSED
;
455 /* Enter sniff mode */
456 static void hci_conn_idle(struct work_struct
*work
)
458 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
460 struct hci_dev
*hdev
= conn
->hdev
;
462 BT_DBG("hcon %p mode %d", conn
, conn
->mode
);
464 if (!lmp_sniff_capable(hdev
) || !lmp_sniff_capable(conn
))
467 if (conn
->mode
!= HCI_CM_ACTIVE
|| !(conn
->link_policy
& HCI_LP_SNIFF
))
470 if (lmp_sniffsubr_capable(hdev
) && lmp_sniffsubr_capable(conn
)) {
471 struct hci_cp_sniff_subrate cp
;
472 cp
.handle
= cpu_to_le16(conn
->handle
);
473 cp
.max_latency
= cpu_to_le16(0);
474 cp
.min_remote_timeout
= cpu_to_le16(0);
475 cp
.min_local_timeout
= cpu_to_le16(0);
476 hci_send_cmd(hdev
, HCI_OP_SNIFF_SUBRATE
, sizeof(cp
), &cp
);
479 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND
, &conn
->flags
)) {
480 struct hci_cp_sniff_mode cp
;
481 cp
.handle
= cpu_to_le16(conn
->handle
);
482 cp
.max_interval
= cpu_to_le16(hdev
->sniff_max_interval
);
483 cp
.min_interval
= cpu_to_le16(hdev
->sniff_min_interval
);
484 cp
.attempt
= cpu_to_le16(4);
485 cp
.timeout
= cpu_to_le16(1);
486 hci_send_cmd(hdev
, HCI_OP_SNIFF_MODE
, sizeof(cp
), &cp
);
490 static void hci_conn_auto_accept(struct work_struct
*work
)
492 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
493 auto_accept_work
.work
);
495 hci_send_cmd(conn
->hdev
, HCI_OP_USER_CONFIRM_REPLY
, sizeof(conn
->dst
),
499 static void le_conn_timeout(struct work_struct
*work
)
501 struct hci_conn
*conn
= container_of(work
, struct hci_conn
,
502 le_conn_timeout
.work
);
503 struct hci_dev
*hdev
= conn
->hdev
;
507 /* We could end up here due to having done directed advertising,
508 * so clean up the state if necessary. This should however only
509 * happen with broken hardware or if low duty cycle was used
510 * (which doesn't have a timeout of its own).
512 if (conn
->role
== HCI_ROLE_SLAVE
) {
514 hci_send_cmd(hdev
, HCI_OP_LE_SET_ADV_ENABLE
, sizeof(enable
),
516 hci_le_conn_failed(conn
, HCI_ERROR_ADVERTISING_TIMEOUT
);
520 hci_le_create_connection_cancel(conn
);
523 struct hci_conn
*hci_conn_add(struct hci_dev
*hdev
, int type
, bdaddr_t
*dst
,
526 struct hci_conn
*conn
;
528 BT_DBG("%s dst %pMR", hdev
->name
, dst
);
530 conn
= kzalloc(sizeof(*conn
), GFP_KERNEL
);
534 bacpy(&conn
->dst
, dst
);
535 bacpy(&conn
->src
, &hdev
->bdaddr
);
539 conn
->mode
= HCI_CM_ACTIVE
;
540 conn
->state
= BT_OPEN
;
541 conn
->auth_type
= HCI_AT_GENERAL_BONDING
;
542 conn
->io_capability
= hdev
->io_capability
;
543 conn
->remote_auth
= 0xff;
544 conn
->key_type
= 0xff;
545 conn
->rssi
= HCI_RSSI_INVALID
;
546 conn
->tx_power
= HCI_TX_POWER_INVALID
;
547 conn
->max_tx_power
= HCI_TX_POWER_INVALID
;
549 set_bit(HCI_CONN_POWER_SAVE
, &conn
->flags
);
550 conn
->disc_timeout
= HCI_DISCONN_TIMEOUT
;
552 if (conn
->role
== HCI_ROLE_MASTER
)
557 conn
->pkt_type
= hdev
->pkt_type
& ACL_PTYPE_MASK
;
560 /* conn->src should reflect the local identity address */
561 hci_copy_identity_address(hdev
, &conn
->src
, &conn
->src_type
);
564 if (lmp_esco_capable(hdev
))
565 conn
->pkt_type
= (hdev
->esco_type
& SCO_ESCO_MASK
) |
566 (hdev
->esco_type
& EDR_ESCO_MASK
);
568 conn
->pkt_type
= hdev
->pkt_type
& SCO_PTYPE_MASK
;
571 conn
->pkt_type
= hdev
->esco_type
& ~EDR_ESCO_MASK
;
575 skb_queue_head_init(&conn
->data_q
);
577 INIT_LIST_HEAD(&conn
->chan_list
);
579 INIT_DELAYED_WORK(&conn
->disc_work
, hci_conn_timeout
);
580 INIT_DELAYED_WORK(&conn
->auto_accept_work
, hci_conn_auto_accept
);
581 INIT_DELAYED_WORK(&conn
->idle_work
, hci_conn_idle
);
582 INIT_DELAYED_WORK(&conn
->le_conn_timeout
, le_conn_timeout
);
584 atomic_set(&conn
->refcnt
, 0);
588 hci_conn_hash_add(hdev
, conn
);
590 hdev
->notify(hdev
, HCI_NOTIFY_CONN_ADD
);
592 hci_conn_init_sysfs(conn
);
597 int hci_conn_del(struct hci_conn
*conn
)
599 struct hci_dev
*hdev
= conn
->hdev
;
601 BT_DBG("%s hcon %p handle %d", hdev
->name
, conn
, conn
->handle
);
603 cancel_delayed_work_sync(&conn
->disc_work
);
604 cancel_delayed_work_sync(&conn
->auto_accept_work
);
605 cancel_delayed_work_sync(&conn
->idle_work
);
607 if (conn
->type
== ACL_LINK
) {
608 struct hci_conn
*sco
= conn
->link
;
613 hdev
->acl_cnt
+= conn
->sent
;
614 } else if (conn
->type
== LE_LINK
) {
615 cancel_delayed_work(&conn
->le_conn_timeout
);
618 hdev
->le_cnt
+= conn
->sent
;
620 hdev
->acl_cnt
+= conn
->sent
;
622 struct hci_conn
*acl
= conn
->link
;
630 amp_mgr_put(conn
->amp_mgr
);
632 skb_queue_purge(&conn
->data_q
);
634 /* Remove the connection from the list and cleanup its remaining
635 * state. This is a separate function since for some cases like
636 * BT_CONNECT_SCAN we *only* want the cleanup part without the
637 * rest of hci_conn_del.
639 hci_conn_cleanup(conn
);
644 struct hci_dev
*hci_get_route(bdaddr_t
*dst
, bdaddr_t
*src
)
646 int use_src
= bacmp(src
, BDADDR_ANY
);
647 struct hci_dev
*hdev
= NULL
, *d
;
649 BT_DBG("%pMR -> %pMR", src
, dst
);
651 read_lock(&hci_dev_list_lock
);
653 list_for_each_entry(d
, &hci_dev_list
, list
) {
654 if (!test_bit(HCI_UP
, &d
->flags
) ||
655 hci_dev_test_flag(d
, HCI_USER_CHANNEL
) ||
656 d
->dev_type
!= HCI_BREDR
)
660 * No source address - find interface with bdaddr != dst
661 * Source address - find interface with bdaddr == src
665 if (!bacmp(&d
->bdaddr
, src
)) {
669 if (bacmp(&d
->bdaddr
, dst
)) {
676 hdev
= hci_dev_hold(hdev
);
678 read_unlock(&hci_dev_list_lock
);
681 EXPORT_SYMBOL(hci_get_route
);
683 /* This function requires the caller holds hdev->lock */
684 void hci_le_conn_failed(struct hci_conn
*conn
, u8 status
)
686 struct hci_dev
*hdev
= conn
->hdev
;
687 struct hci_conn_params
*params
;
689 params
= hci_pend_le_action_lookup(&hdev
->pend_le_conns
, &conn
->dst
,
691 if (params
&& params
->conn
) {
692 hci_conn_drop(params
->conn
);
693 hci_conn_put(params
->conn
);
697 conn
->state
= BT_CLOSED
;
699 mgmt_connect_failed(hdev
, &conn
->dst
, conn
->type
, conn
->dst_type
,
702 hci_connect_cfm(conn
, status
);
706 /* Since we may have temporarily stopped the background scanning in
707 * favor of connection establishment, we should restart it.
709 hci_update_background_scan(hdev
);
711 /* Re-enable advertising in case this was a failed connection
712 * attempt as a peripheral.
714 mgmt_reenable_advertising(hdev
);
717 static void create_le_conn_complete(struct hci_dev
*hdev
, u8 status
, u16 opcode
)
719 struct hci_conn
*conn
;
723 conn
= hci_lookup_le_connect(hdev
);
726 hci_connect_le_scan_cleanup(conn
);
730 BT_ERR("HCI request failed to create LE connection: status 0x%2.2x",
736 hci_le_conn_failed(conn
, status
);
739 hci_dev_unlock(hdev
);
742 static void hci_req_add_le_create_conn(struct hci_request
*req
,
743 struct hci_conn
*conn
)
745 struct hci_cp_le_create_conn cp
;
746 struct hci_dev
*hdev
= conn
->hdev
;
749 memset(&cp
, 0, sizeof(cp
));
751 /* Update random address, but set require_privacy to false so
752 * that we never connect with an non-resolvable address.
754 if (hci_update_random_address(req
, false, &own_addr_type
))
757 cp
.scan_interval
= cpu_to_le16(hdev
->le_scan_interval
);
758 cp
.scan_window
= cpu_to_le16(hdev
->le_scan_window
);
759 bacpy(&cp
.peer_addr
, &conn
->dst
);
760 cp
.peer_addr_type
= conn
->dst_type
;
761 cp
.own_address_type
= own_addr_type
;
762 cp
.conn_interval_min
= cpu_to_le16(conn
->le_conn_min_interval
);
763 cp
.conn_interval_max
= cpu_to_le16(conn
->le_conn_max_interval
);
764 cp
.conn_latency
= cpu_to_le16(conn
->le_conn_latency
);
765 cp
.supervision_timeout
= cpu_to_le16(conn
->le_supv_timeout
);
766 cp
.min_ce_len
= cpu_to_le16(0x0000);
767 cp
.max_ce_len
= cpu_to_le16(0x0000);
769 hci_req_add(req
, HCI_OP_LE_CREATE_CONN
, sizeof(cp
), &cp
);
771 conn
->state
= BT_CONNECT
;
772 clear_bit(HCI_CONN_SCANNING
, &conn
->flags
);
775 static void hci_req_directed_advertising(struct hci_request
*req
,
776 struct hci_conn
*conn
)
778 struct hci_dev
*hdev
= req
->hdev
;
779 struct hci_cp_le_set_adv_param cp
;
783 /* Clear the HCI_LE_ADV bit temporarily so that the
784 * hci_update_random_address knows that it's safe to go ahead
785 * and write a new random address. The flag will be set back on
786 * as soon as the SET_ADV_ENABLE HCI command completes.
788 hci_dev_clear_flag(hdev
, HCI_LE_ADV
);
790 /* Set require_privacy to false so that the remote device has a
791 * chance of identifying us.
793 if (hci_update_random_address(req
, false, &own_addr_type
) < 0)
796 memset(&cp
, 0, sizeof(cp
));
797 cp
.type
= LE_ADV_DIRECT_IND
;
798 cp
.own_address_type
= own_addr_type
;
799 cp
.direct_addr_type
= conn
->dst_type
;
800 bacpy(&cp
.direct_addr
, &conn
->dst
);
801 cp
.channel_map
= hdev
->le_adv_channel_map
;
803 hci_req_add(req
, HCI_OP_LE_SET_ADV_PARAM
, sizeof(cp
), &cp
);
806 hci_req_add(req
, HCI_OP_LE_SET_ADV_ENABLE
, sizeof(enable
), &enable
);
808 conn
->state
= BT_CONNECT
;
811 struct hci_conn
*hci_connect_le(struct hci_dev
*hdev
, bdaddr_t
*dst
,
812 u8 dst_type
, u8 sec_level
, u16 conn_timeout
,
815 struct hci_conn_params
*params
;
816 struct hci_conn
*conn
, *conn_unfinished
;
818 struct hci_request req
;
821 /* Let's make sure that le is enabled.*/
822 if (!hci_dev_test_flag(hdev
, HCI_LE_ENABLED
)) {
823 if (lmp_le_capable(hdev
))
824 return ERR_PTR(-ECONNREFUSED
);
826 return ERR_PTR(-EOPNOTSUPP
);
829 /* Some devices send ATT messages as soon as the physical link is
830 * established. To be able to handle these ATT messages, the user-
831 * space first establishes the connection and then starts the pairing
834 * So if a hci_conn object already exists for the following connection
835 * attempt, we simply update pending_sec_level and auth_type fields
836 * and return the object found.
838 conn
= hci_conn_hash_lookup_ba(hdev
, LE_LINK
, dst
);
839 conn_unfinished
= NULL
;
841 if (conn
->state
== BT_CONNECT
&&
842 test_bit(HCI_CONN_SCANNING
, &conn
->flags
)) {
843 BT_DBG("will continue unfinished conn %pMR", dst
);
844 conn_unfinished
= conn
;
846 if (conn
->pending_sec_level
< sec_level
)
847 conn
->pending_sec_level
= sec_level
;
852 /* Since the controller supports only one LE connection attempt at a
853 * time, we return -EBUSY if there is any connection attempt running.
855 if (hci_lookup_le_connect(hdev
))
856 return ERR_PTR(-EBUSY
);
858 /* When given an identity address with existing identity
859 * resolving key, the connection needs to be established
860 * to a resolvable random address.
862 * Storing the resolvable random address is required here
863 * to handle connection failures. The address will later
864 * be resolved back into the original identity address
865 * from the connect request.
867 irk
= hci_find_irk_by_addr(hdev
, dst
, dst_type
);
868 if (irk
&& bacmp(&irk
->rpa
, BDADDR_ANY
)) {
870 dst_type
= ADDR_LE_DEV_RANDOM
;
873 if (conn_unfinished
) {
874 conn
= conn_unfinished
;
875 bacpy(&conn
->dst
, dst
);
877 conn
= hci_conn_add(hdev
, LE_LINK
, dst
, role
);
881 return ERR_PTR(-ENOMEM
);
883 conn
->dst_type
= dst_type
;
884 conn
->sec_level
= BT_SECURITY_LOW
;
885 conn
->conn_timeout
= conn_timeout
;
887 if (!conn_unfinished
)
888 conn
->pending_sec_level
= sec_level
;
890 hci_req_init(&req
, hdev
);
892 /* Disable advertising if we're active. For master role
893 * connections most controllers will refuse to connect if
894 * advertising is enabled, and for slave role connections we
895 * anyway have to disable it in order to start directed
898 if (hci_dev_test_flag(hdev
, HCI_LE_ADV
)) {
900 hci_req_add(&req
, HCI_OP_LE_SET_ADV_ENABLE
, sizeof(enable
),
904 /* If requested to connect as slave use directed advertising */
905 if (conn
->role
== HCI_ROLE_SLAVE
) {
906 /* If we're active scanning most controllers are unable
907 * to initiate advertising. Simply reject the attempt.
909 if (hci_dev_test_flag(hdev
, HCI_LE_SCAN
) &&
910 hdev
->le_scan_type
== LE_SCAN_ACTIVE
) {
911 skb_queue_purge(&req
.cmd_q
);
913 return ERR_PTR(-EBUSY
);
916 hci_req_directed_advertising(&req
, conn
);
920 params
= hci_conn_params_lookup(hdev
, &conn
->dst
, conn
->dst_type
);
922 conn
->le_conn_min_interval
= params
->conn_min_interval
;
923 conn
->le_conn_max_interval
= params
->conn_max_interval
;
924 conn
->le_conn_latency
= params
->conn_latency
;
925 conn
->le_supv_timeout
= params
->supervision_timeout
;
927 conn
->le_conn_min_interval
= hdev
->le_conn_min_interval
;
928 conn
->le_conn_max_interval
= hdev
->le_conn_max_interval
;
929 conn
->le_conn_latency
= hdev
->le_conn_latency
;
930 conn
->le_supv_timeout
= hdev
->le_supv_timeout
;
933 /* If controller is scanning, we stop it since some controllers are
934 * not able to scan and connect at the same time. Also set the
935 * HCI_LE_SCAN_INTERRUPTED flag so that the command complete
936 * handler for scan disabling knows to set the correct discovery
939 if (hci_dev_test_flag(hdev
, HCI_LE_SCAN
)) {
940 hci_req_add_le_scan_disable(&req
);
941 hci_dev_set_flag(hdev
, HCI_LE_SCAN_INTERRUPTED
);
944 hci_req_add_le_create_conn(&req
, conn
);
947 err
= hci_req_run(&req
, create_le_conn_complete
);
954 /* If this is continuation of connect started by hci_connect_le_scan,
955 * it already called hci_conn_hold and calling it again would mess the
958 if (!conn_unfinished
)
964 static void hci_connect_le_scan_complete(struct hci_dev
*hdev
, u8 status
,
967 struct hci_conn
*conn
;
972 BT_ERR("Failed to add device to auto conn whitelist: status 0x%2.2x",
977 conn
= hci_conn_hash_lookup_state(hdev
, LE_LINK
, BT_CONNECT
);
979 hci_le_conn_failed(conn
, status
);
981 hci_dev_unlock(hdev
);
984 static bool is_connected(struct hci_dev
*hdev
, bdaddr_t
*addr
, u8 type
)
986 struct hci_conn
*conn
;
988 conn
= hci_conn_hash_lookup_ba(hdev
, LE_LINK
, addr
);
992 if (conn
->dst_type
!= type
)
995 if (conn
->state
!= BT_CONNECTED
)
1001 /* This function requires the caller holds hdev->lock */
1002 static int hci_explicit_conn_params_set(struct hci_request
*req
,
1003 bdaddr_t
*addr
, u8 addr_type
)
1005 struct hci_dev
*hdev
= req
->hdev
;
1006 struct hci_conn_params
*params
;
1008 if (is_connected(hdev
, addr
, addr_type
))
1011 params
= hci_conn_params_add(hdev
, addr
, addr_type
);
1015 /* If we created new params, or existing params were marked as disabled,
1016 * mark them to be used just once to connect.
1018 if (params
->auto_connect
== HCI_AUTO_CONN_DISABLED
||
1019 params
->auto_connect
== HCI_AUTO_CONN_REPORT
) {
1020 list_del_init(¶ms
->action
);
1021 list_add(¶ms
->action
, &hdev
->pend_le_conns
);
1024 params
->explicit_connect
= true;
1025 __hci_update_background_scan(req
);
1027 BT_DBG("addr %pMR (type %u) auto_connect %u", addr
, addr_type
,
1028 params
->auto_connect
);
1033 /* This function requires the caller holds hdev->lock */
1034 struct hci_conn
*hci_connect_le_scan(struct hci_dev
*hdev
, bdaddr_t
*dst
,
1035 u8 dst_type
, u8 sec_level
,
1036 u16 conn_timeout
, u8 role
)
1038 struct hci_conn
*conn
;
1039 struct hci_request req
;
1042 /* Let's make sure that le is enabled.*/
1043 if (!hci_dev_test_flag(hdev
, HCI_LE_ENABLED
)) {
1044 if (lmp_le_capable(hdev
))
1045 return ERR_PTR(-ECONNREFUSED
);
1047 return ERR_PTR(-EOPNOTSUPP
);
1050 /* Some devices send ATT messages as soon as the physical link is
1051 * established. To be able to handle these ATT messages, the user-
1052 * space first establishes the connection and then starts the pairing
1055 * So if a hci_conn object already exists for the following connection
1056 * attempt, we simply update pending_sec_level and auth_type fields
1057 * and return the object found.
1059 conn
= hci_conn_hash_lookup_ba(hdev
, LE_LINK
, dst
);
1061 if (conn
->pending_sec_level
< sec_level
)
1062 conn
->pending_sec_level
= sec_level
;
1066 BT_DBG("requesting refresh of dst_addr");
1068 conn
= hci_conn_add(hdev
, LE_LINK
, dst
, role
);
1070 return ERR_PTR(-ENOMEM
);
1072 hci_req_init(&req
, hdev
);
1074 if (hci_explicit_conn_params_set(&req
, dst
, dst_type
) < 0)
1075 return ERR_PTR(-EBUSY
);
1077 conn
->state
= BT_CONNECT
;
1078 set_bit(HCI_CONN_SCANNING
, &conn
->flags
);
1080 err
= hci_req_run(&req
, hci_connect_le_scan_complete
);
1081 if (err
&& err
!= -ENODATA
) {
1083 return ERR_PTR(err
);
1086 conn
->dst_type
= dst_type
;
1087 conn
->sec_level
= BT_SECURITY_LOW
;
1088 conn
->pending_sec_level
= sec_level
;
1089 conn
->conn_timeout
= conn_timeout
;
1092 hci_conn_hold(conn
);
1096 struct hci_conn
*hci_connect_acl(struct hci_dev
*hdev
, bdaddr_t
*dst
,
1097 u8 sec_level
, u8 auth_type
)
1099 struct hci_conn
*acl
;
1101 if (!hci_dev_test_flag(hdev
, HCI_BREDR_ENABLED
)) {
1102 if (lmp_bredr_capable(hdev
))
1103 return ERR_PTR(-ECONNREFUSED
);
1105 return ERR_PTR(-EOPNOTSUPP
);
1108 acl
= hci_conn_hash_lookup_ba(hdev
, ACL_LINK
, dst
);
1110 acl
= hci_conn_add(hdev
, ACL_LINK
, dst
, HCI_ROLE_MASTER
);
1112 return ERR_PTR(-ENOMEM
);
1117 if (acl
->state
== BT_OPEN
|| acl
->state
== BT_CLOSED
) {
1118 acl
->sec_level
= BT_SECURITY_LOW
;
1119 acl
->pending_sec_level
= sec_level
;
1120 acl
->auth_type
= auth_type
;
1121 hci_acl_create_connection(acl
);
1127 struct hci_conn
*hci_connect_sco(struct hci_dev
*hdev
, int type
, bdaddr_t
*dst
,
1130 struct hci_conn
*acl
;
1131 struct hci_conn
*sco
;
1133 acl
= hci_connect_acl(hdev
, dst
, BT_SECURITY_LOW
, HCI_AT_NO_BONDING
);
1137 sco
= hci_conn_hash_lookup_ba(hdev
, type
, dst
);
1139 sco
= hci_conn_add(hdev
, type
, dst
, HCI_ROLE_MASTER
);
1142 return ERR_PTR(-ENOMEM
);
1151 sco
->setting
= setting
;
1153 if (acl
->state
== BT_CONNECTED
&&
1154 (sco
->state
== BT_OPEN
|| sco
->state
== BT_CLOSED
)) {
1155 set_bit(HCI_CONN_POWER_SAVE
, &acl
->flags
);
1156 hci_conn_enter_active_mode(acl
, BT_POWER_FORCE_ACTIVE_ON
);
1158 if (test_bit(HCI_CONN_MODE_CHANGE_PEND
, &acl
->flags
)) {
1159 /* defer SCO setup until mode change completed */
1160 set_bit(HCI_CONN_SCO_SETUP_PEND
, &acl
->flags
);
1164 hci_sco_setup(acl
, 0x00);
1170 /* Check link security requirement */
1171 int hci_conn_check_link_mode(struct hci_conn
*conn
)
1173 BT_DBG("hcon %p", conn
);
1175 /* In Secure Connections Only mode, it is required that Secure
1176 * Connections is used and the link is encrypted with AES-CCM
1177 * using a P-256 authenticated combination key.
1179 if (hci_dev_test_flag(conn
->hdev
, HCI_SC_ONLY
)) {
1180 if (!hci_conn_sc_enabled(conn
) ||
1181 !test_bit(HCI_CONN_AES_CCM
, &conn
->flags
) ||
1182 conn
->key_type
!= HCI_LK_AUTH_COMBINATION_P256
)
1186 if (hci_conn_ssp_enabled(conn
) &&
1187 !test_bit(HCI_CONN_ENCRYPT
, &conn
->flags
))
1193 /* Authenticate remote device */
1194 static int hci_conn_auth(struct hci_conn
*conn
, __u8 sec_level
, __u8 auth_type
)
1196 BT_DBG("hcon %p", conn
);
1198 if (conn
->pending_sec_level
> sec_level
)
1199 sec_level
= conn
->pending_sec_level
;
1201 if (sec_level
> conn
->sec_level
)
1202 conn
->pending_sec_level
= sec_level
;
1203 else if (test_bit(HCI_CONN_AUTH
, &conn
->flags
))
1206 /* Make sure we preserve an existing MITM requirement*/
1207 auth_type
|= (conn
->auth_type
& 0x01);
1209 conn
->auth_type
= auth_type
;
1211 if (!test_and_set_bit(HCI_CONN_AUTH_PEND
, &conn
->flags
)) {
1212 struct hci_cp_auth_requested cp
;
1214 cp
.handle
= cpu_to_le16(conn
->handle
);
1215 hci_send_cmd(conn
->hdev
, HCI_OP_AUTH_REQUESTED
,
1218 /* If we're already encrypted set the REAUTH_PEND flag,
1219 * otherwise set the ENCRYPT_PEND.
1221 if (test_bit(HCI_CONN_ENCRYPT
, &conn
->flags
))
1222 set_bit(HCI_CONN_REAUTH_PEND
, &conn
->flags
);
1224 set_bit(HCI_CONN_ENCRYPT_PEND
, &conn
->flags
);
1230 /* Encrypt the the link */
1231 static void hci_conn_encrypt(struct hci_conn
*conn
)
1233 BT_DBG("hcon %p", conn
);
1235 if (!test_and_set_bit(HCI_CONN_ENCRYPT_PEND
, &conn
->flags
)) {
1236 struct hci_cp_set_conn_encrypt cp
;
1237 cp
.handle
= cpu_to_le16(conn
->handle
);
1239 hci_send_cmd(conn
->hdev
, HCI_OP_SET_CONN_ENCRYPT
, sizeof(cp
),
1244 /* Enable security */
1245 int hci_conn_security(struct hci_conn
*conn
, __u8 sec_level
, __u8 auth_type
,
1248 BT_DBG("hcon %p", conn
);
1250 if (conn
->type
== LE_LINK
)
1251 return smp_conn_security(conn
, sec_level
);
1253 /* For sdp we don't need the link key. */
1254 if (sec_level
== BT_SECURITY_SDP
)
1257 /* For non 2.1 devices and low security level we don't need the link
1259 if (sec_level
== BT_SECURITY_LOW
&& !hci_conn_ssp_enabled(conn
))
1262 /* For other security levels we need the link key. */
1263 if (!test_bit(HCI_CONN_AUTH
, &conn
->flags
))
1266 /* An authenticated FIPS approved combination key has sufficient
1267 * security for security level 4. */
1268 if (conn
->key_type
== HCI_LK_AUTH_COMBINATION_P256
&&
1269 sec_level
== BT_SECURITY_FIPS
)
1272 /* An authenticated combination key has sufficient security for
1273 security level 3. */
1274 if ((conn
->key_type
== HCI_LK_AUTH_COMBINATION_P192
||
1275 conn
->key_type
== HCI_LK_AUTH_COMBINATION_P256
) &&
1276 sec_level
== BT_SECURITY_HIGH
)
1279 /* An unauthenticated combination key has sufficient security for
1280 security level 1 and 2. */
1281 if ((conn
->key_type
== HCI_LK_UNAUTH_COMBINATION_P192
||
1282 conn
->key_type
== HCI_LK_UNAUTH_COMBINATION_P256
) &&
1283 (sec_level
== BT_SECURITY_MEDIUM
|| sec_level
== BT_SECURITY_LOW
))
1286 /* A combination key has always sufficient security for the security
1287 levels 1 or 2. High security level requires the combination key
1288 is generated using maximum PIN code length (16).
1289 For pre 2.1 units. */
1290 if (conn
->key_type
== HCI_LK_COMBINATION
&&
1291 (sec_level
== BT_SECURITY_MEDIUM
|| sec_level
== BT_SECURITY_LOW
||
1292 conn
->pin_length
== 16))
1296 if (test_bit(HCI_CONN_ENCRYPT_PEND
, &conn
->flags
))
1300 set_bit(HCI_CONN_AUTH_INITIATOR
, &conn
->flags
);
1302 if (!hci_conn_auth(conn
, sec_level
, auth_type
))
1306 if (test_bit(HCI_CONN_ENCRYPT
, &conn
->flags
))
1309 hci_conn_encrypt(conn
);
1312 EXPORT_SYMBOL(hci_conn_security
);
1314 /* Check secure link requirement */
1315 int hci_conn_check_secure(struct hci_conn
*conn
, __u8 sec_level
)
1317 BT_DBG("hcon %p", conn
);
1319 /* Accept if non-secure or higher security level is required */
1320 if (sec_level
!= BT_SECURITY_HIGH
&& sec_level
!= BT_SECURITY_FIPS
)
1323 /* Accept if secure or higher security level is already present */
1324 if (conn
->sec_level
== BT_SECURITY_HIGH
||
1325 conn
->sec_level
== BT_SECURITY_FIPS
)
1328 /* Reject not secure link */
1331 EXPORT_SYMBOL(hci_conn_check_secure
);
1334 int hci_conn_switch_role(struct hci_conn
*conn
, __u8 role
)
1336 BT_DBG("hcon %p", conn
);
1338 if (role
== conn
->role
)
1341 if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND
, &conn
->flags
)) {
1342 struct hci_cp_switch_role cp
;
1343 bacpy(&cp
.bdaddr
, &conn
->dst
);
1345 hci_send_cmd(conn
->hdev
, HCI_OP_SWITCH_ROLE
, sizeof(cp
), &cp
);
1350 EXPORT_SYMBOL(hci_conn_switch_role
);
1352 /* Enter active mode */
1353 void hci_conn_enter_active_mode(struct hci_conn
*conn
, __u8 force_active
)
1355 struct hci_dev
*hdev
= conn
->hdev
;
1357 BT_DBG("hcon %p mode %d", conn
, conn
->mode
);
1359 if (conn
->mode
!= HCI_CM_SNIFF
)
1362 if (!test_bit(HCI_CONN_POWER_SAVE
, &conn
->flags
) && !force_active
)
1365 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND
, &conn
->flags
)) {
1366 struct hci_cp_exit_sniff_mode cp
;
1367 cp
.handle
= cpu_to_le16(conn
->handle
);
1368 hci_send_cmd(hdev
, HCI_OP_EXIT_SNIFF_MODE
, sizeof(cp
), &cp
);
1372 if (hdev
->idle_timeout
> 0)
1373 queue_delayed_work(hdev
->workqueue
, &conn
->idle_work
,
1374 msecs_to_jiffies(hdev
->idle_timeout
));
1377 /* Drop all connection on the device */
1378 void hci_conn_hash_flush(struct hci_dev
*hdev
)
1380 struct hci_conn_hash
*h
= &hdev
->conn_hash
;
1381 struct hci_conn
*c
, *n
;
1383 BT_DBG("hdev %s", hdev
->name
);
1385 list_for_each_entry_safe(c
, n
, &h
->list
, list
) {
1386 c
->state
= BT_CLOSED
;
1388 hci_disconn_cfm(c
, HCI_ERROR_LOCAL_HOST_TERM
);
1393 /* Check pending connect attempts */
1394 void hci_conn_check_pending(struct hci_dev
*hdev
)
1396 struct hci_conn
*conn
;
1398 BT_DBG("hdev %s", hdev
->name
);
1402 conn
= hci_conn_hash_lookup_state(hdev
, ACL_LINK
, BT_CONNECT2
);
1404 hci_acl_create_connection(conn
);
1406 hci_dev_unlock(hdev
);
1409 static u32
get_link_mode(struct hci_conn
*conn
)
1413 if (conn
->role
== HCI_ROLE_MASTER
)
1414 link_mode
|= HCI_LM_MASTER
;
1416 if (test_bit(HCI_CONN_ENCRYPT
, &conn
->flags
))
1417 link_mode
|= HCI_LM_ENCRYPT
;
1419 if (test_bit(HCI_CONN_AUTH
, &conn
->flags
))
1420 link_mode
|= HCI_LM_AUTH
;
1422 if (test_bit(HCI_CONN_SECURE
, &conn
->flags
))
1423 link_mode
|= HCI_LM_SECURE
;
1425 if (test_bit(HCI_CONN_FIPS
, &conn
->flags
))
1426 link_mode
|= HCI_LM_FIPS
;
1431 int hci_get_conn_list(void __user
*arg
)
1434 struct hci_conn_list_req req
, *cl
;
1435 struct hci_conn_info
*ci
;
1436 struct hci_dev
*hdev
;
1437 int n
= 0, size
, err
;
1439 if (copy_from_user(&req
, arg
, sizeof(req
)))
1442 if (!req
.conn_num
|| req
.conn_num
> (PAGE_SIZE
* 2) / sizeof(*ci
))
1445 size
= sizeof(req
) + req
.conn_num
* sizeof(*ci
);
1447 cl
= kmalloc(size
, GFP_KERNEL
);
1451 hdev
= hci_dev_get(req
.dev_id
);
1460 list_for_each_entry(c
, &hdev
->conn_hash
.list
, list
) {
1461 bacpy(&(ci
+ n
)->bdaddr
, &c
->dst
);
1462 (ci
+ n
)->handle
= c
->handle
;
1463 (ci
+ n
)->type
= c
->type
;
1464 (ci
+ n
)->out
= c
->out
;
1465 (ci
+ n
)->state
= c
->state
;
1466 (ci
+ n
)->link_mode
= get_link_mode(c
);
1467 if (++n
>= req
.conn_num
)
1470 hci_dev_unlock(hdev
);
1472 cl
->dev_id
= hdev
->id
;
1474 size
= sizeof(req
) + n
* sizeof(*ci
);
1478 err
= copy_to_user(arg
, cl
, size
);
1481 return err
? -EFAULT
: 0;
1484 int hci_get_conn_info(struct hci_dev
*hdev
, void __user
*arg
)
1486 struct hci_conn_info_req req
;
1487 struct hci_conn_info ci
;
1488 struct hci_conn
*conn
;
1489 char __user
*ptr
= arg
+ sizeof(req
);
1491 if (copy_from_user(&req
, arg
, sizeof(req
)))
1495 conn
= hci_conn_hash_lookup_ba(hdev
, req
.type
, &req
.bdaddr
);
1497 bacpy(&ci
.bdaddr
, &conn
->dst
);
1498 ci
.handle
= conn
->handle
;
1499 ci
.type
= conn
->type
;
1501 ci
.state
= conn
->state
;
1502 ci
.link_mode
= get_link_mode(conn
);
1504 hci_dev_unlock(hdev
);
1509 return copy_to_user(ptr
, &ci
, sizeof(ci
)) ? -EFAULT
: 0;
1512 int hci_get_auth_info(struct hci_dev
*hdev
, void __user
*arg
)
1514 struct hci_auth_info_req req
;
1515 struct hci_conn
*conn
;
1517 if (copy_from_user(&req
, arg
, sizeof(req
)))
1521 conn
= hci_conn_hash_lookup_ba(hdev
, ACL_LINK
, &req
.bdaddr
);
1523 req
.type
= conn
->auth_type
;
1524 hci_dev_unlock(hdev
);
1529 return copy_to_user(arg
, &req
, sizeof(req
)) ? -EFAULT
: 0;
1532 struct hci_chan
*hci_chan_create(struct hci_conn
*conn
)
1534 struct hci_dev
*hdev
= conn
->hdev
;
1535 struct hci_chan
*chan
;
1537 BT_DBG("%s hcon %p", hdev
->name
, conn
);
1539 if (test_bit(HCI_CONN_DROP
, &conn
->flags
)) {
1540 BT_DBG("Refusing to create new hci_chan");
1544 chan
= kzalloc(sizeof(*chan
), GFP_KERNEL
);
1548 chan
->conn
= hci_conn_get(conn
);
1549 skb_queue_head_init(&chan
->data_q
);
1550 chan
->state
= BT_CONNECTED
;
1552 list_add_rcu(&chan
->list
, &conn
->chan_list
);
1557 void hci_chan_del(struct hci_chan
*chan
)
1559 struct hci_conn
*conn
= chan
->conn
;
1560 struct hci_dev
*hdev
= conn
->hdev
;
1562 BT_DBG("%s hcon %p chan %p", hdev
->name
, conn
, chan
);
1564 list_del_rcu(&chan
->list
);
1568 /* Prevent new hci_chan's to be created for this hci_conn */
1569 set_bit(HCI_CONN_DROP
, &conn
->flags
);
1573 skb_queue_purge(&chan
->data_q
);
1577 void hci_chan_list_flush(struct hci_conn
*conn
)
1579 struct hci_chan
*chan
, *n
;
1581 BT_DBG("hcon %p", conn
);
1583 list_for_each_entry_safe(chan
, n
, &conn
->chan_list
, list
)
1587 static struct hci_chan
*__hci_chan_lookup_handle(struct hci_conn
*hcon
,
1590 struct hci_chan
*hchan
;
1592 list_for_each_entry(hchan
, &hcon
->chan_list
, list
) {
1593 if (hchan
->handle
== handle
)
1600 struct hci_chan
*hci_chan_lookup_handle(struct hci_dev
*hdev
, __u16 handle
)
1602 struct hci_conn_hash
*h
= &hdev
->conn_hash
;
1603 struct hci_conn
*hcon
;
1604 struct hci_chan
*hchan
= NULL
;
1608 list_for_each_entry_rcu(hcon
, &h
->list
, list
) {
1609 hchan
= __hci_chan_lookup_handle(hcon
, handle
);