blob: 534feb7956a33302264133df30552b698e475c32 [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
Ron Shaffer2d0a0342010-05-28 11:53:46 -04003 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07004
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
10
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI connection handling. */
26
Gustavo Padovan8c520a52012-05-23 04:04:22 -030027#include <linux/export.h>
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +010028#include <linux/debugfs.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029
30#include <net/bluetooth/bluetooth.h>
31#include <net/bluetooth/hci_core.h>
Johan Hedberg4bc58f52014-05-20 09:45:47 +030032#include <net/bluetooth/l2cap.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033
Johan Hedberg0857dd32014-12-19 13:40:20 +020034#include "hci_request.h"
Marcel Holtmannac4b7232013-10-10 14:54:16 -070035#include "smp.h"
Marcel Holtmann70247282013-10-10 14:54:15 -070036#include "a2mp.h"
37
Frédéric Dalleau2dea6322013-08-19 14:24:03 +020038struct sco_param {
39 u16 pkt_type;
40 u16 max_latency;
Johan Hedbergc7da5792014-09-24 22:41:46 +030041 u8 retrans_effort;
Frédéric Dalleau2dea6322013-08-19 14:24:03 +020042};
43
Bernhard Thaler48e68ff2014-09-23 11:01:07 +020044static const struct sco_param esco_param_cvsd[] = {
Johan Hedbergc7da5792014-09-24 22:41:46 +030045 { 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 */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +020050};
51
Bernhard Thaler48e68ff2014-09-23 11:01:07 +020052static const struct sco_param sco_param_cvsd[] = {
Johan Hedbergc7da5792014-09-24 22:41:46 +030053 { EDR_ESCO_MASK | ESCO_HV3, 0xffff, 0xff }, /* D1 */
54 { EDR_ESCO_MASK | ESCO_HV1, 0xffff, 0xff }, /* D0 */
Bernhard Thaler48e68ff2014-09-23 11:01:07 +020055};
56
Johan Hedberg565766b2014-09-25 09:48:01 +030057static const struct sco_param esco_param_msbc[] = {
Johan Hedbergc7da5792014-09-24 22:41:46 +030058 { EDR_ESCO_MASK & ~ESCO_2EV3, 0x000d, 0x02 }, /* T2 */
59 { EDR_ESCO_MASK | ESCO_EV3, 0x0008, 0x02 }, /* T1 */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +020060};
61
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -030062static void hci_le_create_connection_cancel(struct hci_conn *conn)
Ville Tervofcd89c02011-02-10 22:38:47 -030063{
64 hci_send_cmd(conn->hdev, HCI_OP_LE_CREATE_CONN_CANCEL, 0, NULL);
65}
66
Jakub Pawlowskif75113a2015-08-07 20:22:53 +020067/* This function requires the caller holds hdev->lock */
68static void hci_connect_le_scan_cleanup(struct hci_conn *conn)
69{
70 struct hci_conn_params *params;
71 struct smp_irk *irk;
72 bdaddr_t *bdaddr;
73 u8 bdaddr_type;
74
75 bdaddr = &conn->dst;
76 bdaddr_type = conn->dst_type;
77
78 /* Check if we need to convert to identity address */
79 irk = hci_get_irk(conn->hdev, bdaddr, bdaddr_type);
80 if (irk) {
81 bdaddr = &irk->bdaddr;
82 bdaddr_type = irk->addr_type;
83 }
84
85 params = hci_explicit_connect_lookup(conn->hdev, bdaddr, bdaddr_type);
86 if (!params)
87 return;
88
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.
93 */
94 if (params->auto_connect == HCI_AUTO_CONN_EXPLICIT)
95 hci_conn_params_del(conn->hdev, bdaddr, bdaddr_type);
96 else
97 params->explicit_connect = false;
98}
99
100/* This function requires the caller holds hdev->lock */
101static void hci_connect_le_scan_remove(struct hci_conn *conn)
102{
103 hci_connect_le_scan_cleanup(conn);
104
105 hci_conn_hash_del(conn->hdev, conn);
106 hci_update_background_scan(conn->hdev);
107}
108
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -0300109static void hci_acl_create_connection(struct hci_conn *conn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110{
111 struct hci_dev *hdev = conn->hdev;
112 struct inquiry_entry *ie;
113 struct hci_cp_create_conn cp;
114
Andrei Emeltchenko42d2d872012-02-17 11:40:57 +0200115 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700116
117 conn->state = BT_CONNECT;
Johan Hedberga0c808b2012-01-16 09:49:58 +0200118 conn->out = true;
Johan Hedberg40bef302014-07-16 11:42:27 +0300119 conn->role = HCI_ROLE_MASTER;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700120
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200121 conn->attempt++;
122
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200123 conn->link_policy = hdev->link_policy;
124
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 memset(&cp, 0, sizeof(cp));
126 bacpy(&cp.bdaddr, &conn->dst);
127 cp.pscan_rep_mode = 0x02;
128
Andrei Emeltchenko70f230202010-12-01 16:58:25 +0200129 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
130 if (ie) {
Marcel Holtmann41a96212008-07-14 20:13:48 +0200131 if (inquiry_entry_age(ie) <= INQUIRY_ENTRY_AGE_MAX) {
132 cp.pscan_rep_mode = ie->data.pscan_rep_mode;
133 cp.pscan_mode = ie->data.pscan_mode;
134 cp.clock_offset = ie->data.clock_offset |
Joe Perchesdcf4adb2014-03-12 10:52:35 -0700135 cpu_to_le16(0x8000);
Marcel Holtmann41a96212008-07-14 20:13:48 +0200136 }
137
Linus Torvalds1da177e2005-04-16 15:20:36 -0700138 memcpy(conn->dev_class, ie->data.dev_class, 3);
Johan Hedberg58a681e2012-01-16 06:47:28 +0200139 if (ie->data.ssp_mode > 0)
140 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700141 }
142
Marcel Holtmanna8746412008-07-14 20:13:46 +0200143 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700144 if (lmp_rswitch_capable(hdev) && !(hdev->link_mode & HCI_LM_MASTER))
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200145 cp.role_switch = 0x01;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146 else
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200147 cp.role_switch = 0x00;
Marcel Holtmann4c67bc72006-10-15 17:30:56 +0200148
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200149 hci_send_cmd(hdev, HCI_OP_CREATE_CONN, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150}
151
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -0300152static void hci_acl_create_connection_cancel(struct hci_conn *conn)
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200153{
154 struct hci_cp_create_conn_cancel cp;
155
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300156 BT_DBG("hcon %p", conn);
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200157
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +0200158 if (conn->hdev->hci_ver < BLUETOOTH_VER_1_2)
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200159 return;
160
161 bacpy(&cp.bdaddr, &conn->dst);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200162 hci_send_cmd(conn->hdev, HCI_OP_CREATE_CONN_CANCEL, sizeof(cp), &cp);
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200163}
164
Claudio Takahasi93796fa2013-04-11 13:54:56 -0300165static void hci_reject_sco(struct hci_conn *conn)
166{
167 struct hci_cp_reject_sync_conn_req cp;
168
Johan Hedbergd41c15c2014-09-24 13:14:46 +0300169 cp.reason = HCI_ERROR_REJ_LIMITED_RESOURCES;
Claudio Takahasi93796fa2013-04-11 13:54:56 -0300170 bacpy(&cp.bdaddr, &conn->dst);
171
172 hci_send_cmd(conn->hdev, HCI_OP_REJECT_SYNC_CONN_REQ, sizeof(cp), &cp);
173}
174
Johan Hedberge3b679d2014-08-18 20:33:32 +0300175int hci_disconnect(struct hci_conn *conn, __u8 reason)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176{
177 struct hci_cp_disconnect cp;
178
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300179 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700180
Johan Hedberg839035a2014-08-18 20:33:34 +0300181 /* When we are master of an established connection and it enters
182 * the disconnect timeout, then go ahead and try to read the
183 * current clock offset. Processing of the result is done
184 * within the event handling and hci_clock_offset_evt function.
185 */
186 if (conn->type == ACL_LINK && conn->role == HCI_ROLE_MASTER) {
187 struct hci_dev *hdev = conn->hdev;
Fabian Frederick4f639ed2014-10-25 10:48:58 +0200188 struct hci_cp_read_clock_offset clkoff_cp;
Johan Hedberg839035a2014-08-18 20:33:34 +0300189
Fabian Frederick4f639ed2014-10-25 10:48:58 +0200190 clkoff_cp.handle = cpu_to_le16(conn->handle);
191 hci_send_cmd(hdev, HCI_OP_READ_CLOCK_OFFSET, sizeof(clkoff_cp),
192 &clkoff_cp);
Johan Hedberg839035a2014-08-18 20:33:34 +0300193 }
194
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195 conn->state = BT_DISCONN;
196
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700197 cp.handle = cpu_to_le16(conn->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 cp.reason = reason;
Johan Hedberge3b679d2014-08-18 20:33:32 +0300199 return hci_send_cmd(conn->hdev, HCI_OP_DISCONNECT, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200}
201
Marcel Holtmanna2b19762014-06-27 13:45:08 +0200202static void hci_amp_disconn(struct hci_conn *conn)
Andrei Emeltchenko53502d62012-10-10 17:38:27 +0300203{
204 struct hci_cp_disconn_phy_link cp;
205
206 BT_DBG("hcon %p", conn);
207
208 conn->state = BT_DISCONN;
209
210 cp.phy_handle = HCI_PHY_HANDLE(conn->handle);
Marcel Holtmanna2b19762014-06-27 13:45:08 +0200211 cp.reason = hci_proto_disconn_ind(conn);
Andrei Emeltchenko53502d62012-10-10 17:38:27 +0300212 hci_send_cmd(conn->hdev, HCI_OP_DISCONN_PHY_LINK,
213 sizeof(cp), &cp);
214}
215
Vinicius Costa Gomes57f5d0d2012-07-27 19:32:54 -0300216static void hci_add_sco(struct hci_conn *conn, __u16 handle)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217{
218 struct hci_dev *hdev = conn->hdev;
219 struct hci_cp_add_sco cp;
220
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300221 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222
223 conn->state = BT_CONNECT;
Johan Hedberga0c808b2012-01-16 09:49:58 +0200224 conn->out = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225
Marcel Holtmannefc76882009-02-06 09:13:37 +0100226 conn->attempt++;
227
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -0700228 cp.handle = cpu_to_le16(handle);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200229 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200231 hci_send_cmd(hdev, HCI_OP_ADD_SCO, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232}
233
Frédéric Dalleau2dea6322013-08-19 14:24:03 +0200234bool hci_setup_sync(struct hci_conn *conn, __u16 handle)
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200235{
236 struct hci_dev *hdev = conn->hdev;
237 struct hci_cp_setup_sync_conn cp;
Frédéric Dalleau2dea6322013-08-19 14:24:03 +0200238 const struct sco_param *param;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200239
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300240 BT_DBG("hcon %p", conn);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200241
242 conn->state = BT_CONNECT;
Johan Hedberga0c808b2012-01-16 09:49:58 +0200243 conn->out = true;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200244
Marcel Holtmannefc76882009-02-06 09:13:37 +0100245 conn->attempt++;
246
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200247 cp.handle = cpu_to_le16(handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200248
Joe Perchesdcf4adb2014-03-12 10:52:35 -0700249 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
250 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
Frédéric Dalleau10c62dd2013-08-19 14:23:59 +0200251 cp.voice_setting = cpu_to_le16(conn->setting);
252
253 switch (conn->setting & SCO_AIRMODE_MASK) {
254 case SCO_AIRMODE_TRANSP:
Johan Hedberg565766b2014-09-25 09:48:01 +0300255 if (conn->attempt > ARRAY_SIZE(esco_param_msbc))
Frédéric Dalleau2dea6322013-08-19 14:24:03 +0200256 return false;
Johan Hedberg565766b2014-09-25 09:48:01 +0300257 param = &esco_param_msbc[conn->attempt - 1];
Frédéric Dalleau10c62dd2013-08-19 14:23:59 +0200258 break;
259 case SCO_AIRMODE_CVSD:
Bernhard Thaler48e68ff2014-09-23 11:01:07 +0200260 if (lmp_esco_capable(conn->link)) {
261 if (conn->attempt > ARRAY_SIZE(esco_param_cvsd))
262 return false;
Bernhard Thaler48e68ff2014-09-23 11:01:07 +0200263 param = &esco_param_cvsd[conn->attempt - 1];
264 } else {
265 if (conn->attempt > ARRAY_SIZE(sco_param_cvsd))
266 return false;
Bernhard Thaler48e68ff2014-09-23 11:01:07 +0200267 param = &sco_param_cvsd[conn->attempt - 1];
268 }
Frédéric Dalleau10c62dd2013-08-19 14:23:59 +0200269 break;
Frédéric Dalleau2dea6322013-08-19 14:24:03 +0200270 default:
271 return false;
Frédéric Dalleau10c62dd2013-08-19 14:23:59 +0200272 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200273
Johan Hedbergc7da5792014-09-24 22:41:46 +0300274 cp.retrans_effort = param->retrans_effort;
Frédéric Dalleau2dea6322013-08-19 14:24:03 +0200275 cp.pkt_type = __cpu_to_le16(param->pkt_type);
276 cp.max_latency = __cpu_to_le16(param->max_latency);
277
278 if (hci_send_cmd(hdev, HCI_OP_SETUP_SYNC_CONN, sizeof(cp), &cp) < 0)
279 return false;
280
281 return true;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +0200282}
283
Johan Hedberg7d6ca692014-07-02 17:37:31 +0300284u8 hci_le_conn_update(struct hci_conn *conn, u16 min, u16 max, u16 latency,
285 u16 to_multiplier)
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200286{
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200287 struct hci_dev *hdev = conn->hdev;
Marcel Holtmannf044eb02014-06-29 16:43:26 +0200288 struct hci_conn_params *params;
289 struct hci_cp_le_conn_update cp;
290
291 hci_dev_lock(hdev);
292
293 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
294 if (params) {
295 params->conn_min_interval = min;
296 params->conn_max_interval = max;
297 params->conn_latency = latency;
298 params->supervision_timeout = to_multiplier;
299 }
300
301 hci_dev_unlock(hdev);
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200302
303 memset(&cp, 0, sizeof(cp));
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200304 cp.handle = cpu_to_le16(conn->handle);
305 cp.conn_interval_min = cpu_to_le16(min);
306 cp.conn_interval_max = cpu_to_le16(max);
307 cp.conn_latency = cpu_to_le16(latency);
308 cp.supervision_timeout = cpu_to_le16(to_multiplier);
Joe Perchesdcf4adb2014-03-12 10:52:35 -0700309 cp.min_ce_len = cpu_to_le16(0x0000);
310 cp.max_ce_len = cpu_to_le16(0x0000);
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200311
312 hci_send_cmd(hdev, HCI_OP_LE_CONN_UPDATE, sizeof(cp), &cp);
Johan Hedberg7d6ca692014-07-02 17:37:31 +0300313
314 if (params)
315 return 0x01;
316
317 return 0x00;
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200318}
Claudio Takahasi2ce603e2011-02-16 20:44:53 -0200319
Marcel Holtmannfe39c7b2014-02-27 16:00:28 -0800320void hci_le_start_enc(struct hci_conn *conn, __le16 ediv, __le64 rand,
Johan Hedberg8b76ce32015-06-08 18:14:39 +0300321 __u8 ltk[16], __u8 key_size)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300322{
323 struct hci_dev *hdev = conn->hdev;
324 struct hci_cp_le_start_enc cp;
325
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300326 BT_DBG("hcon %p", conn);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300327
328 memset(&cp, 0, sizeof(cp));
329
330 cp.handle = cpu_to_le16(conn->handle);
Marcel Holtmannfe39c7b2014-02-27 16:00:28 -0800331 cp.rand = rand;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300332 cp.ediv = ediv;
Johan Hedberg8b76ce32015-06-08 18:14:39 +0300333 memcpy(cp.ltk, ltk, key_size);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300334
335 hci_send_cmd(hdev, HCI_OP_LE_START_ENC, sizeof(cp), &cp);
336}
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -0300337
Marcel Holtmanne73439d2010-07-26 10:06:00 -0400338/* Device _must_ be locked */
339void hci_sco_setup(struct hci_conn *conn, __u8 status)
340{
341 struct hci_conn *sco = conn->link;
342
Marcel Holtmanne73439d2010-07-26 10:06:00 -0400343 if (!sco)
344 return;
345
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300346 BT_DBG("hcon %p", conn);
347
Marcel Holtmanne73439d2010-07-26 10:06:00 -0400348 if (!status) {
349 if (lmp_esco_capable(conn->hdev))
350 hci_setup_sync(sco, conn->handle);
351 else
352 hci_add_sco(sco, conn->handle);
353 } else {
Johan Hedberg539c4962015-02-18 14:53:57 +0200354 hci_connect_cfm(sco, status);
Marcel Holtmanne73439d2010-07-26 10:06:00 -0400355 hci_conn_del(sco);
356 }
357}
358
Gustavo F. Padovan19c40e32011-06-17 13:03:21 -0300359static void hci_conn_timeout(struct work_struct *work)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360{
Gustavo F. Padovan19c40e32011-06-17 13:03:21 -0300361 struct hci_conn *conn = container_of(work, struct hci_conn,
Gustavo Padovan5974e4c2012-05-17 00:36:25 -0300362 disc_work.work);
Lukasz Rymanowski1d56dc42014-06-17 13:04:20 +0200363 int refcnt = atomic_read(&conn->refcnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300365 BT_DBG("hcon %p state %s", conn, state_to_string(conn->state));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700366
Lukasz Rymanowski1d56dc42014-06-17 13:04:20 +0200367 WARN_ON(refcnt < 0);
368
369 /* FIXME: It was observed that in pairing failed scenario, refcnt
370 * drops below 0. Probably this is because l2cap_conn_del calls
371 * l2cap_chan_del for each channel, and inside l2cap_chan_del conn is
372 * dropped. After that loop hci_chan_del is called which also drops
373 * conn. For now make sure that ACL is alive if refcnt is higher then 0,
374 * otherwise drop it.
375 */
376 if (refcnt > 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377 return;
378
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200379 switch (conn->state) {
380 case BT_CONNECT:
Marcel Holtmann769be972008-07-14 20:13:49 +0200381 case BT_CONNECT2:
Ville Tervofcd89c02011-02-10 22:38:47 -0300382 if (conn->out) {
383 if (conn->type == ACL_LINK)
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -0300384 hci_acl_create_connection_cancel(conn);
Ville Tervofcd89c02011-02-10 22:38:47 -0300385 else if (conn->type == LE_LINK)
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -0300386 hci_le_create_connection_cancel(conn);
Claudio Takahasi93796fa2013-04-11 13:54:56 -0300387 } else if (conn->type == SCO_LINK || conn->type == ESCO_LINK) {
388 hci_reject_sco(conn);
Ville Tervofcd89c02011-02-10 22:38:47 -0300389 }
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200390 break;
Marcel Holtmann769be972008-07-14 20:13:49 +0200391 case BT_CONFIG:
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900392 case BT_CONNECTED:
Marcel Holtmann40051e42014-06-27 13:45:09 +0200393 if (conn->type == AMP_LINK) {
394 hci_amp_disconn(conn);
395 } else {
396 __u8 reason = hci_proto_disconn_ind(conn);
397 hci_disconnect(conn, reason);
398 }
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200399 break;
400 default:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 conn->state = BT_CLOSED;
Marcel Holtmann6ac59342006-09-26 09:43:48 +0200402 break;
403 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700404}
405
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200406/* Enter sniff mode */
Johan Hedberga74a84f2013-10-16 18:11:40 +0300407static void hci_conn_idle(struct work_struct *work)
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200408{
Johan Hedberga74a84f2013-10-16 18:11:40 +0300409 struct hci_conn *conn = container_of(work, struct hci_conn,
410 idle_work.work);
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200411 struct hci_dev *hdev = conn->hdev;
412
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300413 BT_DBG("hcon %p mode %d", conn, conn->mode);
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200414
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200415 if (!lmp_sniff_capable(hdev) || !lmp_sniff_capable(conn))
416 return;
417
418 if (conn->mode != HCI_CM_ACTIVE || !(conn->link_policy & HCI_LP_SNIFF))
419 return;
420
421 if (lmp_sniffsubr_capable(hdev) && lmp_sniffsubr_capable(conn)) {
422 struct hci_cp_sniff_subrate cp;
423 cp.handle = cpu_to_le16(conn->handle);
Joe Perchesdcf4adb2014-03-12 10:52:35 -0700424 cp.max_latency = cpu_to_le16(0);
425 cp.min_remote_timeout = cpu_to_le16(0);
426 cp.min_local_timeout = cpu_to_le16(0);
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200427 hci_send_cmd(hdev, HCI_OP_SNIFF_SUBRATE, sizeof(cp), &cp);
428 }
429
Johan Hedberg51a8efd2012-01-16 06:10:31 +0200430 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags)) {
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200431 struct hci_cp_sniff_mode cp;
432 cp.handle = cpu_to_le16(conn->handle);
433 cp.max_interval = cpu_to_le16(hdev->sniff_max_interval);
434 cp.min_interval = cpu_to_le16(hdev->sniff_min_interval);
Joe Perchesdcf4adb2014-03-12 10:52:35 -0700435 cp.attempt = cpu_to_le16(4);
436 cp.timeout = cpu_to_le16(1);
Gustavo F. Padovan416dc942011-12-07 13:24:33 -0200437 hci_send_cmd(hdev, HCI_OP_SNIFF_MODE, sizeof(cp), &cp);
438 }
439}
440
Johan Hedberg7bc18d92013-10-16 18:11:39 +0300441static void hci_conn_auto_accept(struct work_struct *work)
Johan Hedberg9f616562011-04-28 11:28:54 -0700442{
Johan Hedberg7bc18d92013-10-16 18:11:39 +0300443 struct hci_conn *conn = container_of(work, struct hci_conn,
444 auto_accept_work.work);
Johan Hedberg9f616562011-04-28 11:28:54 -0700445
Johan Hedberg7bc18d92013-10-16 18:11:39 +0300446 hci_send_cmd(conn->hdev, HCI_OP_USER_CONFIRM_REPLY, sizeof(conn->dst),
Gustavo Padovan5974e4c2012-05-17 00:36:25 -0300447 &conn->dst);
Johan Hedberg9f616562011-04-28 11:28:54 -0700448}
449
Johan Hedberg9489eca2014-02-28 17:45:46 +0200450static void le_conn_timeout(struct work_struct *work)
451{
452 struct hci_conn *conn = container_of(work, struct hci_conn,
453 le_conn_timeout.work);
Johan Hedberg3c857752014-03-25 10:30:49 +0200454 struct hci_dev *hdev = conn->hdev;
Johan Hedberg9489eca2014-02-28 17:45:46 +0200455
456 BT_DBG("");
457
Johan Hedberg3c857752014-03-25 10:30:49 +0200458 /* We could end up here due to having done directed advertising,
459 * so clean up the state if necessary. This should however only
460 * happen with broken hardware or if low duty cycle was used
461 * (which doesn't have a timeout of its own).
462 */
Johan Hedberg0b1db382014-10-28 22:23:27 +0100463 if (conn->role == HCI_ROLE_SLAVE) {
Johan Hedberg3c857752014-03-25 10:30:49 +0200464 u8 enable = 0x00;
465 hci_send_cmd(hdev, HCI_OP_LE_SET_ADV_ENABLE, sizeof(enable),
466 &enable);
467 hci_le_conn_failed(conn, HCI_ERROR_ADVERTISING_TIMEOUT);
468 return;
469 }
470
Johan Hedberg9489eca2014-02-28 17:45:46 +0200471 hci_le_create_connection_cancel(conn);
472}
473
Johan Hedberga5c4e302014-07-16 11:56:07 +0300474struct hci_conn *hci_conn_add(struct hci_dev *hdev, int type, bdaddr_t *dst,
475 u8 role)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476{
477 struct hci_conn *conn;
478
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +0300479 BT_DBG("%s dst %pMR", hdev->name, dst);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480
Johan Hedberg27f70f32014-07-21 10:50:06 +0300481 conn = kzalloc(sizeof(*conn), GFP_KERNEL);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200482 if (!conn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484
485 bacpy(&conn->dst, dst);
Marcel Holtmann662e8822013-10-13 05:23:59 -0700486 bacpy(&conn->src, &hdev->bdaddr);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200487 conn->hdev = hdev;
488 conn->type = type;
Johan Hedberga5c4e302014-07-16 11:56:07 +0300489 conn->role = role;
Marcel Holtmanna8746412008-07-14 20:13:46 +0200490 conn->mode = HCI_CM_ACTIVE;
491 conn->state = BT_OPEN;
Andrei Emeltchenko93f19c92009-09-03 12:34:19 +0300492 conn->auth_type = HCI_AT_GENERAL_BONDING;
Johan Hedberg17fa4b92011-01-25 13:28:33 +0200493 conn->io_capability = hdev->io_capability;
Johan Hedberga9583552011-02-19 12:06:01 -0300494 conn->remote_auth = 0xff;
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +0200495 conn->key_type = 0xff;
Johan Hedbergebf86aa2014-12-05 13:36:08 +0200496 conn->rssi = HCI_RSSI_INVALID;
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +0200497 conn->tx_power = HCI_TX_POWER_INVALID;
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +0200498 conn->max_tx_power = HCI_TX_POWER_INVALID;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499
Johan Hedberg58a681e2012-01-16 06:47:28 +0200500 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann052b30b2009-04-26 20:01:22 +0200501 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann04837f62006-07-03 10:02:33 +0200502
Johan Hedberga5c4e302014-07-16 11:56:07 +0300503 if (conn->role == HCI_ROLE_MASTER)
504 conn->out = true;
505
Marcel Holtmanna8746412008-07-14 20:13:46 +0200506 switch (type) {
507 case ACL_LINK:
508 conn->pkt_type = hdev->pkt_type & ACL_PTYPE_MASK;
509 break;
Johan Hedberg9c84d1d2014-03-24 20:21:50 +0200510 case LE_LINK:
511 /* conn->src should reflect the local identity address */
512 hci_copy_identity_address(hdev, &conn->src, &conn->src_type);
513 break;
Marcel Holtmanna8746412008-07-14 20:13:46 +0200514 case SCO_LINK:
515 if (lmp_esco_capable(hdev))
Marcel Holtmannefc76882009-02-06 09:13:37 +0100516 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
517 (hdev->esco_type & EDR_ESCO_MASK);
Marcel Holtmanna8746412008-07-14 20:13:46 +0200518 else
519 conn->pkt_type = hdev->pkt_type & SCO_PTYPE_MASK;
520 break;
521 case ESCO_LINK:
Marcel Holtmannefc76882009-02-06 09:13:37 +0100522 conn->pkt_type = hdev->esco_type & ~EDR_ESCO_MASK;
Marcel Holtmanna8746412008-07-14 20:13:46 +0200523 break;
524 }
525
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526 skb_queue_head_init(&conn->data_q);
Marcel Holtmann04837f62006-07-03 10:02:33 +0200527
Marcel Holtmann70c1f202012-02-22 12:06:43 +0100528 INIT_LIST_HEAD(&conn->chan_list);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +0200529
Gustavo F. Padovan19c40e32011-06-17 13:03:21 -0300530 INIT_DELAYED_WORK(&conn->disc_work, hci_conn_timeout);
Johan Hedberg7bc18d92013-10-16 18:11:39 +0300531 INIT_DELAYED_WORK(&conn->auto_accept_work, hci_conn_auto_accept);
Johan Hedberga74a84f2013-10-16 18:11:40 +0300532 INIT_DELAYED_WORK(&conn->idle_work, hci_conn_idle);
Johan Hedberg9489eca2014-02-28 17:45:46 +0200533 INIT_DELAYED_WORK(&conn->le_conn_timeout, le_conn_timeout);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534
535 atomic_set(&conn->refcnt, 0);
536
537 hci_dev_hold(hdev);
538
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 hci_conn_hash_add(hdev, conn);
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200540 if (hdev->notify)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 hdev->notify(hdev, HCI_NOTIFY_CONN_ADD);
542
Marcel Holtmanna67e8992009-05-02 18:24:06 -0700543 hci_conn_init_sysfs(conn);
544
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 return conn;
546}
547
548int hci_conn_del(struct hci_conn *conn)
549{
550 struct hci_dev *hdev = conn->hdev;
551
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +0300552 BT_DBG("%s hcon %p handle %d", hdev->name, conn, conn->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553
Gustavo F. Padovan19c40e32011-06-17 13:03:21 -0300554 cancel_delayed_work_sync(&conn->disc_work);
Johan Hedberg7bc18d92013-10-16 18:11:39 +0300555 cancel_delayed_work_sync(&conn->auto_accept_work);
Johan Hedberga74a84f2013-10-16 18:11:40 +0300556 cancel_delayed_work_sync(&conn->idle_work);
Johan Hedberg9f616562011-04-28 11:28:54 -0700557
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200558 if (conn->type == ACL_LINK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 struct hci_conn *sco = conn->link;
560 if (sco)
561 sco->link = NULL;
562
563 /* Unacked frames */
564 hdev->acl_cnt += conn->sent;
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300565 } else if (conn->type == LE_LINK) {
Johan Hedberg980ffc02014-10-28 22:23:26 +0100566 cancel_delayed_work(&conn->le_conn_timeout);
Johan Hedberg9489eca2014-02-28 17:45:46 +0200567
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300568 if (hdev->le_pkts)
569 hdev->le_cnt += conn->sent;
570 else
571 hdev->acl_cnt += conn->sent;
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200572 } else {
573 struct hci_conn *acl = conn->link;
574 if (acl) {
575 acl->link = NULL;
David Herrmann76a68ba2013-04-06 20:28:37 +0200576 hci_conn_drop(acl);
Marcel Holtmann5b7f9902007-07-11 09:51:55 +0200577 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 }
579
Gustavo F. Padovan2c33c062011-12-14 13:02:51 -0200580 hci_chan_list_flush(conn);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +0200581
Andrei Emeltchenko9740e492012-05-29 13:59:02 +0300582 if (conn->amp_mgr)
583 amp_mgr_put(conn->amp_mgr);
584
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 hci_conn_hash_del(hdev, conn);
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200586 if (hdev->notify)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 hdev->notify(hdev, HCI_NOTIFY_CONN_DEL);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +0200588
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 skb_queue_purge(&conn->data_q);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590
David Herrmannfc225c32013-04-06 20:28:38 +0200591 hci_conn_del_sysfs(conn);
Dave Young2ae9a6b2009-02-21 16:13:34 +0800592
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +0100593 debugfs_remove_recursive(conn->debugfs);
594
Alfonso Acosta89cbb062014-10-11 21:44:47 +0000595 if (test_bit(HCI_CONN_PARAM_REMOVAL_PEND, &conn->flags))
596 hci_conn_params_del(conn->hdev, &conn->dst, conn->dst_type);
597
Marcel Holtmann384943e2009-05-08 18:20:43 -0700598 hci_dev_put(hdev);
599
David Herrmann8d123562013-04-06 20:28:39 +0200600 hci_conn_put(conn);
Tomas Targownik163f4da2011-06-30 16:30:44 -0300601
Linus Torvalds1da177e2005-04-16 15:20:36 -0700602 return 0;
603}
604
605struct hci_dev *hci_get_route(bdaddr_t *dst, bdaddr_t *src)
606{
607 int use_src = bacmp(src, BDADDR_ANY);
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +0200608 struct hci_dev *hdev = NULL, *d;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +0300610 BT_DBG("%pMR -> %pMR", src, dst);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611
Gustavo F. Padovanf20d09d2011-12-22 16:30:27 -0200612 read_lock(&hci_dev_list_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700613
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +0200614 list_for_each_entry(d, &hci_dev_list, list) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300615 if (!test_bit(HCI_UP, &d->flags) ||
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700616 hci_dev_test_flag(d, HCI_USER_CHANNEL) ||
Andrei Emeltchenkod300fa92012-06-19 15:21:21 +0300617 d->dev_type != HCI_BREDR)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 continue;
619
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900620 /* Simple routing:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700621 * No source address - find interface with bdaddr != dst
622 * Source address - find interface with bdaddr == src
623 */
624
625 if (use_src) {
626 if (!bacmp(&d->bdaddr, src)) {
627 hdev = d; break;
628 }
629 } else {
630 if (bacmp(&d->bdaddr, dst)) {
631 hdev = d; break;
632 }
633 }
634 }
635
636 if (hdev)
637 hdev = hci_dev_hold(hdev);
638
Gustavo F. Padovanf20d09d2011-12-22 16:30:27 -0200639 read_unlock(&hci_dev_list_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640 return hdev;
641}
642EXPORT_SYMBOL(hci_get_route);
643
Andre Guedes9bb3c012014-01-30 18:22:08 -0300644/* This function requires the caller holds hdev->lock */
Andre Guedes06c053f2014-02-26 20:21:41 -0300645void hci_le_conn_failed(struct hci_conn *conn, u8 status)
Andre Guedes9bb3c012014-01-30 18:22:08 -0300646{
647 struct hci_dev *hdev = conn->hdev;
Johan Hedbergf161dd42014-08-15 21:06:54 +0300648 struct hci_conn_params *params;
649
650 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
651 conn->dst_type);
652 if (params && params->conn) {
653 hci_conn_drop(params->conn);
Johan Hedbergf8aaf9b2014-08-17 23:28:57 +0300654 hci_conn_put(params->conn);
Johan Hedbergf161dd42014-08-15 21:06:54 +0300655 params->conn = NULL;
656 }
Andre Guedes9bb3c012014-01-30 18:22:08 -0300657
658 conn->state = BT_CLOSED;
659
660 mgmt_connect_failed(hdev, &conn->dst, conn->type, conn->dst_type,
661 status);
662
Johan Hedberg539c4962015-02-18 14:53:57 +0200663 hci_connect_cfm(conn, status);
Andre Guedes9bb3c012014-01-30 18:22:08 -0300664
665 hci_conn_del(conn);
Andre Guedesa4790db2014-02-26 20:21:47 -0300666
667 /* Since we may have temporarily stopped the background scanning in
668 * favor of connection establishment, we should restart it.
669 */
670 hci_update_background_scan(hdev);
Johan Hedberg3c857752014-03-25 10:30:49 +0200671
672 /* Re-enable advertising in case this was a failed connection
673 * attempt as a peripheral.
674 */
675 mgmt_reenable_advertising(hdev);
Andre Guedes9bb3c012014-01-30 18:22:08 -0300676}
677
Marcel Holtmann1904a852015-01-11 13:50:44 -0800678static void create_le_conn_complete(struct hci_dev *hdev, u8 status, u16 opcode)
Andre Guedes1d399ae2013-10-08 08:21:17 -0300679{
680 struct hci_conn *conn;
681
682 if (status == 0)
683 return;
684
685 BT_ERR("HCI request failed to create LE connection: status 0x%2.2x",
686 status);
687
688 hci_dev_lock(hdev);
689
Jakub Pawlowskie7d9ab72015-08-07 20:22:52 +0200690 conn = hci_lookup_le_connect(hdev);
Andre Guedes1d399ae2013-10-08 08:21:17 -0300691 if (!conn)
692 goto done;
693
Andre Guedes06c053f2014-02-26 20:21:41 -0300694 hci_le_conn_failed(conn, status);
Andre Guedes1d399ae2013-10-08 08:21:17 -0300695
696done:
697 hci_dev_unlock(hdev);
698}
699
Andre Guedes2acf3d92014-02-26 20:21:42 -0300700static void hci_req_add_le_create_conn(struct hci_request *req,
701 struct hci_conn *conn)
702{
703 struct hci_cp_le_create_conn cp;
704 struct hci_dev *hdev = conn->hdev;
705 u8 own_addr_type;
706
707 memset(&cp, 0, sizeof(cp));
708
709 /* Update random address, but set require_privacy to false so
Marcel Holtmann9437d2e2014-12-07 20:13:17 +0100710 * that we never connect with an non-resolvable address.
Andre Guedes2acf3d92014-02-26 20:21:42 -0300711 */
712 if (hci_update_random_address(req, false, &own_addr_type))
713 return;
714
Andre Guedes2acf3d92014-02-26 20:21:42 -0300715 cp.scan_interval = cpu_to_le16(hdev->le_scan_interval);
716 cp.scan_window = cpu_to_le16(hdev->le_scan_window);
717 bacpy(&cp.peer_addr, &conn->dst);
718 cp.peer_addr_type = conn->dst_type;
719 cp.own_address_type = own_addr_type;
720 cp.conn_interval_min = cpu_to_le16(conn->le_conn_min_interval);
721 cp.conn_interval_max = cpu_to_le16(conn->le_conn_max_interval);
Marcel Holtmann037fc412014-06-29 16:43:27 +0200722 cp.conn_latency = cpu_to_le16(conn->le_conn_latency);
723 cp.supervision_timeout = cpu_to_le16(conn->le_supv_timeout);
Joe Perchesdcf4adb2014-03-12 10:52:35 -0700724 cp.min_ce_len = cpu_to_le16(0x0000);
725 cp.max_ce_len = cpu_to_le16(0x0000);
Andre Guedes2acf3d92014-02-26 20:21:42 -0300726
727 hci_req_add(req, HCI_OP_LE_CREATE_CONN, sizeof(cp), &cp);
Johan Hedbergb46e0032014-02-28 12:54:15 +0200728
729 conn->state = BT_CONNECT;
Andre Guedes2acf3d92014-02-26 20:21:42 -0300730}
731
Johan Hedberg3c857752014-03-25 10:30:49 +0200732static void hci_req_directed_advertising(struct hci_request *req,
733 struct hci_conn *conn)
734{
735 struct hci_dev *hdev = req->hdev;
736 struct hci_cp_le_set_adv_param cp;
737 u8 own_addr_type;
738 u8 enable;
739
Johan Hedberg5ce194c2014-07-08 15:07:49 +0300740 /* Clear the HCI_LE_ADV bit temporarily so that the
Johan Hedberg3c857752014-03-25 10:30:49 +0200741 * hci_update_random_address knows that it's safe to go ahead
742 * and write a new random address. The flag will be set back on
743 * as soon as the SET_ADV_ENABLE HCI command completes.
744 */
Marcel Holtmanna358dc12015-03-13 02:11:02 -0700745 hci_dev_clear_flag(hdev, HCI_LE_ADV);
Johan Hedberg3c857752014-03-25 10:30:49 +0200746
747 /* Set require_privacy to false so that the remote device has a
748 * chance of identifying us.
749 */
750 if (hci_update_random_address(req, false, &own_addr_type) < 0)
751 return;
752
753 memset(&cp, 0, sizeof(cp));
754 cp.type = LE_ADV_DIRECT_IND;
755 cp.own_address_type = own_addr_type;
756 cp.direct_addr_type = conn->dst_type;
757 bacpy(&cp.direct_addr, &conn->dst);
758 cp.channel_map = hdev->le_adv_channel_map;
759
760 hci_req_add(req, HCI_OP_LE_SET_ADV_PARAM, sizeof(cp), &cp);
761
762 enable = 0x01;
763 hci_req_add(req, HCI_OP_LE_SET_ADV_ENABLE, sizeof(enable), &enable);
764
765 conn->state = BT_CONNECT;
766}
767
Andre Guedes04a6c582014-02-26 20:21:44 -0300768struct hci_conn *hci_connect_le(struct hci_dev *hdev, bdaddr_t *dst,
Johan Hedbergcdd62752014-07-07 15:02:28 +0300769 u8 dst_type, u8 sec_level, u16 conn_timeout,
Johan Hedberge804d252014-07-16 11:42:28 +0300770 u8 role)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771{
Andre Guedes4292f1f2014-02-03 13:56:19 -0300772 struct hci_conn_params *params;
Andre Guedesf1e5d542013-10-03 18:25:44 -0300773 struct hci_conn *conn;
Johan Hedberg1ebfcc12014-02-18 21:41:36 +0200774 struct smp_irk *irk;
Andre Guedes2acf3d92014-02-26 20:21:42 -0300775 struct hci_request req;
Andre Guedes1d399ae2013-10-08 08:21:17 -0300776 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777
Lukasz Rymanowski152d3862015-02-11 12:31:40 +0100778 /* Let's make sure that le is enabled.*/
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700779 if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) {
Lukasz Rymanowski152d3862015-02-11 12:31:40 +0100780 if (lmp_le_capable(hdev))
781 return ERR_PTR(-ECONNREFUSED);
782
783 return ERR_PTR(-EOPNOTSUPP);
784 }
785
Andre Guedes620ad522013-10-08 08:21:18 -0300786 /* Some devices send ATT messages as soon as the physical link is
787 * established. To be able to handle these ATT messages, the user-
788 * space first establishes the connection and then starts the pairing
789 * process.
790 *
791 * So if a hci_conn object already exists for the following connection
792 * attempt, we simply update pending_sec_level and auth_type fields
793 * and return the object found.
794 */
Andre Guedesf1e5d542013-10-03 18:25:44 -0300795 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, dst);
Andre Guedes620ad522013-10-08 08:21:18 -0300796 if (conn) {
797 conn->pending_sec_level = sec_level;
Andre Guedes620ad522013-10-08 08:21:18 -0300798 goto done;
Ville Tervofcd89c02011-02-10 22:38:47 -0300799 }
800
Andre Guedes620ad522013-10-08 08:21:18 -0300801 /* Since the controller supports only one LE connection attempt at a
802 * time, we return -EBUSY if there is any connection attempt running.
803 */
Jakub Pawlowskie7d9ab72015-08-07 20:22:52 +0200804 if (hci_lookup_le_connect(hdev))
Andre Guedes620ad522013-10-08 08:21:18 -0300805 return ERR_PTR(-EBUSY);
806
Marcel Holtmannedb4b462014-02-18 15:13:43 -0800807 /* When given an identity address with existing identity
808 * resolving key, the connection needs to be established
809 * to a resolvable random address.
810 *
811 * This uses the cached random resolvable address from
812 * a previous scan. When no cached address is available,
813 * try connecting to the identity address instead.
814 *
815 * Storing the resolvable random address is required here
816 * to handle connection failures. The address will later
817 * be resolved back into the original identity address
818 * from the connect request.
819 */
Johan Hedberg1ebfcc12014-02-18 21:41:36 +0200820 irk = hci_find_irk_by_addr(hdev, dst, dst_type);
821 if (irk && bacmp(&irk->rpa, BDADDR_ANY)) {
822 dst = &irk->rpa;
823 dst_type = ADDR_LE_DEV_RANDOM;
824 }
825
Johan Hedberga5c4e302014-07-16 11:56:07 +0300826 conn = hci_conn_add(hdev, LE_LINK, dst, role);
Andre Guedes620ad522013-10-08 08:21:18 -0300827 if (!conn)
828 return ERR_PTR(-ENOMEM);
829
Johan Hedberg1ebfcc12014-02-18 21:41:36 +0200830 conn->dst_type = dst_type;
Andre Guedes620ad522013-10-08 08:21:18 -0300831 conn->sec_level = BT_SECURITY_LOW;
Andre Guedesf1e5d542013-10-03 18:25:44 -0300832 conn->pending_sec_level = sec_level;
Johan Hedberg09ae2602014-07-06 13:41:15 +0300833 conn->conn_timeout = conn_timeout;
Andre Guedes4292f1f2014-02-03 13:56:19 -0300834
Johan Hedberg3c857752014-03-25 10:30:49 +0200835 hci_req_init(&req, hdev);
836
Johan Hedberg376f54c2014-07-08 15:07:52 +0300837 /* Disable advertising if we're active. For master role
838 * connections most controllers will refuse to connect if
839 * advertising is enabled, and for slave role connections we
840 * anyway have to disable it in order to start directed
841 * advertising.
842 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700843 if (hci_dev_test_flag(hdev, HCI_LE_ADV)) {
Johan Hedberg376f54c2014-07-08 15:07:52 +0300844 u8 enable = 0x00;
845 hci_req_add(&req, HCI_OP_LE_SET_ADV_ENABLE, sizeof(enable),
846 &enable);
847 }
848
Johan Hedbergcdd62752014-07-07 15:02:28 +0300849 /* If requested to connect as slave use directed advertising */
Johan Hedberge804d252014-07-16 11:42:28 +0300850 if (conn->role == HCI_ROLE_SLAVE) {
Johan Hedberge8bb6b92014-07-08 15:07:53 +0300851 /* If we're active scanning most controllers are unable
852 * to initiate advertising. Simply reject the attempt.
853 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700854 if (hci_dev_test_flag(hdev, HCI_LE_SCAN) &&
Johan Hedberge8bb6b92014-07-08 15:07:53 +0300855 hdev->le_scan_type == LE_SCAN_ACTIVE) {
856 skb_queue_purge(&req.cmd_q);
857 hci_conn_del(conn);
858 return ERR_PTR(-EBUSY);
859 }
860
Johan Hedberg3c857752014-03-25 10:30:49 +0200861 hci_req_directed_advertising(&req, conn);
862 goto create_conn;
863 }
864
Andre Guedes4292f1f2014-02-03 13:56:19 -0300865 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
866 if (params) {
867 conn->le_conn_min_interval = params->conn_min_interval;
868 conn->le_conn_max_interval = params->conn_max_interval;
Marcel Holtmann037fc412014-06-29 16:43:27 +0200869 conn->le_conn_latency = params->conn_latency;
870 conn->le_supv_timeout = params->supervision_timeout;
Andre Guedes4292f1f2014-02-03 13:56:19 -0300871 } else {
872 conn->le_conn_min_interval = hdev->le_conn_min_interval;
873 conn->le_conn_max_interval = hdev->le_conn_max_interval;
Marcel Holtmann04fb7d92014-06-30 12:34:36 +0200874 conn->le_conn_latency = hdev->le_conn_latency;
875 conn->le_supv_timeout = hdev->le_supv_timeout;
Andre Guedes4292f1f2014-02-03 13:56:19 -0300876 }
Vinicius Costa Gomesd04aef42012-07-27 19:32:56 -0300877
Andre Guedes2acf3d92014-02-26 20:21:42 -0300878 /* If controller is scanning, we stop it since some controllers are
Johan Hedberg81ad6fd2014-02-28 20:26:13 +0200879 * not able to scan and connect at the same time. Also set the
880 * HCI_LE_SCAN_INTERRUPTED flag so that the command complete
881 * handler for scan disabling knows to set the correct discovery
882 * state.
Andre Guedes2acf3d92014-02-26 20:21:42 -0300883 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700884 if (hci_dev_test_flag(hdev, HCI_LE_SCAN)) {
Andre Guedes2acf3d92014-02-26 20:21:42 -0300885 hci_req_add_le_scan_disable(&req);
Marcel Holtmanna1536da2015-03-13 02:11:01 -0700886 hci_dev_set_flag(hdev, HCI_LE_SCAN_INTERRUPTED);
Andre Guedes2acf3d92014-02-26 20:21:42 -0300887 }
888
Johan Hedberg81ad6fd2014-02-28 20:26:13 +0200889 hci_req_add_le_create_conn(&req, conn);
890
Johan Hedberg3c857752014-03-25 10:30:49 +0200891create_conn:
Johan Hedberg81ad6fd2014-02-28 20:26:13 +0200892 err = hci_req_run(&req, create_le_conn_complete);
Andre Guedes2acf3d92014-02-26 20:21:42 -0300893 if (err) {
894 hci_conn_del(conn);
Andre Guedes620ad522013-10-08 08:21:18 -0300895 return ERR_PTR(err);
Andre Guedes2acf3d92014-02-26 20:21:42 -0300896 }
Vinicius Costa Gomesd04aef42012-07-27 19:32:56 -0300897
Andre Guedes620ad522013-10-08 08:21:18 -0300898done:
899 hci_conn_hold(conn);
Andre Guedesf1e5d542013-10-03 18:25:44 -0300900 return conn;
Vinicius Costa Gomesd04aef42012-07-27 19:32:56 -0300901}
902
Jakub Pawlowskif75113a2015-08-07 20:22:53 +0200903static void hci_connect_le_scan_complete(struct hci_dev *hdev, u8 status,
904 u16 opcode)
905{
906 struct hci_conn *conn;
907
908 if (!status)
909 return;
910
911 BT_ERR("Failed to add device to auto conn whitelist: status 0x%2.2x",
912 status);
913
914 hci_dev_lock(hdev);
915
916 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
917 if (conn)
918 hci_le_conn_failed(conn, status);
919
920 hci_dev_unlock(hdev);
921}
922
923static bool is_connected(struct hci_dev *hdev, bdaddr_t *addr, u8 type)
924{
925 struct hci_conn *conn;
926
927 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, addr);
928 if (!conn)
929 return false;
930
931 if (conn->dst_type != type)
932 return false;
933
934 if (conn->state != BT_CONNECTED)
935 return false;
936
937 return true;
938}
939
940/* This function requires the caller holds hdev->lock */
941static int hci_explicit_conn_params_set(struct hci_request *req,
942 bdaddr_t *addr, u8 addr_type)
943{
944 struct hci_dev *hdev = req->hdev;
945 struct hci_conn_params *params;
946
947 if (is_connected(hdev, addr, addr_type))
948 return -EISCONN;
949
950 params = hci_conn_params_add(hdev, addr, addr_type);
951 if (!params)
952 return -EIO;
953
954 /* If we created new params, or existing params were marked as disabled,
955 * mark them to be used just once to connect.
956 */
957 if (params->auto_connect == HCI_AUTO_CONN_DISABLED) {
958 params->auto_connect = HCI_AUTO_CONN_EXPLICIT;
959 list_del_init(&params->action);
960 list_add(&params->action, &hdev->pend_le_conns);
961 }
962
963 params->explicit_connect = true;
964 __hci_update_background_scan(req);
965
966 BT_DBG("addr %pMR (type %u) auto_connect %u", addr, addr_type,
967 params->auto_connect);
968
969 return 0;
970}
971
972/* This function requires the caller holds hdev->lock */
973struct hci_conn *hci_connect_le_scan(struct hci_dev *hdev, bdaddr_t *dst,
974 u8 dst_type, u8 sec_level,
975 u16 conn_timeout, u8 role)
976{
977 struct hci_conn *conn;
978 struct hci_request req;
979 int err;
980
981 /* Let's make sure that le is enabled.*/
982 if (!hci_dev_test_flag(hdev, HCI_LE_ENABLED)) {
983 if (lmp_le_capable(hdev))
984 return ERR_PTR(-ECONNREFUSED);
985
986 return ERR_PTR(-EOPNOTSUPP);
987 }
988
989 /* Some devices send ATT messages as soon as the physical link is
990 * established. To be able to handle these ATT messages, the user-
991 * space first establishes the connection and then starts the pairing
992 * process.
993 *
994 * So if a hci_conn object already exists for the following connection
995 * attempt, we simply update pending_sec_level and auth_type fields
996 * and return the object found.
997 */
998 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, dst);
999 if (conn) {
1000 if (conn->pending_sec_level < sec_level)
1001 conn->pending_sec_level = sec_level;
1002 goto done;
1003 }
1004
1005 BT_DBG("requesting refresh of dst_addr");
1006
1007 conn = hci_conn_add(hdev, LE_LINK, dst, role);
1008 if (!conn)
1009 return ERR_PTR(-ENOMEM);
1010
1011 hci_req_init(&req, hdev);
1012
1013 if (hci_explicit_conn_params_set(&req, dst, dst_type) < 0)
1014 return ERR_PTR(-EBUSY);
1015
1016 conn->state = BT_CONNECT;
1017 set_bit(HCI_CONN_SCANNING, &conn->flags);
1018
1019 err = hci_req_run(&req, hci_connect_le_scan_complete);
1020 if (err && err != -ENODATA) {
1021 hci_conn_del(conn);
1022 return ERR_PTR(err);
1023 }
1024
1025 conn->dst_type = dst_type;
1026 conn->sec_level = BT_SECURITY_LOW;
1027 conn->pending_sec_level = sec_level;
1028 conn->conn_timeout = conn_timeout;
1029
1030done:
1031 hci_conn_hold(conn);
1032 return conn;
1033}
1034
Andre Guedes04a6c582014-02-26 20:21:44 -03001035struct hci_conn *hci_connect_acl(struct hci_dev *hdev, bdaddr_t *dst,
1036 u8 sec_level, u8 auth_type)
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02001037{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001038 struct hci_conn *acl;
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001039
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001040 if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) {
Lukasz Rymanowskic4111102015-02-11 12:31:41 +01001041 if (lmp_bredr_capable(hdev))
1042 return ERR_PTR(-ECONNREFUSED);
1043
Johan Hedbergbeb19e42014-07-18 11:15:26 +03001044 return ERR_PTR(-EOPNOTSUPP);
Lukasz Rymanowskic4111102015-02-11 12:31:41 +01001045 }
Johan Hedberg56f87902013-10-02 13:43:13 +03001046
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047 acl = hci_conn_hash_lookup_ba(hdev, ACL_LINK, dst);
1048 if (!acl) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03001049 acl = hci_conn_add(hdev, ACL_LINK, dst, HCI_ROLE_MASTER);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050 if (!acl)
Johan Hedberg48c7aba2012-02-19 14:06:48 +02001051 return ERR_PTR(-ENOMEM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001052 }
1053
1054 hci_conn_hold(acl);
1055
1056 if (acl->state == BT_OPEN || acl->state == BT_CLOSED) {
1057 acl->sec_level = BT_SECURITY_LOW;
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02001058 acl->pending_sec_level = sec_level;
1059 acl->auth_type = auth_type;
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -03001060 hci_acl_create_connection(acl);
Nick Pellyc3902162009-11-13 14:16:32 -08001061 }
1062
Vinicius Costa Gomesdb474272012-07-28 22:35:59 -03001063 return acl;
1064}
1065
Frédéric Dalleau10c62dd2013-08-19 14:23:59 +02001066struct hci_conn *hci_connect_sco(struct hci_dev *hdev, int type, bdaddr_t *dst,
1067 __u16 setting)
Vinicius Costa Gomesdb474272012-07-28 22:35:59 -03001068{
1069 struct hci_conn *acl;
1070 struct hci_conn *sco;
1071
Frédéric Dalleaue660ed62013-08-19 14:23:54 +02001072 acl = hci_connect_acl(hdev, dst, BT_SECURITY_LOW, HCI_AT_NO_BONDING);
Vinicius Costa Gomesdb474272012-07-28 22:35:59 -03001073 if (IS_ERR(acl))
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001074 return acl;
1075
1076 sco = hci_conn_hash_lookup_ba(hdev, type, dst);
1077 if (!sco) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03001078 sco = hci_conn_add(hdev, type, dst, HCI_ROLE_MASTER);
Marcel Holtmann5b7f9902007-07-11 09:51:55 +02001079 if (!sco) {
David Herrmann76a68ba2013-04-06 20:28:37 +02001080 hci_conn_drop(acl);
Johan Hedberg48c7aba2012-02-19 14:06:48 +02001081 return ERR_PTR(-ENOMEM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001082 }
1083 }
Marcel Holtmanne7c29cb2008-09-09 07:19:20 +02001084
1085 acl->link = sco;
1086 sco->link = acl;
1087
1088 hci_conn_hold(sco);
1089
Frédéric Dalleau10c62dd2013-08-19 14:23:59 +02001090 sco->setting = setting;
1091
Marcel Holtmanne7c29cb2008-09-09 07:19:20 +02001092 if (acl->state == BT_CONNECTED &&
Gustavo Padovan5974e4c2012-05-17 00:36:25 -03001093 (sco->state == BT_OPEN || sco->state == BT_CLOSED)) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02001094 set_bit(HCI_CONN_POWER_SAVE, &acl->flags);
Jaikumar Ganesh14b12d02011-05-23 18:06:04 -07001095 hci_conn_enter_active_mode(acl, BT_POWER_FORCE_ACTIVE_ON);
Marcel Holtmanne7c29cb2008-09-09 07:19:20 +02001096
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001097 if (test_bit(HCI_CONN_MODE_CHANGE_PEND, &acl->flags)) {
Marcel Holtmanne7c29cb2008-09-09 07:19:20 +02001098 /* defer SCO setup until mode change completed */
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001099 set_bit(HCI_CONN_SCO_SETUP_PEND, &acl->flags);
Marcel Holtmann0684e5f2009-02-09 02:48:38 +01001100 return sco;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001101 }
1102
1103 hci_sco_setup(acl, 0x00);
Marcel Holtmann96a31832009-02-12 16:23:03 +01001104 }
Marcel Holtmann0684e5f2009-02-09 02:48:38 +01001105
Marcel Holtmann96a31832009-02-12 16:23:03 +01001106 return sco;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001107}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001108
1109/* Check link security requirement */
1110int hci_conn_check_link_mode(struct hci_conn *conn)
1111{
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001112 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113
Marcel Holtmann40b552a2014-03-19 14:10:25 -07001114 /* In Secure Connections Only mode, it is required that Secure
1115 * Connections is used and the link is encrypted with AES-CCM
1116 * using a P-256 authenticated combination key.
1117 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001118 if (hci_dev_test_flag(conn->hdev, HCI_SC_ONLY)) {
Marcel Holtmann40b552a2014-03-19 14:10:25 -07001119 if (!hci_conn_sc_enabled(conn) ||
1120 !test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
1121 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)
1122 return 0;
1123 }
1124
Johan Hedberg4dae2792014-06-24 17:03:50 +03001125 if (hci_conn_ssp_enabled(conn) &&
1126 !test_bit(HCI_CONN_ENCRYPT, &conn->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001127 return 0;
1128
1129 return 1;
1130}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001131
1132/* Authenticate remote device */
1133static int hci_conn_auth(struct hci_conn *conn, __u8 sec_level, __u8 auth_type)
1134{
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001135 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136
Johan Hedberg765c2a92011-01-19 12:06:52 +05301137 if (conn->pending_sec_level > sec_level)
1138 sec_level = conn->pending_sec_level;
1139
Linus Torvalds1da177e2005-04-16 15:20:36 -07001140 if (sec_level > conn->sec_level)
Johan Hedberg765c2a92011-01-19 12:06:52 +05301141 conn->pending_sec_level = sec_level;
Johan Hedberg4dae2792014-06-24 17:03:50 +03001142 else if (test_bit(HCI_CONN_AUTH, &conn->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001143 return 1;
1144
Johan Hedberg65cf6862011-01-19 12:06:49 +05301145 /* Make sure we preserve an existing MITM requirement*/
1146 auth_type |= (conn->auth_type & 0x01);
1147
Marcel Holtmann96a31832009-02-12 16:23:03 +01001148 conn->auth_type = auth_type;
1149
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001150 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001151 struct hci_cp_auth_requested cp;
Peter Hurleyb7d05ba2012-01-13 15:11:30 +01001152
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -07001153 cp.handle = cpu_to_le16(conn->handle);
Marcel Holtmann40be4922008-07-14 20:13:50 +02001154 hci_send_cmd(conn->hdev, HCI_OP_AUTH_REQUESTED,
Gustavo Padovan5974e4c2012-05-17 00:36:25 -03001155 sizeof(cp), &cp);
Johan Hedberg09da1f32014-04-11 12:02:32 -07001156
1157 /* If we're already encrypted set the REAUTH_PEND flag,
1158 * otherwise set the ENCRYPT_PEND.
1159 */
Johan Hedberg4dae2792014-06-24 17:03:50 +03001160 if (test_bit(HCI_CONN_ENCRYPT, &conn->flags))
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001161 set_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Johan Hedberg09da1f32014-04-11 12:02:32 -07001162 else
1163 set_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001164 }
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001165
Linus Torvalds1da177e2005-04-16 15:20:36 -07001166 return 0;
1167}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001168
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001169/* Encrypt the the link */
1170static void hci_conn_encrypt(struct hci_conn *conn)
1171{
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001172 BT_DBG("hcon %p", conn);
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001173
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001174 if (!test_and_set_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001175 struct hci_cp_set_conn_encrypt cp;
1176 cp.handle = cpu_to_le16(conn->handle);
1177 cp.encrypt = 0x01;
1178 hci_send_cmd(conn->hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan5974e4c2012-05-17 00:36:25 -03001179 &cp);
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001180 }
1181}
1182
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001183/* Enable security */
Johan Hedberge7cafc42014-07-17 15:35:38 +03001184int hci_conn_security(struct hci_conn *conn, __u8 sec_level, __u8 auth_type,
1185 bool initiator)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001186{
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001187 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001188
Vinicius Costa Gomesd8343f12012-08-23 21:32:44 -03001189 if (conn->type == LE_LINK)
1190 return smp_conn_security(conn, sec_level);
1191
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001192 /* For sdp we don't need the link key. */
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001193 if (sec_level == BT_SECURITY_SDP)
1194 return 1;
1195
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001196 /* For non 2.1 devices and low security level we don't need the link
1197 key. */
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02001198 if (sec_level == BT_SECURITY_LOW && !hci_conn_ssp_enabled(conn))
Marcel Holtmann3fdca1e2009-04-28 09:04:55 -07001199 return 1;
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001200
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001201 /* For other security levels we need the link key. */
Johan Hedberg4dae2792014-06-24 17:03:50 +03001202 if (!test_bit(HCI_CONN_AUTH, &conn->flags))
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001203 goto auth;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001204
Marcel Holtmann7b5a9242014-01-15 22:37:39 -08001205 /* An authenticated FIPS approved combination key has sufficient
1206 * security for security level 4. */
1207 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256 &&
1208 sec_level == BT_SECURITY_FIPS)
1209 goto encrypt;
1210
1211 /* An authenticated combination key has sufficient security for
1212 security level 3. */
1213 if ((conn->key_type == HCI_LK_AUTH_COMBINATION_P192 ||
1214 conn->key_type == HCI_LK_AUTH_COMBINATION_P256) &&
1215 sec_level == BT_SECURITY_HIGH)
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001216 goto encrypt;
1217
1218 /* An unauthenticated combination key has sufficient security for
1219 security level 1 and 2. */
Marcel Holtmann66138ce2014-01-10 02:07:20 -08001220 if ((conn->key_type == HCI_LK_UNAUTH_COMBINATION_P192 ||
1221 conn->key_type == HCI_LK_UNAUTH_COMBINATION_P256) &&
Gustavo Padovan5974e4c2012-05-17 00:36:25 -03001222 (sec_level == BT_SECURITY_MEDIUM || sec_level == BT_SECURITY_LOW))
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001223 goto encrypt;
1224
1225 /* A combination key has always sufficient security for the security
1226 levels 1 or 2. High security level requires the combination key
1227 is generated using maximum PIN code length (16).
1228 For pre 2.1 units. */
1229 if (conn->key_type == HCI_LK_COMBINATION &&
Marcel Holtmann7b5a9242014-01-15 22:37:39 -08001230 (sec_level == BT_SECURITY_MEDIUM || sec_level == BT_SECURITY_LOW ||
1231 conn->pin_length == 16))
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001232 goto encrypt;
1233
1234auth:
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001235 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001236 return 0;
1237
Johan Hedberg977f8fc2014-07-17 15:35:39 +03001238 if (initiator)
1239 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
1240
Luiz Augusto von Dentz6fdf6582011-06-13 15:37:35 +03001241 if (!hci_conn_auth(conn, sec_level, auth_type))
1242 return 0;
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001243
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001244encrypt:
Johan Hedberg4dae2792014-06-24 17:03:50 +03001245 if (test_bit(HCI_CONN_ENCRYPT, &conn->flags))
Waldemar Rymarkiewicz13d39312011-04-28 12:07:55 +02001246 return 1;
1247
1248 hci_conn_encrypt(conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001249 return 0;
1250}
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001251EXPORT_SYMBOL(hci_conn_security);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001252
Waldemar Rymarkiewiczb3b1b062011-05-06 09:42:31 +02001253/* Check secure link requirement */
1254int hci_conn_check_secure(struct hci_conn *conn, __u8 sec_level)
1255{
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001256 BT_DBG("hcon %p", conn);
Waldemar Rymarkiewiczb3b1b062011-05-06 09:42:31 +02001257
Marcel Holtmann9cb2e032014-02-01 11:32:25 -08001258 /* Accept if non-secure or higher security level is required */
1259 if (sec_level != BT_SECURITY_HIGH && sec_level != BT_SECURITY_FIPS)
Waldemar Rymarkiewiczb3b1b062011-05-06 09:42:31 +02001260 return 1;
1261
Marcel Holtmann9cb2e032014-02-01 11:32:25 -08001262 /* Accept if secure or higher security level is already present */
1263 if (conn->sec_level == BT_SECURITY_HIGH ||
1264 conn->sec_level == BT_SECURITY_FIPS)
1265 return 1;
1266
1267 /* Reject not secure link */
1268 return 0;
Waldemar Rymarkiewiczb3b1b062011-05-06 09:42:31 +02001269}
1270EXPORT_SYMBOL(hci_conn_check_secure);
1271
Linus Torvalds1da177e2005-04-16 15:20:36 -07001272/* Switch role */
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001273int hci_conn_switch_role(struct hci_conn *conn, __u8 role)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001274{
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001275 BT_DBG("hcon %p", conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276
Johan Hedberg40bef302014-07-16 11:42:27 +03001277 if (role == conn->role)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001278 return 1;
1279
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001280 if (!test_and_set_bit(HCI_CONN_RSWITCH_PEND, &conn->flags)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001281 struct hci_cp_switch_role cp;
1282 bacpy(&cp.bdaddr, &conn->dst);
1283 cp.role = role;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001284 hci_send_cmd(conn->hdev, HCI_OP_SWITCH_ROLE, sizeof(cp), &cp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001285 }
Marcel Holtmann8c1b2352009-01-15 21:58:04 +01001286
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287 return 0;
1288}
1289EXPORT_SYMBOL(hci_conn_switch_role);
1290
Marcel Holtmann04837f62006-07-03 10:02:33 +02001291/* Enter active mode */
Jaikumar Ganesh14b12d02011-05-23 18:06:04 -07001292void hci_conn_enter_active_mode(struct hci_conn *conn, __u8 force_active)
Marcel Holtmann04837f62006-07-03 10:02:33 +02001293{
1294 struct hci_dev *hdev = conn->hdev;
1295
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001296 BT_DBG("hcon %p mode %d", conn, conn->mode);
Marcel Holtmann04837f62006-07-03 10:02:33 +02001297
Jaikumar Ganesh14b12d02011-05-23 18:06:04 -07001298 if (conn->mode != HCI_CM_SNIFF)
1299 goto timer;
1300
Johan Hedberg58a681e2012-01-16 06:47:28 +02001301 if (!test_bit(HCI_CONN_POWER_SAVE, &conn->flags) && !force_active)
Marcel Holtmann04837f62006-07-03 10:02:33 +02001302 goto timer;
1303
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001304 if (!test_and_set_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02001305 struct hci_cp_exit_sniff_mode cp;
YOSHIFUJI Hideakiaca31922007-03-25 20:12:50 -07001306 cp.handle = cpu_to_le16(conn->handle);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001307 hci_send_cmd(hdev, HCI_OP_EXIT_SNIFF_MODE, sizeof(cp), &cp);
Marcel Holtmann04837f62006-07-03 10:02:33 +02001308 }
1309
1310timer:
1311 if (hdev->idle_timeout > 0)
Johan Hedberga74a84f2013-10-16 18:11:40 +03001312 queue_delayed_work(hdev->workqueue, &conn->idle_work,
1313 msecs_to_jiffies(hdev->idle_timeout));
Marcel Holtmann04837f62006-07-03 10:02:33 +02001314}
1315
Linus Torvalds1da177e2005-04-16 15:20:36 -07001316/* Drop all connection on the device */
1317void hci_conn_hash_flush(struct hci_dev *hdev)
1318{
1319 struct hci_conn_hash *h = &hdev->conn_hash;
Andrei Emeltchenko3c4e0df2012-02-02 10:32:17 +02001320 struct hci_conn *c, *n;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321
1322 BT_DBG("hdev %s", hdev->name);
1323
Andrei Emeltchenko3c4e0df2012-02-02 10:32:17 +02001324 list_for_each_entry_safe(c, n, &h->list, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001325 c->state = BT_CLOSED;
1326
Johan Hedberg3a6d5762015-02-18 14:53:58 +02001327 hci_disconn_cfm(c, HCI_ERROR_LOCAL_HOST_TERM);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328 hci_conn_del(c);
1329 }
1330}
1331
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001332/* Check pending connect attempts */
1333void hci_conn_check_pending(struct hci_dev *hdev)
1334{
1335 struct hci_conn *conn;
1336
1337 BT_DBG("hdev %s", hdev->name);
1338
1339 hci_dev_lock(hdev);
1340
1341 conn = hci_conn_hash_lookup_state(hdev, ACL_LINK, BT_CONNECT2);
1342 if (conn)
Vinicius Costa Gomes1aef8662012-07-27 19:32:55 -03001343 hci_acl_create_connection(conn);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001344
1345 hci_dev_unlock(hdev);
1346}
1347
Johan Hedberg4dae2792014-06-24 17:03:50 +03001348static u32 get_link_mode(struct hci_conn *conn)
1349{
1350 u32 link_mode = 0;
1351
Johan Hedberg40bef302014-07-16 11:42:27 +03001352 if (conn->role == HCI_ROLE_MASTER)
Johan Hedberg4dae2792014-06-24 17:03:50 +03001353 link_mode |= HCI_LM_MASTER;
1354
1355 if (test_bit(HCI_CONN_ENCRYPT, &conn->flags))
1356 link_mode |= HCI_LM_ENCRYPT;
1357
1358 if (test_bit(HCI_CONN_AUTH, &conn->flags))
1359 link_mode |= HCI_LM_AUTH;
1360
1361 if (test_bit(HCI_CONN_SECURE, &conn->flags))
1362 link_mode |= HCI_LM_SECURE;
1363
1364 if (test_bit(HCI_CONN_FIPS, &conn->flags))
1365 link_mode |= HCI_LM_FIPS;
1366
1367 return link_mode;
1368}
1369
Linus Torvalds1da177e2005-04-16 15:20:36 -07001370int hci_get_conn_list(void __user *arg)
1371{
Gustavo Padovanfc5fef62012-05-23 04:04:19 -03001372 struct hci_conn *c;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001373 struct hci_conn_list_req req, *cl;
1374 struct hci_conn_info *ci;
1375 struct hci_dev *hdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001376 int n = 0, size, err;
1377
1378 if (copy_from_user(&req, arg, sizeof(req)))
1379 return -EFAULT;
1380
1381 if (!req.conn_num || req.conn_num > (PAGE_SIZE * 2) / sizeof(*ci))
1382 return -EINVAL;
1383
1384 size = sizeof(req) + req.conn_num * sizeof(*ci);
1385
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02001386 cl = kmalloc(size, GFP_KERNEL);
1387 if (!cl)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001388 return -ENOMEM;
1389
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02001390 hdev = hci_dev_get(req.dev_id);
1391 if (!hdev) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001392 kfree(cl);
1393 return -ENODEV;
1394 }
1395
1396 ci = cl->conn_info;
1397
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001398 hci_dev_lock(hdev);
Luiz Augusto von Dentz8035ded2011-11-01 10:58:56 +02001399 list_for_each_entry(c, &hdev->conn_hash.list, list) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001400 bacpy(&(ci + n)->bdaddr, &c->dst);
1401 (ci + n)->handle = c->handle;
1402 (ci + n)->type = c->type;
1403 (ci + n)->out = c->out;
1404 (ci + n)->state = c->state;
Johan Hedberg4dae2792014-06-24 17:03:50 +03001405 (ci + n)->link_mode = get_link_mode(c);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406 if (++n >= req.conn_num)
1407 break;
1408 }
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001409 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001410
1411 cl->dev_id = hdev->id;
1412 cl->conn_num = n;
1413 size = sizeof(req) + n * sizeof(*ci);
1414
1415 hci_dev_put(hdev);
1416
1417 err = copy_to_user(arg, cl, size);
1418 kfree(cl);
1419
1420 return err ? -EFAULT : 0;
1421}
1422
1423int hci_get_conn_info(struct hci_dev *hdev, void __user *arg)
1424{
1425 struct hci_conn_info_req req;
1426 struct hci_conn_info ci;
1427 struct hci_conn *conn;
1428 char __user *ptr = arg + sizeof(req);
1429
1430 if (copy_from_user(&req, arg, sizeof(req)))
1431 return -EFAULT;
1432
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001433 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001434 conn = hci_conn_hash_lookup_ba(hdev, req.type, &req.bdaddr);
1435 if (conn) {
1436 bacpy(&ci.bdaddr, &conn->dst);
1437 ci.handle = conn->handle;
1438 ci.type = conn->type;
1439 ci.out = conn->out;
1440 ci.state = conn->state;
Johan Hedberg4dae2792014-06-24 17:03:50 +03001441 ci.link_mode = get_link_mode(conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 }
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001443 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001444
1445 if (!conn)
1446 return -ENOENT;
1447
1448 return copy_to_user(ptr, &ci, sizeof(ci)) ? -EFAULT : 0;
1449}
Marcel Holtmann40be4922008-07-14 20:13:50 +02001450
1451int hci_get_auth_info(struct hci_dev *hdev, void __user *arg)
1452{
1453 struct hci_auth_info_req req;
1454 struct hci_conn *conn;
1455
1456 if (copy_from_user(&req, arg, sizeof(req)))
1457 return -EFAULT;
1458
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001459 hci_dev_lock(hdev);
Marcel Holtmann40be4922008-07-14 20:13:50 +02001460 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &req.bdaddr);
1461 if (conn)
1462 req.type = conn->auth_type;
Gustavo F. Padovan09fd0de2011-06-17 13:03:21 -03001463 hci_dev_unlock(hdev);
Marcel Holtmann40be4922008-07-14 20:13:50 +02001464
1465 if (!conn)
1466 return -ENOENT;
1467
1468 return copy_to_user(arg, &req, sizeof(req)) ? -EFAULT : 0;
1469}
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001470
1471struct hci_chan *hci_chan_create(struct hci_conn *conn)
1472{
1473 struct hci_dev *hdev = conn->hdev;
1474 struct hci_chan *chan;
1475
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001476 BT_DBG("%s hcon %p", hdev->name, conn);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001477
Johan Hedbergf94b6652014-08-18 00:41:44 +03001478 if (test_bit(HCI_CONN_DROP, &conn->flags)) {
1479 BT_DBG("Refusing to create new hci_chan");
1480 return NULL;
1481 }
1482
Johan Hedberg27f70f32014-07-21 10:50:06 +03001483 chan = kzalloc(sizeof(*chan), GFP_KERNEL);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001484 if (!chan)
1485 return NULL;
1486
Johan Hedberg6c388d32014-08-18 00:41:42 +03001487 chan->conn = hci_conn_get(conn);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001488 skb_queue_head_init(&chan->data_q);
Mat Martineau168df8e2012-10-23 15:24:13 -07001489 chan->state = BT_CONNECTED;
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001490
Gustavo F. Padovan8192ede2011-12-14 15:08:48 -02001491 list_add_rcu(&chan->list, &conn->chan_list);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001492
1493 return chan;
1494}
1495
Andrei Emeltchenko94720072012-09-06 15:05:43 +03001496void hci_chan_del(struct hci_chan *chan)
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001497{
1498 struct hci_conn *conn = chan->conn;
1499 struct hci_dev *hdev = conn->hdev;
1500
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001501 BT_DBG("%s hcon %p chan %p", hdev->name, conn, chan);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001502
Gustavo F. Padovan8192ede2011-12-14 15:08:48 -02001503 list_del_rcu(&chan->list);
1504
1505 synchronize_rcu();
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001506
Johan Hedbergbcbb6552014-08-18 20:33:27 +03001507 /* Prevent new hci_chan's to be created for this hci_conn */
Johan Hedbergf94b6652014-08-18 00:41:44 +03001508 set_bit(HCI_CONN_DROP, &conn->flags);
Johan Hedbergb3ff6702014-08-18 00:41:43 +03001509
Johan Hedberg6c388d32014-08-18 00:41:42 +03001510 hci_conn_put(conn);
Andrei Emeltchenkoe9b02742012-10-25 15:20:51 +03001511
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001512 skb_queue_purge(&chan->data_q);
1513 kfree(chan);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001514}
1515
Gustavo F. Padovan2c33c062011-12-14 13:02:51 -02001516void hci_chan_list_flush(struct hci_conn *conn)
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001517{
Andrei Emeltchenko2a5a5ec2012-02-02 10:32:18 +02001518 struct hci_chan *chan, *n;
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001519
Andrei Emeltchenko38b3fef2012-06-15 11:50:28 +03001520 BT_DBG("hcon %p", conn);
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001521
Andrei Emeltchenko2a5a5ec2012-02-02 10:32:18 +02001522 list_for_each_entry_safe(chan, n, &conn->chan_list, list)
Luiz Augusto von Dentz73d80de2011-11-02 15:52:01 +02001523 hci_chan_del(chan);
1524}
Andrei Emeltchenko42c4e532012-10-10 17:38:28 +03001525
1526static struct hci_chan *__hci_chan_lookup_handle(struct hci_conn *hcon,
1527 __u16 handle)
1528{
1529 struct hci_chan *hchan;
1530
1531 list_for_each_entry(hchan, &hcon->chan_list, list) {
1532 if (hchan->handle == handle)
1533 return hchan;
1534 }
1535
1536 return NULL;
1537}
1538
1539struct hci_chan *hci_chan_lookup_handle(struct hci_dev *hdev, __u16 handle)
1540{
1541 struct hci_conn_hash *h = &hdev->conn_hash;
1542 struct hci_conn *hcon;
1543 struct hci_chan *hchan = NULL;
1544
1545 rcu_read_lock();
1546
1547 list_for_each_entry_rcu(hcon, &h->list, list) {
1548 hchan = __hci_chan_lookup_handle(hcon, handle);
1549 if (hchan)
1550 break;
1551 }
1552
1553 rcu_read_unlock();
1554
1555 return hchan;
1556}