blob: 186041866315a4e107de086df52142f39d6c6ee3 [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 event handling. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <asm/unaligned.h>
28
29#include <net/bluetooth/bluetooth.h>
30#include <net/bluetooth/hci_core.h>
Mikel Astizf0d6a0e2012-08-09 09:52:30 +020031#include <net/bluetooth/mgmt.h>
Marcel Holtmann7ef9fbf2013-10-10 14:54:14 -070032
Johan Hedberg0857dd32014-12-19 13:40:20 +020033#include "hci_request.h"
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +010034#include "hci_debugfs.h"
Marcel Holtmann70247282013-10-10 14:54:15 -070035#include "a2mp.h"
Marcel Holtmann7ef9fbf2013-10-10 14:54:14 -070036#include "amp.h"
Johan Hedberg2ceba532014-06-16 19:25:16 +030037#include "smp.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070038
Marcel Holtmannaa5b0342015-01-27 16:04:33 -080039#define ZERO_KEY "\x00\x00\x00\x00\x00\x00\x00\x00" \
40 "\x00\x00\x00\x00\x00\x00\x00\x00"
41
Linus Torvalds1da177e2005-04-16 15:20:36 -070042/* Handle HCI Event packets */
43
Marcel Holtmanna9de9242007-10-20 13:33:56 +020044static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070045{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020046 __u8 status = *((__u8 *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030048 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -070049
Andre Guedes82f47852013-04-30 15:29:34 -030050 if (status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020051 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -070052
Andre Guedes89352e72011-11-04 14:16:53 -030053 clear_bit(HCI_INQUIRY, &hdev->flags);
Peter Zijlstra4e857c52014-03-17 18:06:10 +010054 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -030055 wake_up_bit(&hdev->flags, HCI_INQUIRY);
Andre Guedes89352e72011-11-04 14:16:53 -030056
Johan Hedberg50143a42014-06-10 14:05:57 +030057 hci_dev_lock(hdev);
58 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
59 hci_dev_unlock(hdev);
60
Marcel Holtmanna9de9242007-10-20 13:33:56 +020061 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -070062}
63
Andre Guedes4d934832012-03-21 00:03:35 -030064static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
65{
66 __u8 status = *((__u8 *) skb->data);
67
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030068 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesae854a72012-03-21 00:03:36 -030069
70 if (status)
71 return;
72
Marcel Holtmanna1536da2015-03-13 02:11:01 -070073 hci_dev_set_flag(hdev, HCI_PERIODIC_INQ);
Andre Guedes4d934832012-03-21 00:03:35 -030074}
75
Marcel Holtmanna9de9242007-10-20 13:33:56 +020076static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -070077{
Marcel Holtmanna9de9242007-10-20 13:33:56 +020078 __u8 status = *((__u8 *) skb->data);
79
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +030080 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +020081
82 if (status)
83 return;
84
Marcel Holtmanna358dc12015-03-13 02:11:02 -070085 hci_dev_clear_flag(hdev, HCI_PERIODIC_INQ);
Andre Guedesae854a72012-03-21 00:03:36 -030086
Marcel Holtmanna9de9242007-10-20 13:33:56 +020087 hci_conn_check_pending(hdev);
88}
89
Gustavo Padovan807deac2012-05-17 00:36:24 -030090static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
91 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +020092{
93 BT_DBG("%s", hdev->name);
94}
95
96static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
97{
98 struct hci_rp_role_discovery *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -070099 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300101 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200103 if (rp->status)
104 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200106 hci_dev_lock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200108 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Johan Hedberg40bef302014-07-16 11:42:27 +0300109 if (conn)
110 conn->role = rp->role;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200111
112 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113}
114
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200115static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
116{
117 struct hci_rp_read_link_policy *rp = (void *) skb->data;
118 struct hci_conn *conn;
119
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300120 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200121
122 if (rp->status)
123 return;
124
125 hci_dev_lock(hdev);
126
127 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
128 if (conn)
129 conn->link_policy = __le16_to_cpu(rp->policy);
130
131 hci_dev_unlock(hdev);
132}
133
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200134static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135{
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200136 struct hci_rp_write_link_policy *rp = (void *) skb->data;
137 struct hci_conn *conn;
138 void *sent;
139
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300140 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200141
142 if (rp->status)
143 return;
144
145 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
146 if (!sent)
147 return;
148
149 hci_dev_lock(hdev);
150
151 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200152 if (conn)
Harvey Harrison83985312008-05-02 16:25:46 -0700153 conn->link_policy = get_unaligned_le16(sent + 2);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200154
155 hci_dev_unlock(hdev);
156}
157
Gustavo Padovan807deac2012-05-17 00:36:24 -0300158static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
159 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200160{
161 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
162
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300163 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200164
165 if (rp->status)
166 return;
167
168 hdev->link_policy = __le16_to_cpu(rp->policy);
169}
170
Gustavo Padovan807deac2012-05-17 00:36:24 -0300171static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
172 struct sk_buff *skb)
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200173{
174 __u8 status = *((__u8 *) skb->data);
175 void *sent;
176
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300177 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200178
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200179 if (status)
180 return;
181
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200182 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
183 if (!sent)
184 return;
185
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200186 hdev->link_policy = get_unaligned_le16(sent);
Marcel Holtmanne4e8e372008-07-14 20:13:47 +0200187}
188
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200189static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
190{
191 __u8 status = *((__u8 *) skb->data);
192
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300193 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200194
Gustavo F. Padovan10572132011-03-16 15:36:29 -0300195 clear_bit(HCI_RESET, &hdev->flags);
196
Marcel Holtmann8761f9d2014-11-02 02:45:58 +0100197 if (status)
198 return;
199
Johan Hedberga297e972012-02-21 17:55:47 +0200200 /* Reset all non-persistent flags */
Marcel Holtmanneacb44d2015-03-13 09:04:17 -0700201 hci_dev_clear_volatile_flags(hdev);
Andre Guedes69775ff2012-02-23 16:50:05 +0200202
Johan Hedberg39c5d972015-01-28 19:56:01 +0200203 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
204
Johan Hedbergbbaf4442012-11-08 01:22:59 +0100205 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
206 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
Johan Hedberg3f0f5242012-11-08 01:23:00 +0100207
208 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
209 hdev->adv_data_len = 0;
Marcel Holtmannf8e808b2013-10-16 00:16:47 -0700210
211 memset(hdev->scan_rsp_data, 0, sizeof(hdev->scan_rsp_data));
212 hdev->scan_rsp_data_len = 0;
Marcel Holtmann06f5b772013-10-19 07:09:11 -0700213
Marcel Holtmann533553f2014-03-21 12:18:10 -0700214 hdev->le_scan_type = LE_SCAN_PASSIVE;
215
Marcel Holtmann06f5b772013-10-19 07:09:11 -0700216 hdev->ssp_debug_mode = 0;
Marcel Holtmanna4d55042014-10-29 23:37:53 +0100217
218 hci_bdaddr_list_clear(&hdev->le_white_list);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200219}
220
Marcel Holtmannc2f0f972015-01-12 09:21:25 -0800221static void hci_cc_read_stored_link_key(struct hci_dev *hdev,
222 struct sk_buff *skb)
223{
224 struct hci_rp_read_stored_link_key *rp = (void *)skb->data;
225 struct hci_cp_read_stored_link_key *sent;
226
227 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
228
229 sent = hci_sent_cmd_data(hdev, HCI_OP_READ_STORED_LINK_KEY);
230 if (!sent)
231 return;
232
233 if (!rp->status && sent->read_all == 0x01) {
234 hdev->stored_max_keys = rp->max_keys;
235 hdev->stored_num_keys = rp->num_keys;
236 }
237}
238
Marcel Holtmanna9366122015-01-12 09:21:28 -0800239static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
240 struct sk_buff *skb)
241{
242 struct hci_rp_delete_stored_link_key *rp = (void *)skb->data;
243
244 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
245
246 if (rp->status)
247 return;
248
249 if (rp->num_keys <= hdev->stored_num_keys)
250 hdev->stored_num_keys -= rp->num_keys;
251 else
252 hdev->stored_num_keys = 0;
253}
254
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200255static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
256{
257 __u8 status = *((__u8 *) skb->data);
258 void *sent;
259
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300260 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200261
262 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
263 if (!sent)
264 return;
265
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200266 hci_dev_lock(hdev);
267
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700268 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200269 mgmt_set_local_name_complete(hdev, sent, status);
Johan Hedberg28cc7bd2012-02-22 21:06:55 +0200270 else if (!status)
271 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
Johan Hedbergf51d5b22012-02-22 18:17:32 +0200272
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200273 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200274}
275
276static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
277{
278 struct hci_rp_read_local_name *rp = (void *) skb->data;
279
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300280 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200281
282 if (rp->status)
283 return;
284
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700285 if (hci_dev_test_flag(hdev, HCI_SETUP) ||
286 hci_dev_test_flag(hdev, HCI_CONFIG))
Johan Hedbergdb99b5f2012-02-22 20:14:22 +0200287 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200288}
289
290static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
291{
292 __u8 status = *((__u8 *) skb->data);
293 void *sent;
294
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300295 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200296
297 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
298 if (!sent)
299 return;
300
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +0530301 hci_dev_lock(hdev);
302
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200303 if (!status) {
304 __u8 param = *((__u8 *) sent);
305
306 if (param == AUTH_ENABLED)
307 set_bit(HCI_AUTH, &hdev->flags);
308 else
309 clear_bit(HCI_AUTH, &hdev->flags);
310 }
311
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700312 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg33ef95e2012-02-16 23:56:27 +0200313 mgmt_auth_enable_complete(hdev, status);
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +0530314
315 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200316}
317
318static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
319{
320 __u8 status = *((__u8 *) skb->data);
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200321 __u8 param;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200322 void *sent;
323
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300324 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200325
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200326 if (status)
327 return;
328
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200329 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
330 if (!sent)
331 return;
332
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200333 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200334
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200335 if (param)
336 set_bit(HCI_ENCRYPT, &hdev->flags);
337 else
338 clear_bit(HCI_ENCRYPT, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200339}
340
341static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
342{
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200343 __u8 status = *((__u8 *) skb->data);
344 __u8 param;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200345 void *sent;
346
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300347 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200348
349 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
350 if (!sent)
351 return;
352
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200353 param = *((__u8 *) sent);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200354
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200355 hci_dev_lock(hdev);
356
Mikel Astizfa1bd912012-08-09 09:52:29 +0200357 if (status) {
Johan Hedberg2d7cee52011-11-07 22:16:03 +0200358 hdev->discov_timeout = 0;
359 goto done;
360 }
361
Johan Hedbergbc6d2d02014-07-10 12:09:08 +0300362 if (param & SCAN_INQUIRY)
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200363 set_bit(HCI_ISCAN, &hdev->flags);
Johan Hedbergbc6d2d02014-07-10 12:09:08 +0300364 else
365 clear_bit(HCI_ISCAN, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200366
Johan Hedberg031547d2014-07-10 12:09:06 +0300367 if (param & SCAN_PAGE)
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200368 set_bit(HCI_PSCAN, &hdev->flags);
Johan Hedbergbc6d2d02014-07-10 12:09:08 +0300369 else
Johan Hedberg204e3992014-07-28 15:45:31 +0300370 clear_bit(HCI_PSCAN, &hdev->flags);
Johan Hedberg36f7fc72011-11-04 00:17:45 +0200371
372done:
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200373 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200374}
375
376static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
377{
378 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
379
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300380 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200381
382 if (rp->status)
383 return;
384
385 memcpy(hdev->dev_class, rp->dev_class, 3);
386
387 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300388 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200389}
390
391static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
392{
393 __u8 status = *((__u8 *) skb->data);
394 void *sent;
395
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300396 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200397
398 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
399 if (!sent)
400 return;
401
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100402 hci_dev_lock(hdev);
403
404 if (status == 0)
405 memcpy(hdev->dev_class, sent, 3);
406
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700407 if (hci_dev_test_flag(hdev, HCI_MGMT))
Marcel Holtmann7f9a9032012-02-22 18:38:01 +0100408 mgmt_set_class_of_dev_complete(hdev, sent, status);
409
410 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200411}
412
413static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
414{
415 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 __u16 setting;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200417
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300418 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200419
420 if (rp->status)
421 return;
422
423 setting = __le16_to_cpu(rp->voice_setting);
424
Marcel Holtmannf383f272008-07-14 20:13:47 +0200425 if (hdev->voice_setting == setting)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200426 return;
427
428 hdev->voice_setting = setting;
429
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300430 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200431
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200432 if (hdev->notify)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200433 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200434}
435
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300436static void hci_cc_write_voice_setting(struct hci_dev *hdev,
437 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200438{
439 __u8 status = *((__u8 *) skb->data);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200440 __u16 setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700441 void *sent;
442
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300443 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444
Marcel Holtmannf383f272008-07-14 20:13:47 +0200445 if (status)
446 return;
447
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200448 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
449 if (!sent)
450 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451
Marcel Holtmannf383f272008-07-14 20:13:47 +0200452 setting = get_unaligned_le16(sent);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700453
Marcel Holtmannf383f272008-07-14 20:13:47 +0200454 if (hdev->voice_setting == setting)
455 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700456
Marcel Holtmannf383f272008-07-14 20:13:47 +0200457 hdev->voice_setting = setting;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700458
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300459 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
Marcel Holtmannf383f272008-07-14 20:13:47 +0200460
Gustavo F. Padovan3c547112011-12-14 22:58:44 -0200461 if (hdev->notify)
Marcel Holtmannf383f272008-07-14 20:13:47 +0200462 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463}
464
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -0700465static void hci_cc_read_num_supported_iac(struct hci_dev *hdev,
466 struct sk_buff *skb)
467{
468 struct hci_rp_read_num_supported_iac *rp = (void *) skb->data;
469
470 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
471
472 if (rp->status)
473 return;
474
475 hdev->num_iac = rp->num_iac;
476
477 BT_DBG("%s num iac %d", hdev->name, hdev->num_iac);
478}
479
Marcel Holtmann333140b2008-07-14 20:13:48 +0200480static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
481{
482 __u8 status = *((__u8 *) skb->data);
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300483 struct hci_cp_write_ssp_mode *sent;
Marcel Holtmann333140b2008-07-14 20:13:48 +0200484
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300485 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200486
Marcel Holtmann333140b2008-07-14 20:13:48 +0200487 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
488 if (!sent)
489 return;
490
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +0530491 hci_dev_lock(hdev);
492
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300493 if (!status) {
494 if (sent->mode)
Johan Hedbergcad718e2013-04-17 15:00:51 +0300495 hdev->features[1][0] |= LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300496 else
Johan Hedbergcad718e2013-04-17 15:00:51 +0300497 hdev->features[1][0] &= ~LMP_HOST_SSP;
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300498 }
499
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700500 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300501 mgmt_ssp_enable_complete(hdev, sent->mode, status);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200502 else if (!status) {
Johan Hedberg5ed8eb22012-10-25 00:09:51 +0300503 if (sent->mode)
Marcel Holtmanna1536da2015-03-13 02:11:01 -0700504 hci_dev_set_flag(hdev, HCI_SSP_ENABLED);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200505 else
Marcel Holtmanna358dc12015-03-13 02:11:02 -0700506 hci_dev_clear_flag(hdev, HCI_SSP_ENABLED);
Johan Hedbergc0ecddc2012-02-22 12:38:31 +0200507 }
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +0530508
509 hci_dev_unlock(hdev);
Marcel Holtmann333140b2008-07-14 20:13:48 +0200510}
511
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800512static void hci_cc_write_sc_support(struct hci_dev *hdev, struct sk_buff *skb)
513{
514 u8 status = *((u8 *) skb->data);
515 struct hci_cp_write_sc_support *sent;
516
517 BT_DBG("%s status 0x%2.2x", hdev->name, status);
518
519 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SC_SUPPORT);
520 if (!sent)
521 return;
522
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +0530523 hci_dev_lock(hdev);
524
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800525 if (!status) {
526 if (sent->support)
527 hdev->features[1][0] |= LMP_HOST_SC;
528 else
529 hdev->features[1][0] &= ~LMP_HOST_SC;
530 }
531
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700532 if (!hci_dev_test_flag(hdev, HCI_MGMT) && !status) {
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800533 if (sent->support)
Marcel Holtmanna1536da2015-03-13 02:11:01 -0700534 hci_dev_set_flag(hdev, HCI_SC_ENABLED);
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800535 else
Marcel Holtmanna358dc12015-03-13 02:11:02 -0700536 hci_dev_clear_flag(hdev, HCI_SC_ENABLED);
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800537 }
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +0530538
539 hci_dev_unlock(hdev);
Marcel Holtmanneac83dc2014-01-10 02:07:23 -0800540}
541
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200542static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
543{
544 struct hci_rp_read_local_version *rp = (void *) skb->data;
545
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300546 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200547
548 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200549 return;
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200550
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700551 if (hci_dev_test_flag(hdev, HCI_SETUP) ||
552 hci_dev_test_flag(hdev, HCI_CONFIG)) {
Marcel Holtmann0d5551f2013-10-18 12:04:50 -0700553 hdev->hci_ver = rp->hci_ver;
554 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
555 hdev->lmp_ver = rp->lmp_ver;
556 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
557 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
558 }
Johan Hedbergd5859e22011-01-25 01:19:58 +0200559}
560
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300561static void hci_cc_read_local_commands(struct hci_dev *hdev,
562 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200563{
564 struct hci_rp_read_local_commands *rp = (void *) skb->data;
565
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300566 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200567
Marcel Holtmann6a070e62013-10-31 04:54:33 -0700568 if (rp->status)
569 return;
570
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700571 if (hci_dev_test_flag(hdev, HCI_SETUP) ||
572 hci_dev_test_flag(hdev, HCI_CONFIG))
Johan Hedberg2177bab2013-03-05 20:37:43 +0200573 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200574}
575
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -0300576static void hci_cc_read_local_features(struct hci_dev *hdev,
577 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200578{
579 struct hci_rp_read_local_features *rp = (void *) skb->data;
580
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300581 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200582
583 if (rp->status)
584 return;
585
586 memcpy(hdev->features, rp->features, 8);
587
588 /* Adjust default settings according to features
589 * supported by device. */
590
Johan Hedbergcad718e2013-04-17 15:00:51 +0300591 if (hdev->features[0][0] & LMP_3SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200592 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
593
Johan Hedbergcad718e2013-04-17 15:00:51 +0300594 if (hdev->features[0][0] & LMP_5SLOT)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200595 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
596
Johan Hedbergcad718e2013-04-17 15:00:51 +0300597 if (hdev->features[0][1] & LMP_HV2) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200598 hdev->pkt_type |= (HCI_HV2);
599 hdev->esco_type |= (ESCO_HV2);
600 }
601
Johan Hedbergcad718e2013-04-17 15:00:51 +0300602 if (hdev->features[0][1] & LMP_HV3) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200603 hdev->pkt_type |= (HCI_HV3);
604 hdev->esco_type |= (ESCO_HV3);
605 }
606
Andre Guedes45db810f2012-07-24 15:03:49 -0300607 if (lmp_esco_capable(hdev))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200608 hdev->esco_type |= (ESCO_EV3);
609
Johan Hedbergcad718e2013-04-17 15:00:51 +0300610 if (hdev->features[0][4] & LMP_EV4)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200611 hdev->esco_type |= (ESCO_EV4);
612
Johan Hedbergcad718e2013-04-17 15:00:51 +0300613 if (hdev->features[0][4] & LMP_EV5)
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200614 hdev->esco_type |= (ESCO_EV5);
615
Johan Hedbergcad718e2013-04-17 15:00:51 +0300616 if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100617 hdev->esco_type |= (ESCO_2EV3);
618
Johan Hedbergcad718e2013-04-17 15:00:51 +0300619 if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100620 hdev->esco_type |= (ESCO_3EV3);
621
Johan Hedbergcad718e2013-04-17 15:00:51 +0300622 if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
Marcel Holtmannefc76882009-02-06 09:13:37 +0100623 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200624}
625
Andre Guedes971e3a42011-06-30 19:20:52 -0300626static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300627 struct sk_buff *skb)
Andre Guedes971e3a42011-06-30 19:20:52 -0300628{
629 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
630
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300631 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andre Guedes971e3a42011-06-30 19:20:52 -0300632
633 if (rp->status)
Johan Hedberg42c6b122013-03-05 20:37:49 +0200634 return;
Andre Guedes971e3a42011-06-30 19:20:52 -0300635
Marcel Holtmann57af75a2013-10-18 12:04:47 -0700636 if (hdev->max_page < rp->max_page)
637 hdev->max_page = rp->max_page;
Johan Hedbergd2c5d772013-04-17 15:00:52 +0300638
Johan Hedbergcad718e2013-04-17 15:00:51 +0300639 if (rp->page < HCI_MAX_PAGES)
640 memcpy(hdev->features[rp->page], rp->features, 8);
Andre Guedes971e3a42011-06-30 19:20:52 -0300641}
642
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200643static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300644 struct sk_buff *skb)
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200645{
646 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
647
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300648 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200649
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200650 if (rp->status)
651 return;
652
653 hdev->flow_ctl_mode = rp->mode;
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +0200654}
655
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200656static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
657{
658 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
659
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300660 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200661
662 if (rp->status)
663 return;
664
665 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
666 hdev->sco_mtu = rp->sco_mtu;
667 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
668 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
669
670 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
671 hdev->sco_mtu = 64;
672 hdev->sco_pkts = 8;
673 }
674
675 hdev->acl_cnt = hdev->acl_pkts;
676 hdev->sco_cnt = hdev->sco_pkts;
677
Gustavo Padovan807deac2012-05-17 00:36:24 -0300678 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
679 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200680}
681
682static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
683{
684 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
685
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300686 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200687
Marcel Holtmanne30d3f52014-07-05 10:48:03 +0200688 if (rp->status)
689 return;
690
691 if (test_bit(HCI_INIT, &hdev->flags))
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200692 bacpy(&hdev->bdaddr, &rp->bdaddr);
Marcel Holtmanne30d3f52014-07-05 10:48:03 +0200693
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700694 if (hci_dev_test_flag(hdev, HCI_SETUP))
Marcel Holtmanne30d3f52014-07-05 10:48:03 +0200695 bacpy(&hdev->setup_addr, &rp->bdaddr);
Johan Hedberg23bb5762010-12-21 23:01:27 +0200696}
697
Johan Hedbergf332ec62013-03-15 17:07:11 -0500698static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
699 struct sk_buff *skb)
700{
701 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
702
703 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
704
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200705 if (rp->status)
706 return;
707
708 if (test_bit(HCI_INIT, &hdev->flags)) {
Johan Hedbergf332ec62013-03-15 17:07:11 -0500709 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
710 hdev->page_scan_window = __le16_to_cpu(rp->window);
711 }
712}
713
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500714static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
715 struct sk_buff *skb)
716{
717 u8 status = *((u8 *) skb->data);
718 struct hci_cp_write_page_scan_activity *sent;
719
720 BT_DBG("%s status 0x%2.2x", hdev->name, status);
721
722 if (status)
723 return;
724
725 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
726 if (!sent)
727 return;
728
729 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
730 hdev->page_scan_window = __le16_to_cpu(sent->window);
731}
732
Johan Hedbergf332ec62013-03-15 17:07:11 -0500733static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
734 struct sk_buff *skb)
735{
736 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
737
738 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
739
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200740 if (rp->status)
741 return;
742
743 if (test_bit(HCI_INIT, &hdev->flags))
Johan Hedbergf332ec62013-03-15 17:07:11 -0500744 hdev->page_scan_type = rp->type;
745}
746
Johan Hedberg4a3ee762013-03-15 17:07:12 -0500747static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
748 struct sk_buff *skb)
749{
750 u8 status = *((u8 *) skb->data);
751 u8 *type;
752
753 BT_DBG("%s status 0x%2.2x", hdev->name, status);
754
755 if (status)
756 return;
757
758 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
759 if (type)
760 hdev->page_scan_type = *type;
761}
762
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200763static void hci_cc_read_data_block_size(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300764 struct sk_buff *skb)
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200765{
766 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
767
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300768 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200769
770 if (rp->status)
771 return;
772
773 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
774 hdev->block_len = __le16_to_cpu(rp->block_len);
775 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
776
777 hdev->block_cnt = hdev->num_blocks;
778
779 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300780 hdev->block_cnt, hdev->block_len);
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +0200781}
782
Johan Hedberg33f35722014-06-28 17:54:06 +0300783static void hci_cc_read_clock(struct hci_dev *hdev, struct sk_buff *skb)
784{
785 struct hci_rp_read_clock *rp = (void *) skb->data;
786 struct hci_cp_read_clock *cp;
787 struct hci_conn *conn;
788
789 BT_DBG("%s", hdev->name);
790
791 if (skb->len < sizeof(*rp))
792 return;
793
794 if (rp->status)
795 return;
796
797 hci_dev_lock(hdev);
798
799 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_CLOCK);
800 if (!cp)
801 goto unlock;
802
803 if (cp->which == 0x00) {
804 hdev->clock = le32_to_cpu(rp->clock);
805 goto unlock;
806 }
807
808 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
809 if (conn) {
810 conn->clock = le32_to_cpu(rp->clock);
811 conn->clock_accuracy = le16_to_cpu(rp->accuracy);
812 }
813
814unlock:
815 hci_dev_unlock(hdev);
816}
817
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300818static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300819 struct sk_buff *skb)
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300820{
821 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
822
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300823 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300824
825 if (rp->status)
Arron Wang83927882015-07-24 17:10:16 +0800826 return;
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300827
828 hdev->amp_status = rp->amp_status;
829 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
830 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
831 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
832 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
833 hdev->amp_type = rp->amp_type;
834 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
835 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
836 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
837 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +0300838}
839
Johan Hedbergd5859e22011-01-25 01:19:58 +0200840static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300841 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200842{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700843 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200844
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300845 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200846
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200847 if (rp->status)
848 return;
849
850 hdev->inq_tx_power = rp->tx_power;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200851}
852
Johan Hedberg980e1a52011-01-22 06:10:07 +0200853static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
854{
855 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
856 struct hci_cp_pin_code_reply *cp;
857 struct hci_conn *conn;
858
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300859 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200860
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200861 hci_dev_lock(hdev);
862
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700863 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg744cf192011-11-08 20:40:14 +0200864 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200865
Mikel Astizfa1bd912012-08-09 09:52:29 +0200866 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200867 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200868
869 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
870 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200871 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200872
873 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
874 if (conn)
875 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200876
877unlock:
878 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200879}
880
881static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
882{
883 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
884
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300885 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200886
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200887 hci_dev_lock(hdev);
888
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700889 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg744cf192011-11-08 20:40:14 +0200890 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300891 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200892
893 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200894}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200895
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300896static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
897 struct sk_buff *skb)
898{
899 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
900
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300901 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300902
903 if (rp->status)
904 return;
905
906 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
907 hdev->le_pkts = rp->le_max_pkt;
908
909 hdev->le_cnt = hdev->le_pkts;
910
911 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300912}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200913
Johan Hedberg60e77322013-01-22 14:01:59 +0200914static void hci_cc_le_read_local_features(struct hci_dev *hdev,
915 struct sk_buff *skb)
916{
917 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
918
919 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
920
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200921 if (rp->status)
922 return;
923
924 memcpy(hdev->le_features, rp->features, 8);
Johan Hedberg60e77322013-01-22 14:01:59 +0200925}
926
Johan Hedberg8fa19092012-10-19 20:57:49 +0300927static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
928 struct sk_buff *skb)
929{
930 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
931
932 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
933
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200934 if (rp->status)
935 return;
936
937 hdev->adv_tx_power = rp->tx_power;
Johan Hedberg8fa19092012-10-19 20:57:49 +0300938}
939
Johan Hedberga5c29682011-02-19 12:05:57 -0300940static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
941{
942 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
943
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300944 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300945
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200946 hci_dev_lock(hdev);
947
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700948 if (hci_dev_test_flag(hdev, HCI_MGMT))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300949 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
950 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200951
952 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300953}
954
955static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300956 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -0300957{
958 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
959
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300960 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300961
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200962 hci_dev_lock(hdev);
963
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700964 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg744cf192011-11-08 20:40:14 +0200965 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300966 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200967
968 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300969}
970
Brian Gix1143d452011-11-23 08:28:34 -0800971static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
972{
973 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
974
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300975 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800976
977 hci_dev_lock(hdev);
978
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700979 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg272d90d2012-02-09 15:26:12 +0200980 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300981 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800982
983 hci_dev_unlock(hdev);
984}
985
986static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300987 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -0800988{
989 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
990
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300991 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800992
993 hci_dev_lock(hdev);
994
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700995 if (hci_dev_test_flag(hdev, HCI_MGMT))
Brian Gix1143d452011-11-23 08:28:34 -0800996 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300997 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -0800998
999 hci_dev_unlock(hdev);
1000}
1001
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08001002static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
1003 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +01001004{
1005 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
1006
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001007 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08001008}
1009
1010static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
1011 struct sk_buff *skb)
1012{
1013 struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;
1014
1015 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +01001016}
1017
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08001018static void hci_cc_le_set_random_addr(struct hci_dev *hdev, struct sk_buff *skb)
1019{
1020 __u8 status = *((__u8 *) skb->data);
1021 bdaddr_t *sent;
1022
1023 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1024
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001025 if (status)
1026 return;
1027
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08001028 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
1029 if (!sent)
1030 return;
1031
1032 hci_dev_lock(hdev);
1033
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001034 bacpy(&hdev->random_addr, sent);
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08001035
1036 hci_dev_unlock(hdev);
1037}
1038
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001039static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
1040{
1041 __u8 *sent, status = *((__u8 *) skb->data);
1042
1043 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1044
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001045 if (status)
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001046 return;
1047
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001048 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
1049 if (!sent)
Johan Hedberg3c857752014-03-25 10:30:49 +02001050 return;
1051
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001052 hci_dev_lock(hdev);
1053
Stephen Hemminger49c922b2014-10-27 21:12:20 -07001054 /* If we're doing connection initiation as peripheral. Set a
Johan Hedberg3c857752014-03-25 10:30:49 +02001055 * timeout in case something goes wrong.
1056 */
1057 if (*sent) {
1058 struct hci_conn *conn;
1059
Marcel Holtmanna1536da2015-03-13 02:11:01 -07001060 hci_dev_set_flag(hdev, HCI_LE_ADV);
Johan Hedberg66c417c2014-07-08 15:07:47 +03001061
Jakub Pawlowskie7d9ab72015-08-07 20:22:52 +02001062 conn = hci_lookup_le_connect(hdev);
Johan Hedberg3c857752014-03-25 10:30:49 +02001063 if (conn)
1064 queue_delayed_work(hdev->workqueue,
1065 &conn->le_conn_timeout,
Johan Hedberg09ae2602014-07-06 13:41:15 +03001066 conn->conn_timeout);
Johan Hedberg66c417c2014-07-08 15:07:47 +03001067 } else {
Marcel Holtmanna358dc12015-03-13 02:11:02 -07001068 hci_dev_clear_flag(hdev, HCI_LE_ADV);
Johan Hedberg3c857752014-03-25 10:30:49 +02001069 }
1070
Johan Hedberg04b4edc2013-03-15 17:07:01 -05001071 hci_dev_unlock(hdev);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001072}
1073
Marcel Holtmann533553f2014-03-21 12:18:10 -07001074static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
1075{
1076 struct hci_cp_le_set_scan_param *cp;
1077 __u8 status = *((__u8 *) skb->data);
1078
1079 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1080
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001081 if (status)
1082 return;
1083
Marcel Holtmann533553f2014-03-21 12:18:10 -07001084 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
1085 if (!cp)
1086 return;
1087
1088 hci_dev_lock(hdev);
1089
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001090 hdev->le_scan_type = cp->type;
Marcel Holtmann533553f2014-03-21 12:18:10 -07001091
1092 hci_dev_unlock(hdev);
1093}
1094
Johan Hedbergb9a63282014-03-25 10:51:52 +02001095static bool has_pending_adv_report(struct hci_dev *hdev)
1096{
1097 struct discovery_state *d = &hdev->discovery;
1098
1099 return bacmp(&d->last_adv_addr, BDADDR_ANY);
1100}
1101
1102static void clear_pending_adv_report(struct hci_dev *hdev)
1103{
1104 struct discovery_state *d = &hdev->discovery;
1105
1106 bacpy(&d->last_adv_addr, BDADDR_ANY);
1107 d->last_adv_data_len = 0;
1108}
1109
1110static void store_pending_adv_report(struct hci_dev *hdev, bdaddr_t *bdaddr,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02001111 u8 bdaddr_type, s8 rssi, u32 flags,
1112 u8 *data, u8 len)
Johan Hedbergb9a63282014-03-25 10:51:52 +02001113{
1114 struct discovery_state *d = &hdev->discovery;
1115
1116 bacpy(&d->last_adv_addr, bdaddr);
1117 d->last_adv_addr_type = bdaddr_type;
Johan Hedbergff5cd292014-03-25 14:40:52 +02001118 d->last_adv_rssi = rssi;
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02001119 d->last_adv_flags = flags;
Johan Hedbergb9a63282014-03-25 10:51:52 +02001120 memcpy(d->last_adv_data, data, len);
1121 d->last_adv_data_len = len;
1122}
1123
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001124static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001125 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001126{
1127 struct hci_cp_le_set_scan_enable *cp;
1128 __u8 status = *((__u8 *) skb->data);
1129
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001130 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001131
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001132 if (status)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001133 return;
1134
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001135 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1136 if (!cp)
Andre Guedes3fd319b2013-04-30 15:29:36 -03001137 return;
1138
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301139 hci_dev_lock(hdev);
1140
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001141 switch (cp->enable) {
Andre Guedes76a388b2013-04-04 20:21:02 -03001142 case LE_SCAN_ENABLE:
Marcel Holtmanna1536da2015-03-13 02:11:01 -07001143 hci_dev_set_flag(hdev, HCI_LE_SCAN);
Johan Hedbergb9a63282014-03-25 10:51:52 +02001144 if (hdev->le_scan_type == LE_SCAN_ACTIVE)
1145 clear_pending_adv_report(hdev);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001146 break;
1147
Andre Guedes76a388b2013-04-04 20:21:02 -03001148 case LE_SCAN_DISABLE:
Johan Hedbergb9a63282014-03-25 10:51:52 +02001149 /* We do this here instead of when setting DISCOVERY_STOPPED
1150 * since the latter would potentially require waiting for
1151 * inquiry to stop too.
1152 */
1153 if (has_pending_adv_report(hdev)) {
1154 struct discovery_state *d = &hdev->discovery;
1155
1156 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergab0aa432014-03-26 14:17:12 +02001157 d->last_adv_addr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02001158 d->last_adv_rssi, d->last_adv_flags,
Johan Hedbergab0aa432014-03-26 14:17:12 +02001159 d->last_adv_data,
Johan Hedbergb9a63282014-03-25 10:51:52 +02001160 d->last_adv_data_len, NULL, 0);
1161 }
1162
Johan Hedberg317ac8c2014-02-28 20:26:12 +02001163 /* Cancel this timer so that we don't try to disable scanning
1164 * when it's already disabled.
1165 */
1166 cancel_delayed_work(&hdev->le_scan_disable);
1167
Marcel Holtmanna358dc12015-03-13 02:11:02 -07001168 hci_dev_clear_flag(hdev, HCI_LE_SCAN);
Johan Hedberge8bb6b92014-07-08 15:07:53 +03001169
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001170 /* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
1171 * interrupted scanning due to a connect request. Mark
Johan Hedberge8bb6b92014-07-08 15:07:53 +03001172 * therefore discovery as stopped. If this was not
1173 * because of a connect request advertising might have
1174 * been disabled because of active scanning, so
1175 * re-enable it again if necessary.
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001176 */
Marcel Holtmanna69d8922015-03-13 02:11:05 -07001177 if (hci_dev_test_and_clear_flag(hdev, HCI_LE_SCAN_INTERRUPTED))
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001178 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001179 else if (!hci_dev_test_flag(hdev, HCI_LE_ADV) &&
Johan Hedberg34722272014-07-08 16:05:05 +03001180 hdev->discovery.state == DISCOVERY_FINDING)
Johan Hedberge8bb6b92014-07-08 15:07:53 +03001181 mgmt_reenable_advertising(hdev);
1182
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001183 break;
1184
1185 default:
1186 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1187 break;
Andre Guedes35815082011-05-26 16:23:53 -03001188 }
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301189
1190 hci_dev_unlock(hdev);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001191}
1192
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001193static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1194 struct sk_buff *skb)
1195{
1196 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1197
1198 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1199
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001200 if (rp->status)
1201 return;
1202
1203 hdev->le_white_list_size = rp->size;
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001204}
1205
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001206static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
1207 struct sk_buff *skb)
1208{
1209 __u8 status = *((__u8 *) skb->data);
1210
1211 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1212
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001213 if (status)
1214 return;
1215
Johan Hedbergdcc36c12014-07-09 12:59:13 +03001216 hci_bdaddr_list_clear(&hdev->le_white_list);
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001217}
1218
1219static void hci_cc_le_add_to_white_list(struct hci_dev *hdev,
1220 struct sk_buff *skb)
1221{
1222 struct hci_cp_le_add_to_white_list *sent;
1223 __u8 status = *((__u8 *) skb->data);
1224
1225 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1226
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001227 if (status)
1228 return;
1229
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001230 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_WHITE_LIST);
1231 if (!sent)
1232 return;
1233
Johan Hedbergdcc36c12014-07-09 12:59:13 +03001234 hci_bdaddr_list_add(&hdev->le_white_list, &sent->bdaddr,
1235 sent->bdaddr_type);
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001236}
1237
1238static void hci_cc_le_del_from_white_list(struct hci_dev *hdev,
1239 struct sk_buff *skb)
1240{
1241 struct hci_cp_le_del_from_white_list *sent;
1242 __u8 status = *((__u8 *) skb->data);
1243
1244 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1245
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001246 if (status)
1247 return;
1248
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001249 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_WHITE_LIST);
1250 if (!sent)
1251 return;
1252
Johan Hedbergdcc36c12014-07-09 12:59:13 +03001253 hci_bdaddr_list_del(&hdev->le_white_list, &sent->bdaddr,
1254 sent->bdaddr_type);
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001255}
1256
Johan Hedberg9b008c02013-01-22 14:02:01 +02001257static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1258 struct sk_buff *skb)
1259{
1260 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1261
1262 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1263
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001264 if (rp->status)
1265 return;
1266
1267 memcpy(hdev->le_states, rp->le_states, 8);
Johan Hedberg9b008c02013-01-22 14:02:01 +02001268}
1269
Marcel Holtmanna8e1bfa2014-12-20 16:28:40 +01001270static void hci_cc_le_read_def_data_len(struct hci_dev *hdev,
1271 struct sk_buff *skb)
1272{
1273 struct hci_rp_le_read_def_data_len *rp = (void *) skb->data;
1274
1275 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1276
1277 if (rp->status)
1278 return;
1279
1280 hdev->le_def_tx_len = le16_to_cpu(rp->tx_len);
1281 hdev->le_def_tx_time = le16_to_cpu(rp->tx_time);
1282}
1283
1284static void hci_cc_le_write_def_data_len(struct hci_dev *hdev,
1285 struct sk_buff *skb)
1286{
1287 struct hci_cp_le_write_def_data_len *sent;
1288 __u8 status = *((__u8 *) skb->data);
1289
1290 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1291
1292 if (status)
1293 return;
1294
1295 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_WRITE_DEF_DATA_LEN);
1296 if (!sent)
1297 return;
1298
1299 hdev->le_def_tx_len = le16_to_cpu(sent->tx_len);
1300 hdev->le_def_tx_time = le16_to_cpu(sent->tx_time);
1301}
1302
1303static void hci_cc_le_read_max_data_len(struct hci_dev *hdev,
1304 struct sk_buff *skb)
1305{
1306 struct hci_rp_le_read_max_data_len *rp = (void *) skb->data;
1307
1308 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1309
1310 if (rp->status)
1311 return;
1312
1313 hdev->le_max_tx_len = le16_to_cpu(rp->tx_len);
1314 hdev->le_max_tx_time = le16_to_cpu(rp->tx_time);
1315 hdev->le_max_rx_len = le16_to_cpu(rp->rx_len);
1316 hdev->le_max_rx_time = le16_to_cpu(rp->rx_time);
1317}
1318
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001319static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1320 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -03001321{
Johan Hedberg06199cf2012-02-22 16:37:11 +02001322 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -03001323 __u8 status = *((__u8 *) skb->data);
1324
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001325 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001326
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001327 if (status)
1328 return;
1329
Johan Hedberg06199cf2012-02-22 16:37:11 +02001330 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001331 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -03001332 return;
1333
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301334 hci_dev_lock(hdev);
1335
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001336 if (sent->le) {
1337 hdev->features[1][0] |= LMP_HOST_LE;
Marcel Holtmanna1536da2015-03-13 02:11:01 -07001338 hci_dev_set_flag(hdev, HCI_LE_ENABLED);
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001339 } else {
1340 hdev->features[1][0] &= ~LMP_HOST_LE;
Marcel Holtmanna358dc12015-03-13 02:11:02 -07001341 hci_dev_clear_flag(hdev, HCI_LE_ENABLED);
1342 hci_dev_clear_flag(hdev, HCI_ADVERTISING);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001343 }
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001344
1345 if (sent->simul)
1346 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
1347 else
1348 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301349
1350 hci_dev_unlock(hdev);
Andre Guedesf9b49302011-06-30 19:20:53 -03001351}
1352
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02001353static void hci_cc_set_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
1354{
1355 struct hci_cp_le_set_adv_param *cp;
1356 u8 status = *((u8 *) skb->data);
1357
1358 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1359
1360 if (status)
1361 return;
1362
1363 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_PARAM);
1364 if (!cp)
1365 return;
1366
1367 hci_dev_lock(hdev);
1368 hdev->adv_addr_type = cp->own_address_type;
1369 hci_dev_unlock(hdev);
1370}
1371
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02001372static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
1373{
1374 struct hci_rp_read_rssi *rp = (void *) skb->data;
1375 struct hci_conn *conn;
1376
1377 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1378
1379 if (rp->status)
1380 return;
1381
1382 hci_dev_lock(hdev);
1383
1384 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
1385 if (conn)
1386 conn->rssi = rp->rssi;
1387
1388 hci_dev_unlock(hdev);
1389}
1390
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001391static void hci_cc_read_tx_power(struct hci_dev *hdev, struct sk_buff *skb)
1392{
1393 struct hci_cp_read_tx_power *sent;
1394 struct hci_rp_read_tx_power *rp = (void *) skb->data;
1395 struct hci_conn *conn;
1396
1397 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1398
1399 if (rp->status)
1400 return;
1401
1402 sent = hci_sent_cmd_data(hdev, HCI_OP_READ_TX_POWER);
1403 if (!sent)
1404 return;
1405
1406 hci_dev_lock(hdev);
1407
1408 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001409 if (!conn)
1410 goto unlock;
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001411
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001412 switch (sent->type) {
1413 case 0x00:
1414 conn->tx_power = rp->tx_power;
1415 break;
1416 case 0x01:
1417 conn->max_tx_power = rp->tx_power;
1418 break;
1419 }
1420
1421unlock:
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001422 hci_dev_unlock(hdev);
1423}
1424
Marcel Holtmannc50b33c2015-01-31 15:07:52 -08001425static void hci_cc_write_ssp_debug_mode(struct hci_dev *hdev, struct sk_buff *skb)
1426{
1427 u8 status = *((u8 *) skb->data);
1428 u8 *mode;
1429
1430 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1431
1432 if (status)
1433 return;
1434
1435 mode = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_DEBUG_MODE);
1436 if (mode)
1437 hdev->ssp_debug_mode = *mode;
1438}
1439
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001440static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001441{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001442 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001443
1444 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001445 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001446 return;
1447 }
1448
Andre Guedes89352e72011-11-04 14:16:53 -03001449 set_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001450}
1451
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001452static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001453{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001454 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001455 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001456
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001457 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001458
1459 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001460 if (!cp)
1461 return;
1462
1463 hci_dev_lock(hdev);
1464
1465 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1466
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001467 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001468
1469 if (status) {
1470 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001471 if (status != 0x0c || conn->attempt > 2) {
1472 conn->state = BT_CLOSED;
Johan Hedberg539c4962015-02-18 14:53:57 +02001473 hci_connect_cfm(conn, status);
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001474 hci_conn_del(conn);
1475 } else
1476 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001477 }
1478 } else {
1479 if (!conn) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03001480 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr,
1481 HCI_ROLE_MASTER);
1482 if (!conn)
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001483 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001484 }
1485 }
1486
1487 hci_dev_unlock(hdev);
1488}
1489
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001490static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001491{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001492 struct hci_cp_add_sco *cp;
1493 struct hci_conn *acl, *sco;
1494 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001495
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001496 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001497
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001498 if (!status)
1499 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001500
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001501 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1502 if (!cp)
1503 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001505 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001507 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001508
1509 hci_dev_lock(hdev);
1510
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001511 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001512 if (acl) {
1513 sco = acl->link;
1514 if (sco) {
1515 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001516
Johan Hedberg539c4962015-02-18 14:53:57 +02001517 hci_connect_cfm(sco, status);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001518 hci_conn_del(sco);
1519 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001520 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001521
1522 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001523}
1524
Marcel Holtmannf8558552008-07-14 20:13:49 +02001525static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1526{
1527 struct hci_cp_auth_requested *cp;
1528 struct hci_conn *conn;
1529
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001530 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001531
1532 if (!status)
1533 return;
1534
1535 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1536 if (!cp)
1537 return;
1538
1539 hci_dev_lock(hdev);
1540
1541 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1542 if (conn) {
1543 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001544 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001545 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001546 }
1547 }
1548
1549 hci_dev_unlock(hdev);
1550}
1551
1552static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1553{
1554 struct hci_cp_set_conn_encrypt *cp;
1555 struct hci_conn *conn;
1556
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001557 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001558
1559 if (!status)
1560 return;
1561
1562 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1563 if (!cp)
1564 return;
1565
1566 hci_dev_lock(hdev);
1567
1568 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1569 if (conn) {
1570 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001571 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001572 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001573 }
1574 }
1575
1576 hci_dev_unlock(hdev);
1577}
1578
Johan Hedberg127178d2010-11-18 22:22:29 +02001579static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001580 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001581{
Johan Hedberg392599b2010-11-18 22:22:28 +02001582 if (conn->state != BT_CONFIG || !conn->out)
1583 return 0;
1584
Johan Hedberg765c2a92011-01-19 12:06:52 +05301585 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001586 return 0;
1587
1588 /* Only request authentication for SSP connections or non-SSP
Johan Hedberg264b8b42014-01-08 16:40:39 +02001589 * devices with sec_level MEDIUM or HIGH or if MITM protection
1590 * is requested.
1591 */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001592 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
Johan Hedberg7e3691e2014-05-30 14:45:19 +03001593 conn->pending_sec_level != BT_SECURITY_FIPS &&
Johan Hedberg264b8b42014-01-08 16:40:39 +02001594 conn->pending_sec_level != BT_SECURITY_HIGH &&
1595 conn->pending_sec_level != BT_SECURITY_MEDIUM)
Johan Hedberg392599b2010-11-18 22:22:28 +02001596 return 0;
1597
Johan Hedberg392599b2010-11-18 22:22:28 +02001598 return 1;
1599}
1600
Gustavo Padovan6039aa732012-05-23 04:04:18 -03001601static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001602 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001603{
1604 struct hci_cp_remote_name_req cp;
1605
1606 memset(&cp, 0, sizeof(cp));
1607
1608 bacpy(&cp.bdaddr, &e->data.bdaddr);
1609 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1610 cp.pscan_mode = e->data.pscan_mode;
1611 cp.clock_offset = e->data.clock_offset;
1612
1613 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1614}
1615
Johan Hedbergb644ba32012-01-17 21:48:47 +02001616static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001617{
1618 struct discovery_state *discov = &hdev->discovery;
1619 struct inquiry_entry *e;
1620
Johan Hedbergb644ba32012-01-17 21:48:47 +02001621 if (list_empty(&discov->resolve))
1622 return false;
1623
1624 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001625 if (!e)
1626 return false;
1627
Johan Hedbergb644ba32012-01-17 21:48:47 +02001628 if (hci_resolve_name(hdev, e) == 0) {
1629 e->name_state = NAME_PENDING;
1630 return true;
1631 }
1632
1633 return false;
1634}
1635
1636static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001637 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001638{
1639 struct discovery_state *discov = &hdev->discovery;
1640 struct inquiry_entry *e;
1641
Johan Hedberg60cb49d2014-11-11 11:33:24 +02001642 /* Update the mgmt connected state if necessary. Be careful with
1643 * conn objects that exist but are not (yet) connected however.
1644 * Only those in BT_CONFIG or BT_CONNECTED states can be
1645 * considered connected.
1646 */
1647 if (conn &&
1648 (conn->state == BT_CONFIG || conn->state == BT_CONNECTED) &&
Jaganath Kanakkasserycb77c3e2014-11-07 16:39:09 +05301649 !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00001650 mgmt_device_connected(hdev, conn, 0, name, name_len);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001651
1652 if (discov->state == DISCOVERY_STOPPED)
1653 return;
1654
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001655 if (discov->state == DISCOVERY_STOPPING)
1656 goto discov_complete;
1657
1658 if (discov->state != DISCOVERY_RESOLVING)
1659 return;
1660
1661 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001662 /* If the device was not found in a list of found devices names of which
1663 * are pending. there is no need to continue resolving a next name as it
1664 * will be done upon receiving another Remote Name Request Complete
1665 * Event */
1666 if (!e)
1667 return;
1668
1669 list_del(&e->list);
1670 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001671 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001672 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1673 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001674 } else {
1675 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001676 }
1677
Johan Hedbergb644ba32012-01-17 21:48:47 +02001678 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001679 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001680
1681discov_complete:
1682 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1683}
1684
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001685static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1686{
Johan Hedberg127178d2010-11-18 22:22:29 +02001687 struct hci_cp_remote_name_req *cp;
1688 struct hci_conn *conn;
1689
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001690 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001691
1692 /* If successful wait for the name req complete event before
1693 * checking for the need to do authentication */
1694 if (!status)
1695 return;
1696
1697 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1698 if (!cp)
1699 return;
1700
1701 hci_dev_lock(hdev);
1702
1703 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001704
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001705 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedbergb644ba32012-01-17 21:48:47 +02001706 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1707
Johan Hedberg79c6c702011-04-28 11:28:55 -07001708 if (!conn)
1709 goto unlock;
1710
1711 if (!hci_outgoing_auth_needed(hdev, conn))
1712 goto unlock;
1713
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001714 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02001715 struct hci_cp_auth_requested auth_cp;
1716
Johan Hedberg977f8fc2014-07-17 15:35:39 +03001717 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
1718
Johannes Bergc1f23a22013-10-07 18:19:16 +02001719 auth_cp.handle = __cpu_to_le16(conn->handle);
1720 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1721 sizeof(auth_cp), &auth_cp);
Johan Hedberg127178d2010-11-18 22:22:29 +02001722 }
1723
Johan Hedberg79c6c702011-04-28 11:28:55 -07001724unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001725 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001726}
1727
Marcel Holtmann769be972008-07-14 20:13:49 +02001728static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1729{
1730 struct hci_cp_read_remote_features *cp;
1731 struct hci_conn *conn;
1732
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001733 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001734
1735 if (!status)
1736 return;
1737
1738 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1739 if (!cp)
1740 return;
1741
1742 hci_dev_lock(hdev);
1743
1744 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1745 if (conn) {
1746 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001747 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001748 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001749 }
1750 }
1751
1752 hci_dev_unlock(hdev);
1753}
1754
1755static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1756{
1757 struct hci_cp_read_remote_ext_features *cp;
1758 struct hci_conn *conn;
1759
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001760 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001761
1762 if (!status)
1763 return;
1764
1765 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1766 if (!cp)
1767 return;
1768
1769 hci_dev_lock(hdev);
1770
1771 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1772 if (conn) {
1773 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001774 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001775 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001776 }
1777 }
1778
1779 hci_dev_unlock(hdev);
1780}
1781
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001782static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1783{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001784 struct hci_cp_setup_sync_conn *cp;
1785 struct hci_conn *acl, *sco;
1786 __u16 handle;
1787
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001788 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001789
1790 if (!status)
1791 return;
1792
1793 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1794 if (!cp)
1795 return;
1796
1797 handle = __le16_to_cpu(cp->handle);
1798
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001799 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001800
1801 hci_dev_lock(hdev);
1802
1803 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001804 if (acl) {
1805 sco = acl->link;
1806 if (sco) {
1807 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001808
Johan Hedberg539c4962015-02-18 14:53:57 +02001809 hci_connect_cfm(sco, status);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001810 hci_conn_del(sco);
1811 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001812 }
1813
1814 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001815}
1816
1817static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1818{
1819 struct hci_cp_sniff_mode *cp;
1820 struct hci_conn *conn;
1821
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001822 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001823
1824 if (!status)
1825 return;
1826
1827 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1828 if (!cp)
1829 return;
1830
1831 hci_dev_lock(hdev);
1832
1833 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001834 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001835 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001836
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001837 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001838 hci_sco_setup(conn, status);
1839 }
1840
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001841 hci_dev_unlock(hdev);
1842}
1843
1844static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1845{
1846 struct hci_cp_exit_sniff_mode *cp;
1847 struct hci_conn *conn;
1848
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001849 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001850
1851 if (!status)
1852 return;
1853
1854 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1855 if (!cp)
1856 return;
1857
1858 hci_dev_lock(hdev);
1859
1860 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001861 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001862 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001863
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001864 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001865 hci_sco_setup(conn, status);
1866 }
1867
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001868 hci_dev_unlock(hdev);
1869}
1870
Johan Hedberg88c3df12012-02-09 14:27:38 +02001871static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1872{
1873 struct hci_cp_disconnect *cp;
1874 struct hci_conn *conn;
1875
1876 if (!status)
1877 return;
1878
1879 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1880 if (!cp)
1881 return;
1882
1883 hci_dev_lock(hdev);
1884
1885 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1886 if (conn)
1887 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001888 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001889
1890 hci_dev_unlock(hdev);
1891}
1892
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001893static void hci_cs_le_create_conn(struct hci_dev *hdev, u8 status)
1894{
1895 struct hci_cp_le_create_conn *cp;
1896 struct hci_conn *conn;
1897
1898 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1899
1900 /* All connection failure handling is taken care of by the
1901 * hci_le_conn_failed function which is triggered by the HCI
1902 * request completion callbacks used for connecting.
1903 */
1904 if (status)
1905 return;
1906
1907 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1908 if (!cp)
1909 return;
1910
1911 hci_dev_lock(hdev);
1912
1913 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1914 if (!conn)
1915 goto unlock;
1916
1917 /* Store the initiator and responder address information which
1918 * is needed for SMP. These values will not change during the
1919 * lifetime of the connection.
1920 */
1921 conn->init_addr_type = cp->own_address_type;
1922 if (cp->own_address_type == ADDR_LE_DEV_RANDOM)
1923 bacpy(&conn->init_addr, &hdev->random_addr);
1924 else
1925 bacpy(&conn->init_addr, &hdev->bdaddr);
1926
1927 conn->resp_addr_type = cp->peer_addr_type;
1928 bacpy(&conn->resp_addr, &cp->peer_addr);
1929
Johan Hedberg9489eca2014-02-28 17:45:46 +02001930 /* We don't want the connection attempt to stick around
1931 * indefinitely since LE doesn't have a page timeout concept
1932 * like BR/EDR. Set a timer for any connection that doesn't use
1933 * the white list for connecting.
1934 */
1935 if (cp->filter_policy == HCI_LE_USE_PEER_ADDR)
1936 queue_delayed_work(conn->hdev->workqueue,
1937 &conn->le_conn_timeout,
Johan Hedberg09ae2602014-07-06 13:41:15 +03001938 conn->conn_timeout);
Johan Hedberg9489eca2014-02-28 17:45:46 +02001939
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001940unlock:
1941 hci_dev_unlock(hdev);
1942}
1943
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07001944static void hci_cs_le_read_remote_features(struct hci_dev *hdev, u8 status)
1945{
1946 struct hci_cp_le_read_remote_features *cp;
1947 struct hci_conn *conn;
1948
1949 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1950
1951 if (!status)
1952 return;
1953
1954 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_READ_REMOTE_FEATURES);
1955 if (!cp)
1956 return;
1957
1958 hci_dev_lock(hdev);
1959
1960 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1961 if (conn) {
1962 if (conn->state == BT_CONFIG) {
1963 hci_connect_cfm(conn, status);
1964 hci_conn_drop(conn);
1965 }
1966 }
1967
1968 hci_dev_unlock(hdev);
1969}
1970
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02001971static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1972{
1973 struct hci_cp_le_start_enc *cp;
1974 struct hci_conn *conn;
1975
1976 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1977
1978 if (!status)
1979 return;
1980
1981 hci_dev_lock(hdev);
1982
1983 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_START_ENC);
1984 if (!cp)
1985 goto unlock;
1986
1987 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1988 if (!conn)
1989 goto unlock;
1990
1991 if (conn->state != BT_CONNECTED)
1992 goto unlock;
1993
1994 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
1995 hci_conn_drop(conn);
1996
1997unlock:
1998 hci_dev_unlock(hdev);
1999}
2000
Kuba Pawlak50fc85f2014-11-06 19:36:52 +01002001static void hci_cs_switch_role(struct hci_dev *hdev, u8 status)
2002{
2003 struct hci_cp_switch_role *cp;
2004 struct hci_conn *conn;
2005
2006 BT_DBG("%s status 0x%2.2x", hdev->name, status);
2007
2008 if (!status)
2009 return;
2010
2011 cp = hci_sent_cmd_data(hdev, HCI_OP_SWITCH_ROLE);
2012 if (!cp)
2013 return;
2014
2015 hci_dev_lock(hdev);
2016
2017 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
2018 if (conn)
2019 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
2020
2021 hci_dev_unlock(hdev);
2022}
2023
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002024static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002025{
2026 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002027 struct discovery_state *discov = &hdev->discovery;
2028 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002029
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002030 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002031
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002032 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03002033
2034 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
2035 return;
2036
Peter Zijlstra4e857c52014-03-17 18:06:10 +01002037 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -03002038 wake_up_bit(&hdev->flags, HCI_INQUIRY);
2039
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002040 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002041 return;
2042
Johan Hedberg56e5cb82011-11-08 20:40:16 +02002043 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002044
Andre Guedes343f9352012-02-17 20:39:37 -03002045 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002046 goto unlock;
2047
2048 if (list_empty(&discov->resolve)) {
Jakub Pawlowski07d23342015-03-17 09:04:14 -07002049 /* When BR/EDR inquiry is active and no LE scanning is in
2050 * progress, then change discovery state to indicate completion.
2051 *
2052 * When running LE scanning and BR/EDR inquiry simultaneously
2053 * and the LE scan already finished, then change the discovery
2054 * state to indicate completion.
2055 */
2056 if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
2057 !test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks))
2058 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002059 goto unlock;
2060 }
2061
2062 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
2063 if (e && hci_resolve_name(hdev, e) == 0) {
2064 e->name_state = NAME_PENDING;
2065 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
2066 } else {
Jakub Pawlowski07d23342015-03-17 09:04:14 -07002067 /* When BR/EDR inquiry is active and no LE scanning is in
2068 * progress, then change discovery state to indicate completion.
2069 *
2070 * When running LE scanning and BR/EDR inquiry simultaneously
2071 * and the LE scan already finished, then change the discovery
2072 * state to indicate completion.
2073 */
2074 if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
2075 !test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks))
2076 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002077 }
2078
2079unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02002080 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002081}
2082
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002083static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002084{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002085 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002086 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002087 int num_rsp = *((__u8 *) skb->data);
2088
2089 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2090
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002091 if (!num_rsp)
2092 return;
2093
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002094 if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
Andre Guedes1519cc12012-03-21 00:03:38 -03002095 return;
2096
Linus Torvalds1da177e2005-04-16 15:20:36 -07002097 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002098
Johan Hedberge17acd42011-03-30 23:57:16 +03002099 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02002100 u32 flags;
Johan Hedberg31754052012-01-04 13:39:52 +02002101
Linus Torvalds1da177e2005-04-16 15:20:36 -07002102 bacpy(&data.bdaddr, &info->bdaddr);
2103 data.pscan_rep_mode = info->pscan_rep_mode;
2104 data.pscan_period_mode = info->pscan_period_mode;
2105 data.pscan_mode = info->pscan_mode;
2106 memcpy(data.dev_class, info->dev_class, 3);
2107 data.clock_offset = info->clock_offset;
Marcel Holtmannefb25132014-12-05 13:03:34 +01002108 data.rssi = HCI_RSSI_INVALID;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002109 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002110
Marcel Holtmannaf589252014-07-01 14:11:20 +02002111 flags = hci_inquiry_cache_update(hdev, &data, false);
2112
Johan Hedberg48264f02011-11-09 13:58:58 +02002113 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Marcel Holtmannefb25132014-12-05 13:03:34 +01002114 info->dev_class, HCI_RSSI_INVALID,
2115 flags, NULL, 0, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002116 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002117
Linus Torvalds1da177e2005-04-16 15:20:36 -07002118 hci_dev_unlock(hdev);
2119}
2120
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002121static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002123 struct hci_ev_conn_complete *ev = (void *) skb->data;
2124 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002125
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002126 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002127
Linus Torvalds1da177e2005-04-16 15:20:36 -07002128 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002129
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002130 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02002131 if (!conn) {
2132 if (ev->link_type != SCO_LINK)
2133 goto unlock;
2134
2135 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2136 if (!conn)
2137 goto unlock;
2138
2139 conn->type = SCO_LINK;
2140 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002141
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002142 if (!ev->status) {
2143 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02002144
2145 if (conn->type == ACL_LINK) {
2146 conn->state = BT_CONFIG;
2147 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02002148
2149 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
2150 !hci_find_link_key(hdev, &ev->bdaddr))
2151 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2152 else
2153 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02002154 } else
2155 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002156
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01002157 hci_debugfs_create_conn(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002158 hci_conn_add_sysfs(conn);
2159
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002160 if (test_bit(HCI_AUTH, &hdev->flags))
Johan Hedberg4dae2792014-06-24 17:03:50 +03002161 set_bit(HCI_CONN_AUTH, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002162
2163 if (test_bit(HCI_ENCRYPT, &hdev->flags))
Johan Hedberg4dae2792014-06-24 17:03:50 +03002164 set_bit(HCI_CONN_ENCRYPT, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002165
2166 /* Get remote features */
2167 if (conn->type == ACL_LINK) {
2168 struct hci_cp_read_remote_features cp;
2169 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02002170 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002171 sizeof(cp), &cp);
Johan Hedberg22f433d2014-08-01 11:13:32 +03002172
Johan Hedberg1d2dc5b2014-12-19 13:40:19 +02002173 hci_update_page_scan(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002174 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002175
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002176 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02002177 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002178 struct hci_cp_change_conn_ptype cp;
2179 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02002180 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002181 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
2182 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002183 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02002184 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002185 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02002186 if (conn->type == ACL_LINK)
Marcel Holtmann64c7b772014-02-18 14:22:20 -08002187 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002188 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02002189 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002190
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002191 if (conn->type == ACL_LINK)
2192 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002193
Marcel Holtmann769be972008-07-14 20:13:49 +02002194 if (ev->status) {
Johan Hedberg539c4962015-02-18 14:53:57 +02002195 hci_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002196 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01002197 } else if (ev->link_type != ACL_LINK)
Johan Hedberg539c4962015-02-18 14:53:57 +02002198 hci_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002199
2200unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002201 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002202
2203 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002204}
2205
Johan Hedberg70c46422014-07-09 12:59:17 +03002206static void hci_reject_conn(struct hci_dev *hdev, bdaddr_t *bdaddr)
2207{
2208 struct hci_cp_reject_conn_req cp;
2209
2210 bacpy(&cp.bdaddr, bdaddr);
2211 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
2212 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
2213}
2214
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002215static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002216{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002217 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002218 int mask = hdev->link_mode;
Johan Hedberg70c46422014-07-09 12:59:17 +03002219 struct inquiry_entry *ie;
2220 struct hci_conn *conn;
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002221 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002222
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002223 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002224 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002225
Frédéric Dalleau20714bf2012-11-21 10:51:12 +01002226 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
2227 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002228
Johan Hedberg70c46422014-07-09 12:59:17 +03002229 if (!(mask & HCI_LM_ACCEPT)) {
2230 hci_reject_conn(hdev, &ev->bdaddr);
2231 return;
2232 }
2233
Johan Hedberg46c4c942014-07-16 16:19:21 +03002234 if (hci_bdaddr_list_lookup(&hdev->blacklist, &ev->bdaddr,
2235 BDADDR_BREDR)) {
2236 hci_reject_conn(hdev, &ev->bdaddr);
2237 return;
2238 }
2239
Johan Hedberg6a8fc952014-12-24 20:43:11 +02002240 /* Require HCI_CONNECTABLE or a whitelist entry to accept the
2241 * connection. These features are only touched through mgmt so
2242 * only do the checks if HCI_MGMT is set.
2243 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002244 if (hci_dev_test_flag(hdev, HCI_MGMT) &&
2245 !hci_dev_test_flag(hdev, HCI_CONNECTABLE) &&
Johan Hedberg46c4c942014-07-16 16:19:21 +03002246 !hci_bdaddr_list_lookup(&hdev->whitelist, &ev->bdaddr,
2247 BDADDR_BREDR)) {
2248 hci_reject_conn(hdev, &ev->bdaddr);
2249 return;
Johan Hedberg70c46422014-07-09 12:59:17 +03002250 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002251
Johan Hedberg70c46422014-07-09 12:59:17 +03002252 /* Connection accepted */
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002253
Johan Hedberg70c46422014-07-09 12:59:17 +03002254 hci_dev_lock(hdev);
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02002255
Johan Hedberg70c46422014-07-09 12:59:17 +03002256 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2257 if (ie)
2258 memcpy(ie->data.dev_class, ev->dev_class, 3);
2259
2260 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
2261 &ev->bdaddr);
2262 if (!conn) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03002263 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr,
2264 HCI_ROLE_SLAVE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002265 if (!conn) {
Johan Hedberg70c46422014-07-09 12:59:17 +03002266 BT_ERR("No memory for new connection");
2267 hci_dev_unlock(hdev);
2268 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002269 }
Johan Hedberg70c46422014-07-09 12:59:17 +03002270 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002271
Johan Hedberg70c46422014-07-09 12:59:17 +03002272 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002273
Johan Hedberg70c46422014-07-09 12:59:17 +03002274 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002275
Johan Hedberg70c46422014-07-09 12:59:17 +03002276 if (ev->link_type == ACL_LINK ||
2277 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
2278 struct hci_cp_accept_conn_req cp;
2279 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002280
2281 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedberg70c46422014-07-09 12:59:17 +03002282
2283 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
2284 cp.role = 0x00; /* Become master */
2285 else
2286 cp.role = 0x01; /* Remain slave */
2287
2288 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp), &cp);
2289 } else if (!(flags & HCI_PROTO_DEFER)) {
2290 struct hci_cp_accept_sync_conn_req cp;
2291 conn->state = BT_CONNECT;
2292
2293 bacpy(&cp.bdaddr, &ev->bdaddr);
2294 cp.pkt_type = cpu_to_le16(conn->pkt_type);
2295
2296 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
2297 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
2298 cp.max_latency = cpu_to_le16(0xffff);
2299 cp.content_format = cpu_to_le16(hdev->voice_setting);
2300 cp.retrans_effort = 0xff;
2301
2302 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ, sizeof(cp),
2303 &cp);
2304 } else {
2305 conn->state = BT_CONNECT2;
Johan Hedberg539c4962015-02-18 14:53:57 +02002306 hci_connect_cfm(conn, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002307 }
2308}
2309
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002310static u8 hci_to_mgmt_reason(u8 err)
2311{
2312 switch (err) {
2313 case HCI_ERROR_CONNECTION_TIMEOUT:
2314 return MGMT_DEV_DISCONN_TIMEOUT;
2315 case HCI_ERROR_REMOTE_USER_TERM:
2316 case HCI_ERROR_REMOTE_LOW_RESOURCES:
2317 case HCI_ERROR_REMOTE_POWER_OFF:
2318 return MGMT_DEV_DISCONN_REMOTE;
2319 case HCI_ERROR_LOCAL_HOST_TERM:
2320 return MGMT_DEV_DISCONN_LOCAL_HOST;
2321 default:
2322 return MGMT_DEV_DISCONN_UNKNOWN;
2323 }
2324}
2325
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002326static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002327{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002328 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Andre Guedesabf54a52013-11-07 17:36:09 -03002329 u8 reason = hci_to_mgmt_reason(ev->reason);
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002330 struct hci_conn_params *params;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002331 struct hci_conn *conn;
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002332 bool mgmt_connected;
Andre Guedes38462202013-11-07 17:36:10 -03002333 u8 type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002334
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002335 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002336
Linus Torvalds1da177e2005-04-16 15:20:36 -07002337 hci_dev_lock(hdev);
2338
Marcel Holtmann04837f62006-07-03 10:02:33 +02002339 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02002340 if (!conn)
2341 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002342
Andre Guedesabf54a52013-11-07 17:36:09 -03002343 if (ev->status) {
2344 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2345 conn->dst_type, ev->status);
2346 goto unlock;
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002347 }
Johan Hedbergf7520542011-01-20 12:34:39 +02002348
Andre Guedes38462202013-11-07 17:36:10 -03002349 conn->state = BT_CLOSED;
2350
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002351 mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2352 mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
2353 reason, mgmt_connected);
Andre Guedesabf54a52013-11-07 17:36:09 -03002354
Johan Hedberg22f433d2014-08-01 11:13:32 +03002355 if (conn->type == ACL_LINK) {
2356 if (test_bit(HCI_CONN_FLUSH_KEY, &conn->flags))
2357 hci_remove_link_key(hdev, &conn->dst);
2358
Johan Hedberg1d2dc5b2014-12-19 13:40:19 +02002359 hci_update_page_scan(hdev);
Johan Hedberg22f433d2014-08-01 11:13:32 +03002360 }
Johan Hedberg22102462013-10-05 12:01:06 +02002361
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002362 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
2363 if (params) {
2364 switch (params->auto_connect) {
2365 case HCI_AUTO_CONN_LINK_LOSS:
2366 if (ev->reason != HCI_ERROR_CONNECTION_TIMEOUT)
2367 break;
2368 /* Fall through */
2369
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02002370 case HCI_AUTO_CONN_DIRECT:
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002371 case HCI_AUTO_CONN_ALWAYS:
Johan Hedberg418025d2014-07-04 12:37:24 +03002372 list_del_init(&params->action);
2373 list_add(&params->action, &hdev->pend_le_conns);
2374 hci_update_background_scan(hdev);
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002375 break;
2376
2377 default:
2378 break;
2379 }
2380 }
2381
Andre Guedes38462202013-11-07 17:36:10 -03002382 type = conn->type;
Johan Hedberg22102462013-10-05 12:01:06 +02002383
Johan Hedberg3a6d5762015-02-18 14:53:58 +02002384 hci_disconn_cfm(conn, ev->reason);
Andre Guedes38462202013-11-07 17:36:10 -03002385 hci_conn_del(conn);
2386
2387 /* Re-enable advertising if necessary, since it might
2388 * have been disabled by the connection. From the
2389 * HCI_LE_Set_Advertise_Enable command description in
2390 * the core specification (v4.0):
2391 * "The Controller shall continue advertising until the Host
2392 * issues an LE_Set_Advertise_Enable command with
2393 * Advertising_Enable set to 0x00 (Advertising is disabled)
2394 * or until a connection is created or until the Advertising
2395 * is timed out due to Directed Advertising."
2396 */
2397 if (type == LE_LINK)
2398 mgmt_reenable_advertising(hdev);
Johan Hedbergf7520542011-01-20 12:34:39 +02002399
2400unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002401 hci_dev_unlock(hdev);
2402}
2403
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002404static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002405{
2406 struct hci_ev_auth_complete *ev = (void *) skb->data;
2407 struct hci_conn *conn;
2408
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002409 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002410
2411 hci_dev_lock(hdev);
2412
2413 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002414 if (!conn)
2415 goto unlock;
2416
2417 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002418 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002419 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002420 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03002421 } else {
Johan Hedberg4dae2792014-06-24 17:03:50 +03002422 set_bit(HCI_CONN_AUTH, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002423 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03002424 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002425 } else {
Johan Hedberge1e930f2014-09-08 17:09:49 -07002426 mgmt_auth_failed(conn, ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002427 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002428
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002429 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2430 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002431
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002432 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002433 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002434 struct hci_cp_set_conn_encrypt cp;
2435 cp.handle = ev->handle;
2436 cp.encrypt = 0x01;
2437 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002438 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002439 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002440 conn->state = BT_CONNECTED;
Johan Hedberg539c4962015-02-18 14:53:57 +02002441 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002442 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002443 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002444 } else {
2445 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002446
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002447 hci_conn_hold(conn);
2448 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02002449 hci_conn_drop(conn);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002450 }
2451
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002452 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002453 if (!ev->status) {
2454 struct hci_cp_set_conn_encrypt cp;
2455 cp.handle = ev->handle;
2456 cp.encrypt = 0x01;
2457 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002458 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002459 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002460 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002461 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002462 }
2463 }
2464
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002465unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002466 hci_dev_unlock(hdev);
2467}
2468
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002469static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002470{
Johan Hedberg127178d2010-11-18 22:22:29 +02002471 struct hci_ev_remote_name *ev = (void *) skb->data;
2472 struct hci_conn *conn;
2473
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002474 BT_DBG("%s", hdev->name);
2475
2476 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002477
2478 hci_dev_lock(hdev);
2479
2480 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002481
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002482 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedbergb644ba32012-01-17 21:48:47 +02002483 goto check_auth;
2484
2485 if (ev->status == 0)
2486 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002487 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002488 else
2489 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2490
2491check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002492 if (!conn)
2493 goto unlock;
2494
2495 if (!hci_outgoing_auth_needed(hdev, conn))
2496 goto unlock;
2497
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002498 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002499 struct hci_cp_auth_requested cp;
Johan Hedberg977f8fc2014-07-17 15:35:39 +03002500
2501 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
2502
Johan Hedberg127178d2010-11-18 22:22:29 +02002503 cp.handle = __cpu_to_le16(conn->handle);
2504 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2505 }
2506
Johan Hedberg79c6c702011-04-28 11:28:55 -07002507unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002508 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002509}
2510
Johan Hedberg821f3762015-06-11 13:52:29 +03002511static void read_enc_key_size_complete(struct hci_dev *hdev, u8 status,
2512 u16 opcode, struct sk_buff *skb)
2513{
2514 const struct hci_rp_read_enc_key_size *rp;
2515 struct hci_conn *conn;
2516 u16 handle;
2517
2518 BT_DBG("%s status 0x%02x", hdev->name, status);
2519
2520 if (!skb || skb->len < sizeof(*rp)) {
2521 BT_ERR("%s invalid HCI Read Encryption Key Size response",
2522 hdev->name);
2523 return;
2524 }
2525
2526 rp = (void *)skb->data;
2527 handle = le16_to_cpu(rp->handle);
2528
2529 hci_dev_lock(hdev);
2530
2531 conn = hci_conn_hash_lookup_handle(hdev, handle);
2532 if (!conn)
2533 goto unlock;
2534
2535 /* If we fail to read the encryption key size, assume maximum
2536 * (which is the same we do also when this HCI command isn't
2537 * supported.
2538 */
2539 if (rp->status) {
2540 BT_ERR("%s failed to read key size for handle %u", hdev->name,
2541 handle);
2542 conn->enc_key_size = HCI_LINK_KEY_SIZE;
2543 } else {
2544 conn->enc_key_size = rp->key_size;
2545 }
2546
2547 if (conn->state == BT_CONFIG) {
2548 conn->state = BT_CONNECTED;
2549 hci_connect_cfm(conn, 0);
2550 hci_conn_drop(conn);
2551 } else {
2552 u8 encrypt;
2553
2554 if (!test_bit(HCI_CONN_ENCRYPT, &conn->flags))
2555 encrypt = 0x00;
Johan Hedberg5d667ef2015-06-12 13:04:47 +03002556 else if (test_bit(HCI_CONN_AES_CCM, &conn->flags))
Johan Hedberg821f3762015-06-11 13:52:29 +03002557 encrypt = 0x02;
2558 else
2559 encrypt = 0x01;
2560
2561 hci_encrypt_cfm(conn, 0, encrypt);
2562 }
2563
2564unlock:
2565 hci_dev_unlock(hdev);
2566}
2567
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002568static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002569{
2570 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2571 struct hci_conn *conn;
2572
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002573 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002574
2575 hci_dev_lock(hdev);
2576
2577 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002578 if (!conn)
2579 goto unlock;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002580
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002581 if (!ev->status) {
2582 if (ev->encrypt) {
2583 /* Encryption implies authentication */
Johan Hedberg4dae2792014-06-24 17:03:50 +03002584 set_bit(HCI_CONN_AUTH, &conn->flags);
2585 set_bit(HCI_CONN_ENCRYPT, &conn->flags);
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002586 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002587
Marcel Holtmann914a6ff2014-02-01 11:52:02 -08002588 /* P-256 authentication key implies FIPS */
2589 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
Johan Hedberg4dae2792014-06-24 17:03:50 +03002590 set_bit(HCI_CONN_FIPS, &conn->flags);
Marcel Holtmann914a6ff2014-02-01 11:52:02 -08002591
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002592 if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
2593 conn->type == LE_LINK)
2594 set_bit(HCI_CONN_AES_CCM, &conn->flags);
2595 } else {
Johan Hedberg4dae2792014-06-24 17:03:50 +03002596 clear_bit(HCI_CONN_ENCRYPT, &conn->flags);
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002597 clear_bit(HCI_CONN_AES_CCM, &conn->flags);
2598 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002599 }
2600
Johan Hedberg7ed3fa22014-09-10 22:16:35 -07002601 /* We should disregard the current RPA and generate a new one
2602 * whenever the encryption procedure fails.
2603 */
2604 if (ev->status && conn->type == LE_LINK)
Marcel Holtmanna1536da2015-03-13 02:11:01 -07002605 hci_dev_set_flag(hdev, HCI_RPA_EXPIRED);
Johan Hedberg7ed3fa22014-09-10 22:16:35 -07002606
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002607 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2608
2609 if (ev->status && conn->state == BT_CONNECTED) {
2610 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
2611 hci_conn_drop(conn);
2612 goto unlock;
2613 }
2614
Johan Hedberg035ad622015-06-11 13:52:28 +03002615 /* In Secure Connections Only mode, do not allow any connections
2616 * that are not encrypted with AES-CCM using a P-256 authenticated
2617 * combination key.
2618 */
2619 if (hci_dev_test_flag(hdev, HCI_SC_ONLY) &&
2620 (!test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
2621 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)) {
2622 hci_connect_cfm(conn, HCI_ERROR_AUTH_FAILURE);
2623 hci_conn_drop(conn);
2624 goto unlock;
2625 }
2626
Johan Hedberg821f3762015-06-11 13:52:29 +03002627 /* Try reading the encryption key size for encrypted ACL links */
2628 if (!ev->status && ev->encrypt && conn->type == ACL_LINK) {
2629 struct hci_cp_read_enc_key_size cp;
2630 struct hci_request req;
2631
2632 /* Only send HCI_Read_Encryption_Key_Size if the
2633 * controller really supports it. If it doesn't, assume
2634 * the default size (16).
2635 */
2636 if (!(hdev->commands[20] & 0x10)) {
2637 conn->enc_key_size = HCI_LINK_KEY_SIZE;
2638 goto notify;
2639 }
2640
2641 hci_req_init(&req, hdev);
2642
2643 cp.handle = cpu_to_le16(conn->handle);
2644 hci_req_add(&req, HCI_OP_READ_ENC_KEY_SIZE, sizeof(cp), &cp);
2645
2646 if (hci_req_run_skb(&req, read_enc_key_size_complete)) {
2647 BT_ERR("Sending HCI Read Encryption Key Size failed");
2648 conn->enc_key_size = HCI_LINK_KEY_SIZE;
2649 goto notify;
2650 }
2651
2652 goto unlock;
2653 }
2654
2655notify:
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002656 if (conn->state == BT_CONFIG) {
2657 if (!ev->status)
2658 conn->state = BT_CONNECTED;
2659
Johan Hedberg539c4962015-02-18 14:53:57 +02002660 hci_connect_cfm(conn, ev->status);
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002661 hci_conn_drop(conn);
2662 } else
2663 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
2664
Gustavo Padovana7d77232012-05-13 03:20:07 -03002665unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002666 hci_dev_unlock(hdev);
2667}
2668
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002669static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2670 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002671{
2672 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2673 struct hci_conn *conn;
2674
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002675 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002676
2677 hci_dev_lock(hdev);
2678
2679 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2680 if (conn) {
2681 if (!ev->status)
Johan Hedberg4dae2792014-06-24 17:03:50 +03002682 set_bit(HCI_CONN_SECURE, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002683
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002684 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002685
2686 hci_key_change_cfm(conn, ev->status);
2687 }
2688
2689 hci_dev_unlock(hdev);
2690}
2691
Gustavo Padovan6039aa732012-05-23 04:04:18 -03002692static void hci_remote_features_evt(struct hci_dev *hdev,
2693 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002694{
2695 struct hci_ev_remote_features *ev = (void *) skb->data;
2696 struct hci_conn *conn;
2697
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002698 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002699
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002700 hci_dev_lock(hdev);
2701
2702 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002703 if (!conn)
2704 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002705
Johan Hedbergccd556f2010-11-10 17:11:51 +02002706 if (!ev->status)
Johan Hedbergcad718e2013-04-17 15:00:51 +03002707 memcpy(conn->features[0], ev->features, 8);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002708
2709 if (conn->state != BT_CONFIG)
2710 goto unlock;
2711
Szymon Jancac363cf2015-01-29 16:36:59 +01002712 if (!ev->status && lmp_ext_feat_capable(hdev) &&
2713 lmp_ext_feat_capable(conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002714 struct hci_cp_read_remote_ext_features cp;
2715 cp.handle = ev->handle;
2716 cp.page = 0x01;
2717 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002718 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002719 goto unlock;
2720 }
2721
Johan Hedberg671267b2012-05-12 16:11:50 -03002722 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002723 struct hci_cp_remote_name_req cp;
2724 memset(&cp, 0, sizeof(cp));
2725 bacpy(&cp.bdaddr, &conn->dst);
2726 cp.pscan_rep_mode = 0x02;
2727 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002728 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00002729 mgmt_device_connected(hdev, conn, 0, NULL, 0);
Johan Hedberg392599b2010-11-18 22:22:28 +02002730
Johan Hedberg127178d2010-11-18 22:22:29 +02002731 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002732 conn->state = BT_CONNECTED;
Johan Hedberg539c4962015-02-18 14:53:57 +02002733 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002734 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002735 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002736
Johan Hedbergccd556f2010-11-10 17:11:51 +02002737unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002738 hci_dev_unlock(hdev);
2739}
2740
Johan Hedberge62144872015-04-02 13:41:08 +03002741static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb,
2742 u16 *opcode, u8 *status,
2743 hci_req_complete_t *req_complete,
2744 hci_req_complete_skb_t *req_complete_skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002745{
2746 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberge62144872015-04-02 13:41:08 +03002747
2748 *opcode = __le16_to_cpu(ev->opcode);
2749 *status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002750
2751 skb_pull(skb, sizeof(*ev));
2752
Johan Hedberge62144872015-04-02 13:41:08 +03002753 switch (*opcode) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002754 case HCI_OP_INQUIRY_CANCEL:
2755 hci_cc_inquiry_cancel(hdev, skb);
2756 break;
2757
Andre Guedes4d934832012-03-21 00:03:35 -03002758 case HCI_OP_PERIODIC_INQ:
2759 hci_cc_periodic_inq(hdev, skb);
2760 break;
2761
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002762 case HCI_OP_EXIT_PERIODIC_INQ:
2763 hci_cc_exit_periodic_inq(hdev, skb);
2764 break;
2765
2766 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2767 hci_cc_remote_name_req_cancel(hdev, skb);
2768 break;
2769
2770 case HCI_OP_ROLE_DISCOVERY:
2771 hci_cc_role_discovery(hdev, skb);
2772 break;
2773
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002774 case HCI_OP_READ_LINK_POLICY:
2775 hci_cc_read_link_policy(hdev, skb);
2776 break;
2777
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002778 case HCI_OP_WRITE_LINK_POLICY:
2779 hci_cc_write_link_policy(hdev, skb);
2780 break;
2781
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002782 case HCI_OP_READ_DEF_LINK_POLICY:
2783 hci_cc_read_def_link_policy(hdev, skb);
2784 break;
2785
2786 case HCI_OP_WRITE_DEF_LINK_POLICY:
2787 hci_cc_write_def_link_policy(hdev, skb);
2788 break;
2789
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002790 case HCI_OP_RESET:
2791 hci_cc_reset(hdev, skb);
2792 break;
2793
Marcel Holtmannc2f0f972015-01-12 09:21:25 -08002794 case HCI_OP_READ_STORED_LINK_KEY:
2795 hci_cc_read_stored_link_key(hdev, skb);
2796 break;
2797
Marcel Holtmanna9366122015-01-12 09:21:28 -08002798 case HCI_OP_DELETE_STORED_LINK_KEY:
2799 hci_cc_delete_stored_link_key(hdev, skb);
2800 break;
2801
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002802 case HCI_OP_WRITE_LOCAL_NAME:
2803 hci_cc_write_local_name(hdev, skb);
2804 break;
2805
2806 case HCI_OP_READ_LOCAL_NAME:
2807 hci_cc_read_local_name(hdev, skb);
2808 break;
2809
2810 case HCI_OP_WRITE_AUTH_ENABLE:
2811 hci_cc_write_auth_enable(hdev, skb);
2812 break;
2813
2814 case HCI_OP_WRITE_ENCRYPT_MODE:
2815 hci_cc_write_encrypt_mode(hdev, skb);
2816 break;
2817
2818 case HCI_OP_WRITE_SCAN_ENABLE:
2819 hci_cc_write_scan_enable(hdev, skb);
2820 break;
2821
2822 case HCI_OP_READ_CLASS_OF_DEV:
2823 hci_cc_read_class_of_dev(hdev, skb);
2824 break;
2825
2826 case HCI_OP_WRITE_CLASS_OF_DEV:
2827 hci_cc_write_class_of_dev(hdev, skb);
2828 break;
2829
2830 case HCI_OP_READ_VOICE_SETTING:
2831 hci_cc_read_voice_setting(hdev, skb);
2832 break;
2833
2834 case HCI_OP_WRITE_VOICE_SETTING:
2835 hci_cc_write_voice_setting(hdev, skb);
2836 break;
2837
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -07002838 case HCI_OP_READ_NUM_SUPPORTED_IAC:
2839 hci_cc_read_num_supported_iac(hdev, skb);
2840 break;
2841
Marcel Holtmann333140b2008-07-14 20:13:48 +02002842 case HCI_OP_WRITE_SSP_MODE:
2843 hci_cc_write_ssp_mode(hdev, skb);
2844 break;
2845
Marcel Holtmanneac83dc2014-01-10 02:07:23 -08002846 case HCI_OP_WRITE_SC_SUPPORT:
2847 hci_cc_write_sc_support(hdev, skb);
2848 break;
2849
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002850 case HCI_OP_READ_LOCAL_VERSION:
2851 hci_cc_read_local_version(hdev, skb);
2852 break;
2853
2854 case HCI_OP_READ_LOCAL_COMMANDS:
2855 hci_cc_read_local_commands(hdev, skb);
2856 break;
2857
2858 case HCI_OP_READ_LOCAL_FEATURES:
2859 hci_cc_read_local_features(hdev, skb);
2860 break;
2861
Andre Guedes971e3a42011-06-30 19:20:52 -03002862 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2863 hci_cc_read_local_ext_features(hdev, skb);
2864 break;
2865
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002866 case HCI_OP_READ_BUFFER_SIZE:
2867 hci_cc_read_buffer_size(hdev, skb);
2868 break;
2869
2870 case HCI_OP_READ_BD_ADDR:
2871 hci_cc_read_bd_addr(hdev, skb);
2872 break;
2873
Johan Hedbergf332ec62013-03-15 17:07:11 -05002874 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2875 hci_cc_read_page_scan_activity(hdev, skb);
2876 break;
2877
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002878 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2879 hci_cc_write_page_scan_activity(hdev, skb);
2880 break;
2881
Johan Hedbergf332ec62013-03-15 17:07:11 -05002882 case HCI_OP_READ_PAGE_SCAN_TYPE:
2883 hci_cc_read_page_scan_type(hdev, skb);
2884 break;
2885
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002886 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2887 hci_cc_write_page_scan_type(hdev, skb);
2888 break;
2889
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002890 case HCI_OP_READ_DATA_BLOCK_SIZE:
2891 hci_cc_read_data_block_size(hdev, skb);
2892 break;
2893
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002894 case HCI_OP_READ_FLOW_CONTROL_MODE:
2895 hci_cc_read_flow_control_mode(hdev, skb);
2896 break;
2897
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002898 case HCI_OP_READ_LOCAL_AMP_INFO:
2899 hci_cc_read_local_amp_info(hdev, skb);
2900 break;
2901
Johan Hedberg33f35722014-06-28 17:54:06 +03002902 case HCI_OP_READ_CLOCK:
2903 hci_cc_read_clock(hdev, skb);
2904 break;
2905
Johan Hedbergd5859e22011-01-25 01:19:58 +02002906 case HCI_OP_READ_INQ_RSP_TX_POWER:
2907 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2908 break;
2909
Johan Hedberg980e1a52011-01-22 06:10:07 +02002910 case HCI_OP_PIN_CODE_REPLY:
2911 hci_cc_pin_code_reply(hdev, skb);
2912 break;
2913
2914 case HCI_OP_PIN_CODE_NEG_REPLY:
2915 hci_cc_pin_code_neg_reply(hdev, skb);
2916 break;
2917
Szymon Jancc35938b2011-03-22 13:12:21 +01002918 case HCI_OP_READ_LOCAL_OOB_DATA:
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08002919 hci_cc_read_local_oob_data(hdev, skb);
2920 break;
2921
2922 case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
2923 hci_cc_read_local_oob_ext_data(hdev, skb);
Szymon Jancc35938b2011-03-22 13:12:21 +01002924 break;
2925
Ville Tervo6ed58ec2011-02-10 22:38:48 -03002926 case HCI_OP_LE_READ_BUFFER_SIZE:
2927 hci_cc_le_read_buffer_size(hdev, skb);
2928 break;
2929
Johan Hedberg60e77322013-01-22 14:01:59 +02002930 case HCI_OP_LE_READ_LOCAL_FEATURES:
2931 hci_cc_le_read_local_features(hdev, skb);
2932 break;
2933
Johan Hedberg8fa19092012-10-19 20:57:49 +03002934 case HCI_OP_LE_READ_ADV_TX_POWER:
2935 hci_cc_le_read_adv_tx_power(hdev, skb);
2936 break;
2937
Johan Hedberga5c29682011-02-19 12:05:57 -03002938 case HCI_OP_USER_CONFIRM_REPLY:
2939 hci_cc_user_confirm_reply(hdev, skb);
2940 break;
2941
2942 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2943 hci_cc_user_confirm_neg_reply(hdev, skb);
2944 break;
2945
Brian Gix1143d452011-11-23 08:28:34 -08002946 case HCI_OP_USER_PASSKEY_REPLY:
2947 hci_cc_user_passkey_reply(hdev, skb);
2948 break;
2949
2950 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2951 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02002952 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09002953
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08002954 case HCI_OP_LE_SET_RANDOM_ADDR:
2955 hci_cc_le_set_random_addr(hdev, skb);
2956 break;
2957
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01002958 case HCI_OP_LE_SET_ADV_ENABLE:
2959 hci_cc_le_set_adv_enable(hdev, skb);
2960 break;
2961
Marcel Holtmann533553f2014-03-21 12:18:10 -07002962 case HCI_OP_LE_SET_SCAN_PARAM:
2963 hci_cc_le_set_scan_param(hdev, skb);
2964 break;
2965
Andre Guedeseb9d91f2011-05-26 16:23:52 -03002966 case HCI_OP_LE_SET_SCAN_ENABLE:
2967 hci_cc_le_set_scan_enable(hdev, skb);
2968 break;
2969
Johan Hedbergcf1d0812013-01-22 14:02:00 +02002970 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2971 hci_cc_le_read_white_list_size(hdev, skb);
2972 break;
2973
Marcel Holtmann0f36b582014-02-27 20:37:31 -08002974 case HCI_OP_LE_CLEAR_WHITE_LIST:
2975 hci_cc_le_clear_white_list(hdev, skb);
2976 break;
2977
2978 case HCI_OP_LE_ADD_TO_WHITE_LIST:
2979 hci_cc_le_add_to_white_list(hdev, skb);
2980 break;
2981
2982 case HCI_OP_LE_DEL_FROM_WHITE_LIST:
2983 hci_cc_le_del_from_white_list(hdev, skb);
2984 break;
2985
Johan Hedberg9b008c02013-01-22 14:02:01 +02002986 case HCI_OP_LE_READ_SUPPORTED_STATES:
2987 hci_cc_le_read_supported_states(hdev, skb);
2988 break;
2989
Marcel Holtmanna8e1bfa2014-12-20 16:28:40 +01002990 case HCI_OP_LE_READ_DEF_DATA_LEN:
2991 hci_cc_le_read_def_data_len(hdev, skb);
2992 break;
2993
2994 case HCI_OP_LE_WRITE_DEF_DATA_LEN:
2995 hci_cc_le_write_def_data_len(hdev, skb);
2996 break;
2997
2998 case HCI_OP_LE_READ_MAX_DATA_LEN:
2999 hci_cc_le_read_max_data_len(hdev, skb);
3000 break;
3001
Andre Guedesf9b49302011-06-30 19:20:53 -03003002 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
3003 hci_cc_write_le_host_supported(hdev, skb);
3004 break;
3005
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02003006 case HCI_OP_LE_SET_ADV_PARAM:
3007 hci_cc_set_adv_param(hdev, skb);
3008 break;
3009
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02003010 case HCI_OP_READ_RSSI:
3011 hci_cc_read_rssi(hdev, skb);
3012 break;
3013
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02003014 case HCI_OP_READ_TX_POWER:
3015 hci_cc_read_tx_power(hdev, skb);
3016 break;
3017
Marcel Holtmannc50b33c2015-01-31 15:07:52 -08003018 case HCI_OP_WRITE_SSP_DEBUG_MODE:
3019 hci_cc_write_ssp_debug_mode(hdev, skb);
3020 break;
3021
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003022 default:
Johan Hedberge62144872015-04-02 13:41:08 +03003023 BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003024 break;
3025 }
3026
Johan Hedberge62144872015-04-02 13:41:08 +03003027 if (*opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02003028 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02003029
Johan Hedberg600b2152015-03-28 11:17:36 +02003030 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags))
3031 atomic_set(&hdev->cmd_cnt, 1);
3032
Johan Hedberge62144872015-04-02 13:41:08 +03003033 hci_req_cmd_complete(hdev, *opcode, *status, req_complete,
3034 req_complete_skb);
Johan Hedberg9238f362013-03-05 20:37:48 +02003035
Johan Hedberg600b2152015-03-28 11:17:36 +02003036 if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
3037 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003038}
3039
Johan Hedberge62144872015-04-02 13:41:08 +03003040static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb,
3041 u16 *opcode, u8 *status,
3042 hci_req_complete_t *req_complete,
3043 hci_req_complete_skb_t *req_complete_skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003044{
3045 struct hci_ev_cmd_status *ev = (void *) skb->data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003046
3047 skb_pull(skb, sizeof(*ev));
3048
Johan Hedberge62144872015-04-02 13:41:08 +03003049 *opcode = __le16_to_cpu(ev->opcode);
3050 *status = ev->status;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003051
Johan Hedberge62144872015-04-02 13:41:08 +03003052 switch (*opcode) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003053 case HCI_OP_INQUIRY:
3054 hci_cs_inquiry(hdev, ev->status);
3055 break;
3056
3057 case HCI_OP_CREATE_CONN:
3058 hci_cs_create_conn(hdev, ev->status);
3059 break;
3060
Kuba Pawlak9645c762014-11-06 19:36:53 +01003061 case HCI_OP_DISCONNECT:
3062 hci_cs_disconnect(hdev, ev->status);
3063 break;
3064
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003065 case HCI_OP_ADD_SCO:
3066 hci_cs_add_sco(hdev, ev->status);
3067 break;
3068
Marcel Holtmannf8558552008-07-14 20:13:49 +02003069 case HCI_OP_AUTH_REQUESTED:
3070 hci_cs_auth_requested(hdev, ev->status);
3071 break;
3072
3073 case HCI_OP_SET_CONN_ENCRYPT:
3074 hci_cs_set_conn_encrypt(hdev, ev->status);
3075 break;
3076
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003077 case HCI_OP_REMOTE_NAME_REQ:
3078 hci_cs_remote_name_req(hdev, ev->status);
3079 break;
3080
Marcel Holtmann769be972008-07-14 20:13:49 +02003081 case HCI_OP_READ_REMOTE_FEATURES:
3082 hci_cs_read_remote_features(hdev, ev->status);
3083 break;
3084
3085 case HCI_OP_READ_REMOTE_EXT_FEATURES:
3086 hci_cs_read_remote_ext_features(hdev, ev->status);
3087 break;
3088
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003089 case HCI_OP_SETUP_SYNC_CONN:
3090 hci_cs_setup_sync_conn(hdev, ev->status);
3091 break;
3092
3093 case HCI_OP_SNIFF_MODE:
3094 hci_cs_sniff_mode(hdev, ev->status);
3095 break;
3096
3097 case HCI_OP_EXIT_SNIFF_MODE:
3098 hci_cs_exit_sniff_mode(hdev, ev->status);
3099 break;
3100
Kuba Pawlak50fc85f2014-11-06 19:36:52 +01003101 case HCI_OP_SWITCH_ROLE:
3102 hci_cs_switch_role(hdev, ev->status);
3103 break;
3104
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02003105 case HCI_OP_LE_CREATE_CONN:
3106 hci_cs_le_create_conn(hdev, ev->status);
3107 break;
3108
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07003109 case HCI_OP_LE_READ_REMOTE_FEATURES:
3110 hci_cs_le_read_remote_features(hdev, ev->status);
3111 break;
3112
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02003113 case HCI_OP_LE_START_ENC:
3114 hci_cs_le_start_enc(hdev, ev->status);
3115 break;
3116
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003117 default:
Johan Hedberge62144872015-04-02 13:41:08 +03003118 BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003119 break;
3120 }
3121
Johan Hedberge62144872015-04-02 13:41:08 +03003122 if (*opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02003123 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02003124
Johan Hedberg600b2152015-03-28 11:17:36 +02003125 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags))
3126 atomic_set(&hdev->cmd_cnt, 1);
3127
Johan Hedberg444c6dd2015-04-02 13:41:07 +03003128 /* Indicate request completion if the command failed. Also, if
3129 * we're not waiting for a special event and we get a success
3130 * command status we should try to flag the request as completed
3131 * (since for this kind of commands there will not be a command
3132 * complete event).
3133 */
Johan Hedberg02350a72013-04-03 21:50:29 +03003134 if (ev->status ||
Johan Hedbergdb6e3e82015-03-30 23:21:02 +03003135 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
Johan Hedberge62144872015-04-02 13:41:08 +03003136 hci_req_cmd_complete(hdev, *opcode, ev->status, req_complete,
3137 req_complete_skb);
Johan Hedberg9238f362013-03-05 20:37:48 +02003138
Johan Hedberg600b2152015-03-28 11:17:36 +02003139 if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
3140 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003141}
3142
Marcel Holtmann24dfa342014-11-02 02:56:41 +01003143static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
3144{
3145 struct hci_ev_hardware_error *ev = (void *) skb->data;
3146
Marcel Holtmannc7741d12015-01-28 11:09:55 -08003147 hdev->hw_error_code = ev->code;
3148
3149 queue_work(hdev->req_workqueue, &hdev->error_reset);
Marcel Holtmann24dfa342014-11-02 02:56:41 +01003150}
3151
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003152static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003153{
3154 struct hci_ev_role_change *ev = (void *) skb->data;
3155 struct hci_conn *conn;
3156
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003157 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003158
3159 hci_dev_lock(hdev);
3160
3161 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3162 if (conn) {
Johan Hedberg40bef302014-07-16 11:42:27 +03003163 if (!ev->status)
3164 conn->role = ev->role;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003165
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003166 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003167
3168 hci_role_switch_cfm(conn, ev->status, ev->role);
3169 }
3170
3171 hci_dev_unlock(hdev);
3172}
3173
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003174static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003175{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003176 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003177 int i;
3178
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02003179 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
3180 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
3181 return;
3182 }
3183
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02003184 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03003185 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003186 BT_DBG("%s bad parameters", hdev->name);
3187 return;
3188 }
3189
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02003190 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
3191
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02003192 for (i = 0; i < ev->num_hndl; i++) {
3193 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003194 struct hci_conn *conn;
3195 __u16 handle, count;
3196
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02003197 handle = __le16_to_cpu(info->handle);
3198 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003199
3200 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02003201 if (!conn)
3202 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003203
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02003204 conn->sent -= count;
3205
3206 switch (conn->type) {
3207 case ACL_LINK:
3208 hdev->acl_cnt += count;
3209 if (hdev->acl_cnt > hdev->acl_pkts)
3210 hdev->acl_cnt = hdev->acl_pkts;
3211 break;
3212
3213 case LE_LINK:
3214 if (hdev->le_pkts) {
3215 hdev->le_cnt += count;
3216 if (hdev->le_cnt > hdev->le_pkts)
3217 hdev->le_cnt = hdev->le_pkts;
3218 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02003219 hdev->acl_cnt += count;
3220 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003221 hdev->acl_cnt = hdev->acl_pkts;
3222 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02003223 break;
3224
3225 case SCO_LINK:
3226 hdev->sco_cnt += count;
3227 if (hdev->sco_cnt > hdev->sco_pkts)
3228 hdev->sco_cnt = hdev->sco_pkts;
3229 break;
3230
3231 default:
3232 BT_ERR("Unknown type %d conn %p", conn->type, conn);
3233 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003234 }
3235 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003236
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02003237 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003238}
3239
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03003240static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
3241 __u16 handle)
3242{
3243 struct hci_chan *chan;
3244
3245 switch (hdev->dev_type) {
3246 case HCI_BREDR:
3247 return hci_conn_hash_lookup_handle(hdev, handle);
3248 case HCI_AMP:
3249 chan = hci_chan_lookup_handle(hdev, handle);
3250 if (chan)
3251 return chan->conn;
3252 break;
3253 default:
3254 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
3255 break;
3256 }
3257
3258 return NULL;
3259}
3260
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003261static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003262{
3263 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
3264 int i;
3265
3266 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
3267 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
3268 return;
3269 }
3270
3271 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03003272 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003273 BT_DBG("%s bad parameters", hdev->name);
3274 return;
3275 }
3276
3277 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003278 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003279
3280 for (i = 0; i < ev->num_hndl; i++) {
3281 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03003282 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003283 __u16 handle, block_count;
3284
3285 handle = __le16_to_cpu(info->handle);
3286 block_count = __le16_to_cpu(info->blocks);
3287
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03003288 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003289 if (!conn)
3290 continue;
3291
3292 conn->sent -= block_count;
3293
3294 switch (conn->type) {
3295 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03003296 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003297 hdev->block_cnt += block_count;
3298 if (hdev->block_cnt > hdev->num_blocks)
3299 hdev->block_cnt = hdev->num_blocks;
3300 break;
3301
3302 default:
3303 BT_ERR("Unknown type %d conn %p", conn->type, conn);
3304 break;
3305 }
3306 }
3307
3308 queue_work(hdev->workqueue, &hdev->tx_work);
3309}
3310
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003311static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003312{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003313 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003314 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003315
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003316 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003317
3318 hci_dev_lock(hdev);
3319
Marcel Holtmann04837f62006-07-03 10:02:33 +02003320 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3321 if (conn) {
3322 conn->mode = ev->mode;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003323
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003324 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
3325 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02003326 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02003327 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003328 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02003329 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003330 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003331
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003332 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003333 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003334 }
3335
3336 hci_dev_unlock(hdev);
3337}
3338
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003339static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003340{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003341 struct hci_ev_pin_code_req *ev = (void *) skb->data;
3342 struct hci_conn *conn;
3343
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003344 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003345
3346 hci_dev_lock(hdev);
3347
3348 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003349 if (!conn)
3350 goto unlock;
3351
3352 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003353 hci_conn_hold(conn);
3354 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003355 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003356 }
3357
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003358 if (!hci_dev_test_flag(hdev, HCI_BONDABLE) &&
Johan Hedberg2f407f02014-07-17 15:35:40 +03003359 !test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags)) {
Johan Hedberg03b555e2011-01-04 15:40:05 +02003360 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003361 sizeof(ev->bdaddr), &ev->bdaddr);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003362 } else if (hci_dev_test_flag(hdev, HCI_MGMT)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003363 u8 secure;
3364
3365 if (conn->pending_sec_level == BT_SECURITY_HIGH)
3366 secure = 1;
3367 else
3368 secure = 0;
3369
Johan Hedberg744cf192011-11-08 20:40:14 +02003370 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003371 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02003372
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003373unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003374 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003375}
3376
Johan Hedbergcb6f3f72014-11-19 14:53:04 +02003377static void conn_set_key(struct hci_conn *conn, u8 key_type, u8 pin_len)
3378{
3379 if (key_type == HCI_LK_CHANGED_COMBINATION)
3380 return;
3381
3382 conn->pin_length = pin_len;
3383 conn->key_type = key_type;
3384
3385 switch (key_type) {
3386 case HCI_LK_LOCAL_UNIT:
3387 case HCI_LK_REMOTE_UNIT:
3388 case HCI_LK_DEBUG_COMBINATION:
3389 return;
3390 case HCI_LK_COMBINATION:
3391 if (pin_len == 16)
3392 conn->pending_sec_level = BT_SECURITY_HIGH;
3393 else
3394 conn->pending_sec_level = BT_SECURITY_MEDIUM;
3395 break;
3396 case HCI_LK_UNAUTH_COMBINATION_P192:
3397 case HCI_LK_UNAUTH_COMBINATION_P256:
3398 conn->pending_sec_level = BT_SECURITY_MEDIUM;
3399 break;
3400 case HCI_LK_AUTH_COMBINATION_P192:
3401 conn->pending_sec_level = BT_SECURITY_HIGH;
3402 break;
3403 case HCI_LK_AUTH_COMBINATION_P256:
3404 conn->pending_sec_level = BT_SECURITY_FIPS;
3405 break;
3406 }
3407}
3408
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003409static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003410{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003411 struct hci_ev_link_key_req *ev = (void *) skb->data;
3412 struct hci_cp_link_key_reply cp;
3413 struct hci_conn *conn;
3414 struct link_key *key;
3415
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003416 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003417
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003418 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003419 return;
3420
3421 hci_dev_lock(hdev);
3422
3423 key = hci_find_link_key(hdev, &ev->bdaddr);
3424 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003425 BT_DBG("%s link key not found for %pMR", hdev->name,
3426 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003427 goto not_found;
3428 }
3429
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003430 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
3431 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003432
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003433 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003434 if (conn) {
Johan Hedbergfe8bc5a2014-08-14 12:33:17 +03003435 clear_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);
3436
Marcel Holtmann66138ce2014-01-10 02:07:20 -08003437 if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
3438 key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003439 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003440 BT_DBG("%s ignoring unauthenticated key", hdev->name);
3441 goto not_found;
3442 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003443
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003444 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Johan Hedbergf3fb0b52014-06-02 10:12:44 +03003445 (conn->pending_sec_level == BT_SECURITY_HIGH ||
3446 conn->pending_sec_level == BT_SECURITY_FIPS)) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003447 BT_DBG("%s ignoring key unauthenticated for high security",
3448 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003449 goto not_found;
3450 }
3451
Johan Hedbergcb6f3f72014-11-19 14:53:04 +02003452 conn_set_key(conn, key->type, key->pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003453 }
3454
3455 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03003456 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003457
3458 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
3459
3460 hci_dev_unlock(hdev);
3461
3462 return;
3463
3464not_found:
3465 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
3466 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003467}
3468
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003469static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003470{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003471 struct hci_ev_link_key_notify *ev = (void *) skb->data;
3472 struct hci_conn *conn;
Johan Hedberg7652ff62014-06-24 13:15:49 +03003473 struct link_key *key;
3474 bool persistent;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003475 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003476
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003477 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003478
3479 hci_dev_lock(hdev);
3480
3481 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg82c13d42014-12-03 11:03:06 +02003482 if (!conn)
3483 goto unlock;
3484
3485 hci_conn_hold(conn);
3486 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3487 hci_conn_drop(conn);
3488
Johan Hedbergfe8bc5a2014-08-14 12:33:17 +03003489 set_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);
Johan Hedberg82c13d42014-12-03 11:03:06 +02003490 conn_set_key(conn, ev->key_type, conn->pin_length);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003491
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003492 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg7652ff62014-06-24 13:15:49 +03003493 goto unlock;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003494
Johan Hedberg7652ff62014-06-24 13:15:49 +03003495 key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
3496 ev->key_type, pin_len, &persistent);
3497 if (!key)
3498 goto unlock;
3499
Johan Hedbergcb6f3f72014-11-19 14:53:04 +02003500 /* Update connection information since adding the key will have
3501 * fixed up the type in the case of changed combination keys.
3502 */
3503 if (ev->key_type == HCI_LK_CHANGED_COMBINATION)
3504 conn_set_key(conn, key->type, key->pin_len);
3505
Johan Hedberg7652ff62014-06-24 13:15:49 +03003506 mgmt_new_link_key(hdev, key, persistent);
3507
Johan Hedberg6d5650c2014-06-24 13:15:51 +03003508 /* Keep debug keys around only if the HCI_KEEP_DEBUG_KEYS flag
3509 * is set. If it's not set simply remove the key from the kernel
3510 * list (we've still notified user space about it but with
3511 * store_hint being 0).
3512 */
3513 if (key->type == HCI_LK_DEBUG_COMBINATION &&
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003514 !hci_dev_test_flag(hdev, HCI_KEEP_DEBUG_KEYS)) {
Johan Hedberg0378b592014-11-19 15:22:22 +02003515 list_del_rcu(&key->list);
3516 kfree_rcu(key, rcu);
Johan Hedberg82c13d42014-12-03 11:03:06 +02003517 goto unlock;
Johan Hedberg6d5650c2014-06-24 13:15:51 +03003518 }
Johan Hedberg7652ff62014-06-24 13:15:49 +03003519
Johan Hedberg82c13d42014-12-03 11:03:06 +02003520 if (persistent)
3521 clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3522 else
3523 set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3524
Johan Hedberg7652ff62014-06-24 13:15:49 +03003525unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003526 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003527}
3528
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003529static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02003530{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003531 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003532 struct hci_conn *conn;
3533
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003534 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003535
3536 hci_dev_lock(hdev);
3537
3538 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003539 if (conn && !ev->status) {
3540 struct inquiry_entry *ie;
3541
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003542 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3543 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003544 ie->data.clock_offset = ev->clock_offset;
3545 ie->timestamp = jiffies;
3546 }
3547 }
3548
3549 hci_dev_unlock(hdev);
3550}
3551
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003552static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02003553{
3554 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
3555 struct hci_conn *conn;
3556
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003557 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02003558
3559 hci_dev_lock(hdev);
3560
3561 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3562 if (conn && !ev->status)
3563 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
3564
3565 hci_dev_unlock(hdev);
3566}
3567
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003568static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003569{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003570 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003571 struct inquiry_entry *ie;
3572
3573 BT_DBG("%s", hdev->name);
3574
3575 hci_dev_lock(hdev);
3576
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003577 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3578 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003579 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
3580 ie->timestamp = jiffies;
3581 }
3582
3583 hci_dev_unlock(hdev);
3584}
3585
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003586static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
3587 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003588{
3589 struct inquiry_data data;
3590 int num_rsp = *((__u8 *) skb->data);
3591
3592 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3593
3594 if (!num_rsp)
3595 return;
3596
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003597 if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
Andre Guedes1519cc12012-03-21 00:03:38 -03003598 return;
3599
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003600 hci_dev_lock(hdev);
3601
3602 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01003603 struct inquiry_info_with_rssi_and_pscan_mode *info;
3604 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003605
Johan Hedberge17acd42011-03-30 23:57:16 +03003606 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02003607 u32 flags;
3608
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003609 bacpy(&data.bdaddr, &info->bdaddr);
3610 data.pscan_rep_mode = info->pscan_rep_mode;
3611 data.pscan_period_mode = info->pscan_period_mode;
3612 data.pscan_mode = info->pscan_mode;
3613 memcpy(data.dev_class, info->dev_class, 3);
3614 data.clock_offset = info->clock_offset;
3615 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003616 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02003617
Marcel Holtmannaf589252014-07-01 14:11:20 +02003618 flags = hci_inquiry_cache_update(hdev, &data, false);
3619
Johan Hedberg48264f02011-11-09 13:58:58 +02003620 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003621 info->dev_class, info->rssi,
Marcel Holtmannaf589252014-07-01 14:11:20 +02003622 flags, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003623 }
3624 } else {
3625 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
3626
Johan Hedberge17acd42011-03-30 23:57:16 +03003627 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02003628 u32 flags;
3629
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003630 bacpy(&data.bdaddr, &info->bdaddr);
3631 data.pscan_rep_mode = info->pscan_rep_mode;
3632 data.pscan_period_mode = info->pscan_period_mode;
3633 data.pscan_mode = 0x00;
3634 memcpy(data.dev_class, info->dev_class, 3);
3635 data.clock_offset = info->clock_offset;
3636 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003637 data.ssp_mode = 0x00;
Marcel Holtmannaf589252014-07-01 14:11:20 +02003638
3639 flags = hci_inquiry_cache_update(hdev, &data, false);
3640
Johan Hedberg48264f02011-11-09 13:58:58 +02003641 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003642 info->dev_class, info->rssi,
Marcel Holtmannaf589252014-07-01 14:11:20 +02003643 flags, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003644 }
3645 }
3646
3647 hci_dev_unlock(hdev);
3648}
3649
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003650static void hci_remote_ext_features_evt(struct hci_dev *hdev,
3651 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003652{
Marcel Holtmann41a96212008-07-14 20:13:48 +02003653 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
3654 struct hci_conn *conn;
3655
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003656 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003657
Marcel Holtmann41a96212008-07-14 20:13:48 +02003658 hci_dev_lock(hdev);
3659
3660 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02003661 if (!conn)
3662 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003663
Johan Hedbergcad718e2013-04-17 15:00:51 +03003664 if (ev->page < HCI_MAX_PAGES)
3665 memcpy(conn->features[ev->page], ev->features, 8);
3666
Johan Hedbergccd556f2010-11-10 17:11:51 +02003667 if (!ev->status && ev->page == 0x01) {
3668 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003669
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003670 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3671 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003672 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02003673
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303674 if (ev->features[0] & LMP_HOST_SSP) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02003675 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303676 } else {
3677 /* It is mandatory by the Bluetooth specification that
3678 * Extended Inquiry Results are only used when Secure
3679 * Simple Pairing is enabled, but some devices violate
3680 * this.
3681 *
3682 * To make these devices work, the internal SSP
3683 * enabled flag needs to be cleared if the remote host
3684 * features do not indicate SSP support */
3685 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
3686 }
Marcel Holtmanneb9a8f32014-01-15 22:37:38 -08003687
3688 if (ev->features[0] & LMP_HOST_SC)
3689 set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003690 }
3691
Johan Hedbergccd556f2010-11-10 17:11:51 +02003692 if (conn->state != BT_CONFIG)
3693 goto unlock;
3694
Johan Hedberg671267b2012-05-12 16:11:50 -03003695 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02003696 struct hci_cp_remote_name_req cp;
3697 memset(&cp, 0, sizeof(cp));
3698 bacpy(&cp.bdaddr, &conn->dst);
3699 cp.pscan_rep_mode = 0x02;
3700 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003701 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00003702 mgmt_device_connected(hdev, conn, 0, NULL, 0);
Johan Hedberg392599b2010-11-18 22:22:28 +02003703
Johan Hedberg127178d2010-11-18 22:22:29 +02003704 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02003705 conn->state = BT_CONNECTED;
Johan Hedberg539c4962015-02-18 14:53:57 +02003706 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003707 hci_conn_drop(conn);
Johan Hedbergccd556f2010-11-10 17:11:51 +02003708 }
3709
3710unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02003711 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003712}
3713
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003714static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3715 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003716{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003717 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3718 struct hci_conn *conn;
3719
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003720 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003721
3722 hci_dev_lock(hdev);
3723
3724 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003725 if (!conn) {
3726 if (ev->link_type == ESCO_LINK)
3727 goto unlock;
3728
Kuba Pawlak618353b2015-08-28 13:05:22 +01003729 /* When the link type in the event indicates SCO connection
3730 * and lookup of the connection object fails, then check
3731 * if an eSCO connection object exists.
3732 *
3733 * The core limits the synchronous connections to either
3734 * SCO or eSCO. The eSCO connection is preferred and tried
3735 * to be setup first and until successfully established,
3736 * the link type will be hinted as eSCO.
3737 */
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003738 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3739 if (!conn)
3740 goto unlock;
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003741 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003742
Marcel Holtmann732547f2009-04-19 19:14:14 +02003743 switch (ev->status) {
3744 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003745 conn->handle = __le16_to_cpu(ev->handle);
3746 conn->state = BT_CONNECTED;
Kuba Pawlak618353b2015-08-28 13:05:22 +01003747 conn->type = ev->link_type;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003748
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01003749 hci_debugfs_create_conn(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003750 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02003751 break;
3752
Nick Pelly81218d22014-06-30 11:25:01 +05303753 case 0x10: /* Connection Accept Timeout */
Frédéric Dalleau1a4c9582013-08-19 14:24:02 +02003754 case 0x0d: /* Connection Rejected due to Limited Resources */
Stephen Coe705e5712010-02-16 11:29:44 -05003755 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003756 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08003757 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003758 case 0x1f: /* Unspecified error */
Andrew Earl27539bc2014-03-10 10:31:04 +00003759 case 0x20: /* Unsupported LMP Parameter value */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003760 if (conn->out) {
Marcel Holtmann732547f2009-04-19 19:14:14 +02003761 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3762 (hdev->esco_type & EDR_ESCO_MASK);
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003763 if (hci_setup_sync(conn, conn->link->handle))
3764 goto unlock;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003765 }
3766 /* fall through */
3767
3768 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003769 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003770 break;
3771 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003772
Johan Hedberg539c4962015-02-18 14:53:57 +02003773 hci_connect_cfm(conn, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003774 if (ev->status)
3775 hci_conn_del(conn);
3776
3777unlock:
3778 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003779}
3780
Marcel Holtmannefdcf8e2013-10-15 10:31:12 -07003781static inline size_t eir_get_length(u8 *eir, size_t eir_len)
3782{
3783 size_t parsed = 0;
3784
3785 while (parsed < eir_len) {
3786 u8 field_len = eir[0];
3787
3788 if (field_len == 0)
3789 return parsed;
3790
3791 parsed += field_len + 1;
3792 eir += field_len + 1;
3793 }
3794
3795 return eir_len;
3796}
3797
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003798static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3799 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003800{
3801 struct inquiry_data data;
3802 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3803 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303804 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003805
3806 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3807
3808 if (!num_rsp)
3809 return;
3810
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003811 if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
Andre Guedes1519cc12012-03-21 00:03:38 -03003812 return;
3813
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003814 hci_dev_lock(hdev);
3815
Johan Hedberge17acd42011-03-30 23:57:16 +03003816 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02003817 u32 flags;
3818 bool name_known;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003819
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003820 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003821 data.pscan_rep_mode = info->pscan_rep_mode;
3822 data.pscan_period_mode = info->pscan_period_mode;
3823 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003824 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003825 data.clock_offset = info->clock_offset;
3826 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003827 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003828
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003829 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003830 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003831 sizeof(info->data),
3832 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003833 else
3834 name_known = true;
3835
Marcel Holtmannaf589252014-07-01 14:11:20 +02003836 flags = hci_inquiry_cache_update(hdev, &data, name_known);
3837
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303838 eir_len = eir_get_length(info->data, sizeof(info->data));
Marcel Holtmannaf589252014-07-01 14:11:20 +02003839
Johan Hedberg48264f02011-11-09 13:58:58 +02003840 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Marcel Holtmannaf589252014-07-01 14:11:20 +02003841 info->dev_class, info->rssi,
3842 flags, info->data, eir_len, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003843 }
3844
3845 hci_dev_unlock(hdev);
3846}
3847
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003848static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3849 struct sk_buff *skb)
3850{
3851 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3852 struct hci_conn *conn;
3853
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003854 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003855 __le16_to_cpu(ev->handle));
3856
3857 hci_dev_lock(hdev);
3858
3859 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3860 if (!conn)
3861 goto unlock;
3862
Johan Hedberg9eb1fbf2014-04-11 12:02:31 -07003863 /* For BR/EDR the necessary steps are taken through the
3864 * auth_complete event.
3865 */
3866 if (conn->type != LE_LINK)
3867 goto unlock;
3868
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003869 if (!ev->status)
3870 conn->sec_level = conn->pending_sec_level;
3871
3872 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3873
3874 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003875 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02003876 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003877 goto unlock;
3878 }
3879
3880 if (conn->state == BT_CONFIG) {
3881 if (!ev->status)
3882 conn->state = BT_CONNECTED;
3883
Johan Hedberg539c4962015-02-18 14:53:57 +02003884 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003885 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003886 } else {
3887 hci_auth_cfm(conn, ev->status);
3888
3889 hci_conn_hold(conn);
3890 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003891 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003892 }
3893
3894unlock:
3895 hci_dev_unlock(hdev);
3896}
3897
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003898static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003899{
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003900 /* If remote requests no-bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02003901 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3902 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02003903 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003904
Mikel Astizb7f94c82014-04-08 14:21:31 +02003905 /* If both remote and local have enough IO capabilities, require
3906 * MITM protection
3907 */
3908 if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
3909 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
3910 return conn->remote_auth | 0x01;
3911
Timo Mueller7e741702014-04-08 14:21:33 +02003912 /* No MITM protection possible so ignore remote requirement */
3913 return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003914}
3915
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08003916static u8 bredr_oob_data_present(struct hci_conn *conn)
3917{
3918 struct hci_dev *hdev = conn->hdev;
3919 struct oob_data *data;
3920
3921 data = hci_find_remote_oob_data(hdev, &conn->dst, BDADDR_BREDR);
3922 if (!data)
3923 return 0x00;
3924
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07003925 if (bredr_sc_enabled(hdev)) {
3926 /* When Secure Connections is enabled, then just
3927 * return the present value stored with the OOB
3928 * data. The stored value contains the right present
3929 * information. However it can only be trusted when
3930 * not in Secure Connection Only mode.
Marcel Holtmann659c7fb2015-01-30 23:20:56 -08003931 */
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07003932 if (!hci_dev_test_flag(hdev, HCI_SC_ONLY))
3933 return data->present;
3934
3935 /* When Secure Connections Only mode is enabled, then
3936 * the P-256 values are required. If they are not
3937 * available, then do not declare that OOB data is
3938 * present.
3939 */
3940 if (!memcmp(data->rand256, ZERO_KEY, 16) ||
3941 !memcmp(data->hash256, ZERO_KEY, 16))
Marcel Holtmann659c7fb2015-01-30 23:20:56 -08003942 return 0x00;
3943
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07003944 return 0x02;
Marcel Holtmann659c7fb2015-01-30 23:20:56 -08003945 }
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08003946
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07003947 /* When Secure Connections is not enabled or actually
3948 * not supported by the hardware, then check that if
3949 * P-192 data values are present.
3950 */
3951 if (!memcmp(data->rand192, ZERO_KEY, 16) ||
3952 !memcmp(data->hash192, ZERO_KEY, 16))
3953 return 0x00;
3954
3955 return 0x01;
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08003956}
3957
Gustavo Padovan6039aa732012-05-23 04:04:18 -03003958static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02003959{
3960 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3961 struct hci_conn *conn;
3962
3963 BT_DBG("%s", hdev->name);
3964
3965 hci_dev_lock(hdev);
3966
3967 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02003968 if (!conn)
3969 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02003970
Johan Hedberg03b555e2011-01-04 15:40:05 +02003971 hci_conn_hold(conn);
3972
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003973 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg03b555e2011-01-04 15:40:05 +02003974 goto unlock;
3975
Johan Hedberg2f407f02014-07-17 15:35:40 +03003976 /* Allow pairing if we're pairable, the initiators of the
3977 * pairing or if the remote is not requesting bonding.
3978 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003979 if (hci_dev_test_flag(hdev, HCI_BONDABLE) ||
Johan Hedberg2f407f02014-07-17 15:35:40 +03003980 test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03003981 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003982 struct hci_cp_io_capability_reply cp;
3983
3984 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05303985 /* Change the IO capability from KeyboardDisplay
3986 * to DisplayYesNo as it is not supported by BT spec. */
3987 cp.capability = (conn->io_capability == 0x04) ?
Mikel Astiza7676312013-06-28 10:56:29 +02003988 HCI_IO_DISPLAY_YESNO : conn->io_capability;
Mikel Astizb7f94c82014-04-08 14:21:31 +02003989
3990 /* If we are initiators, there is no remote information yet */
3991 if (conn->remote_auth == 0xff) {
Mikel Astizb16c6602014-04-08 14:21:34 +02003992 /* Request MITM protection if our IO caps allow it
Johan Hedberg4ad51a72014-06-09 14:41:25 +03003993 * except for the no-bonding case.
Mikel Astizb16c6602014-04-08 14:21:34 +02003994 */
Mikel Astiz6fd6b912014-04-08 14:21:32 +02003995 if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
Johan Hedberg9f743d72014-07-17 11:56:33 +03003996 conn->auth_type != HCI_AT_NO_BONDING)
Johan Hedberg6c538232014-07-11 15:32:23 +03003997 conn->auth_type |= 0x01;
Mikel Astizb7f94c82014-04-08 14:21:31 +02003998 } else {
3999 conn->auth_type = hci_get_auth_req(conn);
Mikel Astizb7f94c82014-04-08 14:21:31 +02004000 }
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004001
Johan Hedberg82c295b2014-07-30 09:22:24 +03004002 /* If we're not bondable, force one of the non-bondable
4003 * authentication requirement values.
4004 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004005 if (!hci_dev_test_flag(hdev, HCI_BONDABLE))
Johan Hedberg82c295b2014-07-30 09:22:24 +03004006 conn->auth_type &= HCI_AT_NO_BONDING_MITM;
4007
4008 cp.authentication = conn->auth_type;
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08004009 cp.oob_data = bredr_oob_data_present(conn);
Szymon Jancce85ee12011-03-22 13:12:23 +01004010
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004011 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004012 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02004013 } else {
4014 struct hci_cp_io_capability_neg_reply cp;
4015
4016 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02004017 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02004018
4019 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004020 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02004021 }
4022
4023unlock:
4024 hci_dev_unlock(hdev);
4025}
4026
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004027static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02004028{
4029 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
4030 struct hci_conn *conn;
4031
4032 BT_DBG("%s", hdev->name);
4033
4034 hci_dev_lock(hdev);
4035
4036 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4037 if (!conn)
4038 goto unlock;
4039
Johan Hedberg03b555e2011-01-04 15:40:05 +02004040 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02004041 conn->remote_auth = ev->authentication;
4042
4043unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02004044 hci_dev_unlock(hdev);
4045}
4046
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004047static void hci_user_confirm_request_evt(struct hci_dev *hdev,
4048 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03004049{
4050 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004051 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07004052 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03004053
4054 BT_DBG("%s", hdev->name);
4055
4056 hci_dev_lock(hdev);
4057
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004058 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg7a828902011-04-28 11:28:53 -07004059 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03004060
Johan Hedberg7a828902011-04-28 11:28:53 -07004061 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4062 if (!conn)
4063 goto unlock;
4064
4065 loc_mitm = (conn->auth_type & 0x01);
4066 rem_mitm = (conn->remote_auth & 0x01);
4067
4068 /* If we require MITM but the remote device can't provide that
Johan Hedberg6c538232014-07-11 15:32:23 +03004069 * (it has NoInputNoOutput) then reject the confirmation
4070 * request. We check the security level here since it doesn't
4071 * necessarily match conn->auth_type.
Mikel Astiz6fd6b912014-04-08 14:21:32 +02004072 */
Johan Hedberg6c538232014-07-11 15:32:23 +03004073 if (conn->pending_sec_level > BT_SECURITY_MEDIUM &&
4074 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
Johan Hedberg7a828902011-04-28 11:28:53 -07004075 BT_DBG("Rejecting request: remote device can't provide MITM");
4076 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004077 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07004078 goto unlock;
4079 }
4080
4081 /* If no side requires MITM protection; auto-accept */
Mikel Astiza7676312013-06-28 10:56:29 +02004082 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
4083 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004084
4085 /* If we're not the initiators request authorization to
4086 * proceed from user space (mgmt_user_confirm with
Johan Hedbergba15a582014-06-09 13:58:14 +03004087 * confirm_hint set to 1). The exception is if neither
Johan Hedberg02f3e252014-07-16 15:09:13 +03004088 * side had MITM or if the local IO capability is
4089 * NoInputNoOutput, in which case we do auto-accept
Johan Hedbergba15a582014-06-09 13:58:14 +03004090 */
4091 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
Johan Hedberg02f3e252014-07-16 15:09:13 +03004092 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
Johan Hedbergba15a582014-06-09 13:58:14 +03004093 (loc_mitm || rem_mitm)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004094 BT_DBG("Confirming auto-accept as acceptor");
4095 confirm_hint = 1;
4096 goto confirm;
4097 }
4098
Johan Hedberg9f616562011-04-28 11:28:54 -07004099 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03004100 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07004101
4102 if (hdev->auto_accept_delay > 0) {
4103 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
Johan Hedberg7bc18d92013-10-16 18:11:39 +03004104 queue_delayed_work(conn->hdev->workqueue,
4105 &conn->auto_accept_work, delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07004106 goto unlock;
4107 }
4108
Johan Hedberg7a828902011-04-28 11:28:53 -07004109 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004110 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07004111 goto unlock;
4112 }
4113
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004114confirm:
Johan Hedberg39adbff2014-03-20 08:18:14 +02004115 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
4116 le32_to_cpu(ev->passkey), confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07004117
4118unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03004119 hci_dev_unlock(hdev);
4120}
4121
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004122static void hci_user_passkey_request_evt(struct hci_dev *hdev,
4123 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08004124{
4125 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
4126
4127 BT_DBG("%s", hdev->name);
4128
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004129 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg272d90d2012-02-09 15:26:12 +02004130 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08004131}
4132
Johan Hedberg92a25252012-09-06 18:39:26 +03004133static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
4134 struct sk_buff *skb)
4135{
4136 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
4137 struct hci_conn *conn;
4138
4139 BT_DBG("%s", hdev->name);
4140
4141 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4142 if (!conn)
4143 return;
4144
4145 conn->passkey_notify = __le32_to_cpu(ev->passkey);
4146 conn->passkey_entered = 0;
4147
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004148 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg92a25252012-09-06 18:39:26 +03004149 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
4150 conn->dst_type, conn->passkey_notify,
4151 conn->passkey_entered);
4152}
4153
4154static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
4155{
4156 struct hci_ev_keypress_notify *ev = (void *) skb->data;
4157 struct hci_conn *conn;
4158
4159 BT_DBG("%s", hdev->name);
4160
4161 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4162 if (!conn)
4163 return;
4164
4165 switch (ev->type) {
4166 case HCI_KEYPRESS_STARTED:
4167 conn->passkey_entered = 0;
4168 return;
4169
4170 case HCI_KEYPRESS_ENTERED:
4171 conn->passkey_entered++;
4172 break;
4173
4174 case HCI_KEYPRESS_ERASED:
4175 conn->passkey_entered--;
4176 break;
4177
4178 case HCI_KEYPRESS_CLEARED:
4179 conn->passkey_entered = 0;
4180 break;
4181
4182 case HCI_KEYPRESS_COMPLETED:
4183 return;
4184 }
4185
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004186 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg92a25252012-09-06 18:39:26 +03004187 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
4188 conn->dst_type, conn->passkey_notify,
4189 conn->passkey_entered);
4190}
4191
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004192static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
4193 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02004194{
4195 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
4196 struct hci_conn *conn;
4197
4198 BT_DBG("%s", hdev->name);
4199
4200 hci_dev_lock(hdev);
4201
4202 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03004203 if (!conn)
4204 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02004205
Johan Hedbergc1d4fa72014-07-17 15:14:50 +03004206 /* Reset the authentication requirement to unknown */
4207 conn->remote_auth = 0xff;
4208
Johan Hedberg2a611692011-02-19 12:06:00 -03004209 /* To avoid duplicate auth_failed events to user space we check
4210 * the HCI_CONN_AUTH_PEND flag which will be set if we
4211 * initiated the authentication. A traditional auth_complete
4212 * event gets always produced as initiator and is also mapped to
4213 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02004214 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedberge1e930f2014-09-08 17:09:49 -07004215 mgmt_auth_failed(conn, ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03004216
David Herrmann76a68ba2013-04-06 20:28:37 +02004217 hci_conn_drop(conn);
Johan Hedberg2a611692011-02-19 12:06:00 -03004218
4219unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02004220 hci_dev_unlock(hdev);
4221}
4222
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004223static void hci_remote_host_features_evt(struct hci_dev *hdev,
4224 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02004225{
4226 struct hci_ev_remote_host_features *ev = (void *) skb->data;
4227 struct inquiry_entry *ie;
Johan Hedbergcad718e2013-04-17 15:00:51 +03004228 struct hci_conn *conn;
Marcel Holtmann41a96212008-07-14 20:13:48 +02004229
4230 BT_DBG("%s", hdev->name);
4231
4232 hci_dev_lock(hdev);
4233
Johan Hedbergcad718e2013-04-17 15:00:51 +03004234 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4235 if (conn)
4236 memcpy(conn->features[1], ev->features, 8);
4237
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02004238 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
4239 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02004240 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02004241
4242 hci_dev_unlock(hdev);
4243}
4244
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004245static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
4246 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01004247{
4248 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
4249 struct oob_data *data;
4250
4251 BT_DBG("%s", hdev->name);
4252
4253 hci_dev_lock(hdev);
4254
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004255 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Szymon Jance1ba1f12011-04-06 13:01:59 +02004256 goto unlock;
4257
Johan Hedberg6928a922014-10-26 20:46:09 +01004258 data = hci_find_remote_oob_data(hdev, &ev->bdaddr, BDADDR_BREDR);
Marcel Holtmann6665d052015-01-27 16:04:31 -08004259 if (!data) {
Szymon Janc2763eda2011-03-22 13:12:22 +01004260 struct hci_cp_remote_oob_data_neg_reply cp;
4261
4262 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08004263 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
4264 sizeof(cp), &cp);
Marcel Holtmann6665d052015-01-27 16:04:31 -08004265 goto unlock;
4266 }
4267
4268 if (bredr_sc_enabled(hdev)) {
4269 struct hci_cp_remote_oob_ext_data_reply cp;
4270
4271 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004272 if (hci_dev_test_flag(hdev, HCI_SC_ONLY)) {
Marcel Holtmann6665d052015-01-27 16:04:31 -08004273 memset(cp.hash192, 0, sizeof(cp.hash192));
4274 memset(cp.rand192, 0, sizeof(cp.rand192));
4275 } else {
4276 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
4277 memcpy(cp.rand192, data->rand192, sizeof(cp.rand192));
4278 }
4279 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
4280 memcpy(cp.rand256, data->rand256, sizeof(cp.rand256));
4281
4282 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
4283 sizeof(cp), &cp);
4284 } else {
4285 struct hci_cp_remote_oob_data_reply cp;
4286
4287 bacpy(&cp.bdaddr, &ev->bdaddr);
4288 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
4289 memcpy(cp.rand, data->rand192, sizeof(cp.rand));
4290
4291 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
4292 sizeof(cp), &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01004293 }
4294
Szymon Jance1ba1f12011-04-06 13:01:59 +02004295unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01004296 hci_dev_unlock(hdev);
4297}
4298
Arron Wanga77a6a12015-07-24 17:13:15 +08004299#if IS_ENABLED(CONFIG_BT_HS)
4300static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
4301{
4302 struct hci_ev_channel_selected *ev = (void *)skb->data;
4303 struct hci_conn *hcon;
4304
4305 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
4306
4307 skb_pull(skb, sizeof(*ev));
4308
4309 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4310 if (!hcon)
4311 return;
4312
4313 amp_read_loc_assoc_final_data(hdev, hcon);
4314}
4315
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004316static void hci_phy_link_complete_evt(struct hci_dev *hdev,
4317 struct sk_buff *skb)
4318{
4319 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
4320 struct hci_conn *hcon, *bredr_hcon;
4321
4322 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
4323 ev->status);
4324
4325 hci_dev_lock(hdev);
4326
4327 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4328 if (!hcon) {
4329 hci_dev_unlock(hdev);
4330 return;
4331 }
4332
4333 if (ev->status) {
4334 hci_conn_del(hcon);
4335 hci_dev_unlock(hdev);
4336 return;
4337 }
4338
4339 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
4340
4341 hcon->state = BT_CONNECTED;
4342 bacpy(&hcon->dst, &bredr_hcon->dst);
4343
4344 hci_conn_hold(hcon);
4345 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02004346 hci_conn_drop(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004347
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01004348 hci_debugfs_create_conn(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004349 hci_conn_add_sysfs(hcon);
4350
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02004351 amp_physical_cfm(bredr_hcon, hcon);
4352
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004353 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004354}
4355
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03004356static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
4357{
4358 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
4359 struct hci_conn *hcon;
4360 struct hci_chan *hchan;
4361 struct amp_mgr *mgr;
4362
4363 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
4364 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
4365 ev->status);
4366
4367 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4368 if (!hcon)
4369 return;
4370
4371 /* Create AMP hchan */
4372 hchan = hci_chan_create(hcon);
4373 if (!hchan)
4374 return;
4375
4376 hchan->handle = le16_to_cpu(ev->handle);
4377
4378 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
4379
4380 mgr = hcon->amp_mgr;
4381 if (mgr && mgr->bredr_chan) {
4382 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
4383
4384 l2cap_chan_lock(bredr_chan);
4385
4386 bredr_chan->conn->mtu = hdev->block_mtu;
4387 l2cap_logical_cfm(bredr_chan, hchan, 0);
4388 hci_conn_hold(hcon);
4389
4390 l2cap_chan_unlock(bredr_chan);
4391 }
4392}
4393
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02004394static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
4395 struct sk_buff *skb)
4396{
4397 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
4398 struct hci_chan *hchan;
4399
4400 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
4401 le16_to_cpu(ev->handle), ev->status);
4402
4403 if (ev->status)
4404 return;
4405
4406 hci_dev_lock(hdev);
4407
4408 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
4409 if (!hchan)
4410 goto unlock;
4411
4412 amp_destroy_logical_link(hchan, ev->reason);
4413
4414unlock:
4415 hci_dev_unlock(hdev);
4416}
4417
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02004418static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
4419 struct sk_buff *skb)
4420{
4421 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
4422 struct hci_conn *hcon;
4423
4424 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4425
4426 if (ev->status)
4427 return;
4428
4429 hci_dev_lock(hdev);
4430
4431 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4432 if (hcon) {
4433 hcon->state = BT_CLOSED;
4434 hci_conn_del(hcon);
4435 }
4436
4437 hci_dev_unlock(hdev);
4438}
Arron Wanga77a6a12015-07-24 17:13:15 +08004439#endif
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02004440
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004441static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03004442{
4443 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
Johan Hedberg912b42e2014-07-03 19:33:49 +03004444 struct hci_conn_params *params;
Ville Tervofcd89c02011-02-10 22:38:47 -03004445 struct hci_conn *conn;
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02004446 struct smp_irk *irk;
Johan Hedberg837d5022014-07-02 09:36:22 +03004447 u8 addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03004448
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004449 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03004450
4451 hci_dev_lock(hdev);
4452
Johan Hedbergfbd96c12014-07-08 17:21:51 +03004453 /* All controllers implicitly stop advertising in the event of a
4454 * connection, so ensure that the state bit is cleared.
4455 */
Marcel Holtmanna358dc12015-03-13 02:11:02 -07004456 hci_dev_clear_flag(hdev, HCI_LE_ADV);
Johan Hedbergfbd96c12014-07-08 17:21:51 +03004457
Jakub Pawlowskie7d9ab72015-08-07 20:22:52 +02004458 conn = hci_lookup_le_connect(hdev);
Ville Tervob62f3282011-02-10 22:38:50 -03004459 if (!conn) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03004460 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr, ev->role);
Ville Tervob62f3282011-02-10 22:38:50 -03004461 if (!conn) {
4462 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03004463 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03004464 }
Andre Guedes29b79882011-05-31 14:20:54 -03004465
4466 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03004467
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004468 /* If we didn't have a hci_conn object previously
4469 * but we're in master role this must be something
4470 * initiated using a white list. Since white list based
4471 * connections are not "first class citizens" we don't
4472 * have full tracking of them. Therefore, we go ahead
4473 * with a "best effort" approach of determining the
4474 * initiator address based on the HCI_PRIVACY flag.
4475 */
4476 if (conn->out) {
4477 conn->resp_addr_type = ev->bdaddr_type;
4478 bacpy(&conn->resp_addr, &ev->bdaddr);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004479 if (hci_dev_test_flag(hdev, HCI_PRIVACY)) {
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004480 conn->init_addr_type = ADDR_LE_DEV_RANDOM;
4481 bacpy(&conn->init_addr, &hdev->rpa);
4482 } else {
4483 hci_copy_identity_address(hdev,
4484 &conn->init_addr,
4485 &conn->init_addr_type);
4486 }
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004487 }
Johan Hedberg9489eca2014-02-28 17:45:46 +02004488 } else {
4489 cancel_delayed_work(&conn->le_conn_timeout);
Ville Tervob62f3282011-02-10 22:38:50 -03004490 }
Ville Tervofcd89c02011-02-10 22:38:47 -03004491
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004492 if (!conn->out) {
4493 /* Set the responder (our side) address type based on
4494 * the advertising address type.
4495 */
4496 conn->resp_addr_type = hdev->adv_addr_type;
4497 if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM)
4498 bacpy(&conn->resp_addr, &hdev->random_addr);
4499 else
4500 bacpy(&conn->resp_addr, &hdev->bdaddr);
4501
4502 conn->init_addr_type = ev->bdaddr_type;
4503 bacpy(&conn->init_addr, &ev->bdaddr);
Marcel Holtmanna720d732014-06-23 12:14:51 +02004504
4505 /* For incoming connections, set the default minimum
4506 * and maximum connection interval. They will be used
4507 * to check if the parameters are in range and if not
4508 * trigger the connection update procedure.
4509 */
4510 conn->le_conn_min_interval = hdev->le_conn_min_interval;
4511 conn->le_conn_max_interval = hdev->le_conn_max_interval;
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004512 }
Johan Hedberg7be2edb2014-02-23 19:42:17 +02004513
Marcel Holtmannedb4b462014-02-18 15:13:43 -08004514 /* Lookup the identity address from the stored connection
4515 * address and address type.
4516 *
4517 * When establishing connections to an identity address, the
4518 * connection procedure will store the resolvable random
4519 * address first. Now if it can be converted back into the
4520 * identity address, start using the identity address from
4521 * now on.
4522 */
4523 irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02004524 if (irk) {
4525 bacpy(&conn->dst, &irk->bdaddr);
4526 conn->dst_type = irk->addr_type;
4527 }
4528
Johan Hedberg2d3c2262014-07-15 11:51:28 +03004529 if (ev->status) {
4530 hci_le_conn_failed(conn, ev->status);
Johan Hedberg837d5022014-07-02 09:36:22 +03004531 goto unlock;
4532 }
4533
Johan Hedberg08853f12014-08-15 21:06:55 +03004534 if (conn->dst_type == ADDR_LE_DEV_PUBLIC)
4535 addr_type = BDADDR_LE_PUBLIC;
4536 else
4537 addr_type = BDADDR_LE_RANDOM;
4538
Johan Hedberg2d3c2262014-07-15 11:51:28 +03004539 /* Drop the connection if the device is blocked */
4540 if (hci_bdaddr_list_lookup(&hdev->blacklist, &conn->dst, addr_type)) {
4541 hci_conn_drop(conn);
Andre Guedescd17dec2012-07-27 15:10:16 -03004542 goto unlock;
4543 }
4544
Johan Hedbergb644ba32012-01-17 21:48:47 +02004545 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00004546 mgmt_device_connected(hdev, conn, 0, NULL, 0);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03004547
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03004548 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03004549 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07004550 conn->state = BT_CONFIG;
Ville Tervofcd89c02011-02-10 22:38:47 -03004551
Marcel Holtmanne04fde62014-06-23 11:40:04 +02004552 conn->le_conn_interval = le16_to_cpu(ev->interval);
4553 conn->le_conn_latency = le16_to_cpu(ev->latency);
4554 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4555
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01004556 hci_debugfs_create_conn(conn);
Ville Tervofcd89c02011-02-10 22:38:47 -03004557 hci_conn_add_sysfs(conn);
4558
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07004559 if (!ev->status) {
4560 /* The remote features procedure is defined for master
4561 * role only. So only in case of an initiated connection
4562 * request the remote features.
4563 *
4564 * If the local controller supports slave-initiated features
4565 * exchange, then requesting the remote features in slave
4566 * role is possible. Otherwise just transition into the
4567 * connected state without requesting the remote features.
4568 */
4569 if (conn->out ||
4570 (hdev->le_features[0] & HCI_LE_SLAVE_FEATURES)) {
4571 struct hci_cp_le_read_remote_features cp;
4572
4573 cp.handle = __cpu_to_le16(conn->handle);
4574
4575 hci_send_cmd(hdev, HCI_OP_LE_READ_REMOTE_FEATURES,
4576 sizeof(cp), &cp);
4577
4578 hci_conn_hold(conn);
4579 } else {
4580 conn->state = BT_CONNECTED;
4581 hci_connect_cfm(conn, ev->status);
4582 }
4583 } else {
4584 hci_connect_cfm(conn, ev->status);
4585 }
Ville Tervofcd89c02011-02-10 22:38:47 -03004586
Johan Hedberg54776102014-08-15 21:06:56 +03004587 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
4588 conn->dst_type);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004589 if (params) {
Johan Hedberg95305ba2014-07-04 12:37:21 +03004590 list_del_init(&params->action);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004591 if (params->conn) {
4592 hci_conn_drop(params->conn);
Johan Hedbergf8aaf9b2014-08-17 23:28:57 +03004593 hci_conn_put(params->conn);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004594 params->conn = NULL;
4595 }
4596 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004597
Ville Tervofcd89c02011-02-10 22:38:47 -03004598unlock:
Johan Hedberg223683a2014-07-06 15:44:23 +03004599 hci_update_background_scan(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03004600 hci_dev_unlock(hdev);
4601}
4602
Marcel Holtmann1855d922014-06-23 11:40:05 +02004603static void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
4604 struct sk_buff *skb)
4605{
4606 struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
4607 struct hci_conn *conn;
4608
4609 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4610
4611 if (ev->status)
4612 return;
4613
4614 hci_dev_lock(hdev);
4615
4616 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4617 if (conn) {
4618 conn->le_conn_interval = le16_to_cpu(ev->interval);
4619 conn->le_conn_latency = le16_to_cpu(ev->latency);
4620 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4621 }
4622
4623 hci_dev_unlock(hdev);
4624}
4625
Andre Guedesa4790db2014-02-26 20:21:47 -03004626/* This function requires the caller holds hdev->lock */
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004627static struct hci_conn *check_pending_le_conn(struct hci_dev *hdev,
4628 bdaddr_t *addr,
4629 u8 addr_type, u8 adv_type)
Andre Guedesa4790db2014-02-26 20:21:47 -03004630{
4631 struct hci_conn *conn;
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004632 struct hci_conn_params *params;
Andre Guedesa4790db2014-02-26 20:21:47 -03004633
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004634 /* If the event is not connectable don't proceed further */
4635 if (adv_type != LE_ADV_IND && adv_type != LE_ADV_DIRECT_IND)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004636 return NULL;
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004637
4638 /* Ignore if the device is blocked */
Johan Hedbergdcc36c12014-07-09 12:59:13 +03004639 if (hci_bdaddr_list_lookup(&hdev->blacklist, addr, addr_type))
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004640 return NULL;
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004641
Johan Hedbergf99353c2014-07-16 11:56:09 +03004642 /* Most controller will fail if we try to create new connections
4643 * while we have an existing one in slave role.
4644 */
4645 if (hdev->conn_hash.le_num_slave > 0)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004646 return NULL;
Johan Hedbergf99353c2014-07-16 11:56:09 +03004647
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004648 /* If we're not connectable only connect devices that we have in
4649 * our pend_le_conns list.
4650 */
Jakub Pawlowski28a667c2015-08-07 20:22:54 +02004651 params = hci_explicit_connect_lookup(hdev, addr, addr_type);
4652
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004653 if (!params)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004654 return NULL;
Andre Guedesa4790db2014-02-26 20:21:47 -03004655
Jakub Pawlowski28a667c2015-08-07 20:22:54 +02004656 if (!params->explicit_connect) {
4657 switch (params->auto_connect) {
4658 case HCI_AUTO_CONN_DIRECT:
4659 /* Only devices advertising with ADV_DIRECT_IND are
4660 * triggering a connection attempt. This is allowing
4661 * incoming connections from slave devices.
4662 */
4663 if (adv_type != LE_ADV_DIRECT_IND)
4664 return NULL;
4665 break;
4666 case HCI_AUTO_CONN_ALWAYS:
4667 /* Devices advertising with ADV_IND or ADV_DIRECT_IND
4668 * are triggering a connection attempt. This means
4669 * that incoming connectioms from slave device are
4670 * accepted and also outgoing connections to slave
4671 * devices are established when found.
4672 */
4673 break;
4674 default:
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004675 return NULL;
Jakub Pawlowski28a667c2015-08-07 20:22:54 +02004676 }
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004677 }
4678
Andre Guedesa4790db2014-02-26 20:21:47 -03004679 conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
Johan Hedberge804d252014-07-16 11:42:28 +03004680 HCI_LE_AUTOCONN_TIMEOUT, HCI_ROLE_MASTER);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004681 if (!IS_ERR(conn)) {
Jakub Pawlowski28a667c2015-08-07 20:22:54 +02004682 /* If HCI_AUTO_CONN_EXPLICIT is set, conn is already owned
4683 * by higher layer that tried to connect, if no then
4684 * store the pointer since we don't really have any
Johan Hedbergf161dd42014-08-15 21:06:54 +03004685 * other owner of the object besides the params that
4686 * triggered it. This way we can abort the connection if
4687 * the parameters get removed and keep the reference
4688 * count consistent once the connection is established.
4689 */
Jakub Pawlowski28a667c2015-08-07 20:22:54 +02004690
4691 if (!params->explicit_connect)
4692 params->conn = hci_conn_get(conn);
4693
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004694 return conn;
Johan Hedbergf161dd42014-08-15 21:06:54 +03004695 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004696
4697 switch (PTR_ERR(conn)) {
4698 case -EBUSY:
4699 /* If hci_connect() returns -EBUSY it means there is already
4700 * an LE connection attempt going on. Since controllers don't
4701 * support more than one connection attempt at the time, we
4702 * don't consider this an error case.
4703 */
4704 break;
4705 default:
4706 BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004707 return NULL;
Andre Guedesa4790db2014-02-26 20:21:47 -03004708 }
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004709
4710 return NULL;
Andre Guedesa4790db2014-02-26 20:21:47 -03004711}
4712
Johan Hedberg4af605d2014-03-24 10:48:00 +02004713static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004714 u8 bdaddr_type, bdaddr_t *direct_addr,
4715 u8 direct_addr_type, s8 rssi, u8 *data, u8 len)
Johan Hedberg4af605d2014-03-24 10:48:00 +02004716{
Johan Hedbergb9a63282014-03-25 10:51:52 +02004717 struct discovery_state *d = &hdev->discovery;
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004718 struct smp_irk *irk;
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004719 struct hci_conn *conn;
Johan Hedberg474ee062014-03-25 14:34:59 +02004720 bool match;
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004721 u32 flags;
Johan Hedbergb9a63282014-03-25 10:51:52 +02004722
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004723 /* If the direct address is present, then this report is from
4724 * a LE Direct Advertising Report event. In that case it is
4725 * important to see if the address is matching the local
4726 * controller address.
4727 */
4728 if (direct_addr) {
4729 /* Only resolvable random addresses are valid for these
4730 * kind of reports and others can be ignored.
4731 */
4732 if (!hci_bdaddr_is_rpa(direct_addr, direct_addr_type))
4733 return;
4734
4735 /* If the controller is not using resolvable random
4736 * addresses, then this report can be ignored.
4737 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004738 if (!hci_dev_test_flag(hdev, HCI_PRIVACY))
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004739 return;
4740
4741 /* If the local IRK of the controller does not match
4742 * with the resolvable random address provided, then
4743 * this report can be ignored.
4744 */
4745 if (!smp_irk_matches(hdev, hdev->irk, direct_addr))
4746 return;
4747 }
4748
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004749 /* Check if we need to convert to identity address */
4750 irk = hci_get_irk(hdev, bdaddr, bdaddr_type);
4751 if (irk) {
4752 bdaddr = &irk->bdaddr;
4753 bdaddr_type = irk->addr_type;
4754 }
4755
4756 /* Check if we have been requested to connect to this device */
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004757 conn = check_pending_le_conn(hdev, bdaddr, bdaddr_type, type);
4758 if (conn && type == LE_ADV_IND) {
4759 /* Store report for later inclusion by
4760 * mgmt_device_connected
4761 */
4762 memcpy(conn->le_adv_data, data, len);
4763 conn->le_adv_data_len = len;
4764 }
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004765
Johan Hedberg0d2bf132014-07-02 22:42:02 +03004766 /* Passive scanning shouldn't trigger any device found events,
4767 * except for devices marked as CONN_REPORT for which we do send
4768 * device found events.
4769 */
Johan Hedbergca5c4be2014-03-25 10:30:46 +02004770 if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
Johan Hedberg0d2bf132014-07-02 22:42:02 +03004771 if (type == LE_ADV_DIRECT_IND)
4772 return;
4773
Johan Hedberg3a19b6f2014-07-15 08:07:59 +03004774 if (!hci_pend_le_action_lookup(&hdev->pend_le_reports,
4775 bdaddr, bdaddr_type))
Johan Hedberg0d2bf132014-07-02 22:42:02 +03004776 return;
4777
4778 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND)
4779 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4780 else
4781 flags = 0;
4782 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4783 rssi, flags, data, len, NULL, 0);
Johan Hedberg97bf2e92014-07-04 12:37:16 +03004784 return;
Johan Hedbergca5c4be2014-03-25 10:30:46 +02004785 }
Johan Hedberg4af605d2014-03-24 10:48:00 +02004786
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004787 /* When receiving non-connectable or scannable undirected
4788 * advertising reports, this means that the remote device is
4789 * not connectable and then clearly indicate this in the
4790 * device found event.
4791 *
4792 * When receiving a scan response, then there is no way to
4793 * know if the remote device is connectable or not. However
4794 * since scan responses are merged with a previously seen
4795 * advertising report, the flags field from that report
4796 * will be used.
4797 *
4798 * In the really unlikely case that a controller get confused
4799 * and just sends a scan response event, then it is marked as
4800 * not connectable as well.
4801 */
4802 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND ||
4803 type == LE_ADV_SCAN_RSP)
4804 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4805 else
4806 flags = 0;
4807
Johan Hedbergb9a63282014-03-25 10:51:52 +02004808 /* If there's nothing pending either store the data from this
4809 * event or send an immediate device found event if the data
4810 * should not be stored for later.
4811 */
4812 if (!has_pending_adv_report(hdev)) {
4813 /* If the report will trigger a SCAN_REQ store it for
4814 * later merging.
4815 */
4816 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4817 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004818 rssi, flags, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004819 return;
4820 }
4821
4822 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004823 rssi, flags, data, len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004824 return;
4825 }
4826
Johan Hedberg474ee062014-03-25 14:34:59 +02004827 /* Check if the pending report is for the same device as the new one */
4828 match = (!bacmp(bdaddr, &d->last_adv_addr) &&
4829 bdaddr_type == d->last_adv_addr_type);
4830
Johan Hedbergb9a63282014-03-25 10:51:52 +02004831 /* If the pending data doesn't match this report or this isn't a
4832 * scan response (e.g. we got a duplicate ADV_IND) then force
4833 * sending of the pending data.
4834 */
Johan Hedberg474ee062014-03-25 14:34:59 +02004835 if (type != LE_ADV_SCAN_RSP || !match) {
4836 /* Send out whatever is in the cache, but skip duplicates */
4837 if (!match)
4838 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004839 d->last_adv_addr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004840 d->last_adv_rssi, d->last_adv_flags,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004841 d->last_adv_data,
Johan Hedberg474ee062014-03-25 14:34:59 +02004842 d->last_adv_data_len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004843
4844 /* If the new report will trigger a SCAN_REQ store it for
4845 * later merging.
4846 */
4847 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4848 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004849 rssi, flags, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004850 return;
4851 }
4852
4853 /* The advertising reports cannot be merged, so clear
4854 * the pending report and send out a device found event.
4855 */
4856 clear_pending_adv_report(hdev);
Johan Hedberg5c5b93e2014-03-29 08:39:53 +02004857 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004858 rssi, flags, data, len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004859 return;
4860 }
4861
4862 /* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
4863 * the new event is a SCAN_RSP. We can therefore proceed with
4864 * sending a merged device found event.
4865 */
4866 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004867 d->last_adv_addr_type, NULL, rssi, d->last_adv_flags,
Marcel Holtmann42bd6a52014-07-01 14:11:19 +02004868 d->last_adv_data, d->last_adv_data_len, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004869 clear_pending_adv_report(hdev);
Johan Hedberg4af605d2014-03-24 10:48:00 +02004870}
4871
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004872static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03004873{
Andre Guedese95beb42011-09-26 20:48:35 -03004874 u8 num_reports = skb->data[0];
4875 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03004876
Andre Guedesa4790db2014-02-26 20:21:47 -03004877 hci_dev_lock(hdev);
4878
Andre Guedese95beb42011-09-26 20:48:35 -03004879 while (num_reports--) {
4880 struct hci_ev_le_advertising_info *ev = ptr;
Johan Hedberg4af605d2014-03-24 10:48:00 +02004881 s8 rssi;
Andre Guedesa4790db2014-02-26 20:21:47 -03004882
Andre Guedes3c9e9192012-01-10 18:20:50 -03004883 rssi = ev->data[ev->length];
Johan Hedberg4af605d2014-03-24 10:48:00 +02004884 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004885 ev->bdaddr_type, NULL, 0, rssi,
4886 ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03004887
Andre Guedese95beb42011-09-26 20:48:35 -03004888 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03004889 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004890
4891 hci_dev_unlock(hdev);
Andre Guedes9aa04c92011-05-26 16:23:51 -03004892}
4893
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07004894static void hci_le_remote_feat_complete_evt(struct hci_dev *hdev,
4895 struct sk_buff *skb)
4896{
4897 struct hci_ev_le_remote_feat_complete *ev = (void *)skb->data;
4898 struct hci_conn *conn;
4899
4900 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4901
4902 hci_dev_lock(hdev);
4903
4904 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4905 if (conn) {
4906 if (!ev->status)
4907 memcpy(conn->features[0], ev->features, 8);
4908
4909 if (conn->state == BT_CONFIG) {
4910 __u8 status;
4911
4912 /* If the local controller supports slave-initiated
4913 * features exchange, but the remote controller does
4914 * not, then it is possible that the error code 0x1a
4915 * for unsupported remote feature gets returned.
4916 *
4917 * In this specific case, allow the connection to
4918 * transition into connected state and mark it as
4919 * successful.
4920 */
4921 if ((hdev->le_features[0] & HCI_LE_SLAVE_FEATURES) &&
4922 !conn->out && ev->status == 0x1a)
4923 status = 0x00;
4924 else
4925 status = ev->status;
4926
4927 conn->state = BT_CONNECTED;
4928 hci_connect_cfm(conn, status);
4929 hci_conn_drop(conn);
4930 }
4931 }
4932
4933 hci_dev_unlock(hdev);
4934}
4935
Gustavo Padovan6039aa732012-05-23 04:04:18 -03004936static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004937{
4938 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
4939 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004940 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004941 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004942 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004943
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004944 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004945
4946 hci_dev_lock(hdev);
4947
4948 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004949 if (conn == NULL)
4950 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004951
Johan Hedbergf3a73d92014-05-29 15:02:59 +03004952 ltk = hci_find_ltk(hdev, &conn->dst, conn->dst_type, conn->role);
Johan Hedberg5378bc52014-05-29 14:00:39 +03004953 if (!ltk)
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004954 goto not_found;
4955
Johan Hedberg5378bc52014-05-29 14:00:39 +03004956 if (smp_ltk_is_sc(ltk)) {
4957 /* With SC both EDiv and Rand are set to zero */
4958 if (ev->ediv || ev->rand)
4959 goto not_found;
4960 } else {
4961 /* For non-SC keys check that EDiv and Rand match */
4962 if (ev->ediv != ltk->ediv || ev->rand != ltk->rand)
4963 goto not_found;
4964 }
4965
Johan Hedberg8b76ce32015-06-08 18:14:39 +03004966 memcpy(cp.ltk, ltk->val, ltk->enc_size);
4967 memset(cp.ltk + ltk->enc_size, 0, sizeof(cp.ltk) - ltk->enc_size);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004968 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004969
Johan Hedberga6f78332014-09-10 17:37:45 -07004970 conn->pending_sec_level = smp_ltk_sec_level(ltk);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004971
Andre Guedes89cbb4d2013-07-31 16:25:29 -03004972 conn->enc_key_size = ltk->enc_size;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004973
4974 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
4975
Claudio Takahasi5981a882013-07-25 16:34:24 -03004976 /* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
4977 * temporary key used to encrypt a connection following
4978 * pairing. It is used during the Encrypted Session Setup to
4979 * distribute the keys. Later, security can be re-established
4980 * using a distributed LTK.
4981 */
Johan Hedberg2ceba532014-06-16 19:25:16 +03004982 if (ltk->type == SMP_STK) {
Johan Hedbergfe59a052014-07-01 19:14:12 +03004983 set_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
Johan Hedberg970d0f12014-11-13 14:37:47 +02004984 list_del_rcu(&ltk->list);
4985 kfree_rcu(ltk, rcu);
Johan Hedbergfe59a052014-07-01 19:14:12 +03004986 } else {
4987 clear_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03004988 }
4989
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004990 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03004991
4992 return;
4993
4994not_found:
4995 neg.handle = ev->handle;
4996 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
4997 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03004998}
4999
Andre Guedes8e75b462014-07-01 18:10:08 -03005000static void send_conn_param_neg_reply(struct hci_dev *hdev, u16 handle,
5001 u8 reason)
5002{
5003 struct hci_cp_le_conn_param_req_neg_reply cp;
5004
5005 cp.handle = cpu_to_le16(handle);
5006 cp.reason = reason;
5007
5008 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_NEG_REPLY, sizeof(cp),
5009 &cp);
5010}
5011
5012static void hci_le_remote_conn_param_req_evt(struct hci_dev *hdev,
5013 struct sk_buff *skb)
5014{
5015 struct hci_ev_le_remote_conn_param_req *ev = (void *) skb->data;
5016 struct hci_cp_le_conn_param_req_reply cp;
5017 struct hci_conn *hcon;
5018 u16 handle, min, max, latency, timeout;
5019
5020 handle = le16_to_cpu(ev->handle);
5021 min = le16_to_cpu(ev->interval_min);
5022 max = le16_to_cpu(ev->interval_max);
5023 latency = le16_to_cpu(ev->latency);
5024 timeout = le16_to_cpu(ev->timeout);
5025
5026 hcon = hci_conn_hash_lookup_handle(hdev, handle);
5027 if (!hcon || hcon->state != BT_CONNECTED)
5028 return send_conn_param_neg_reply(hdev, handle,
5029 HCI_ERROR_UNKNOWN_CONN_ID);
5030
5031 if (hci_check_conn_params(min, max, latency, timeout))
5032 return send_conn_param_neg_reply(hdev, handle,
5033 HCI_ERROR_INVALID_LL_PARAMS);
5034
Johan Hedberg40bef302014-07-16 11:42:27 +03005035 if (hcon->role == HCI_ROLE_MASTER) {
Johan Hedberg348d50b2014-07-02 17:37:30 +03005036 struct hci_conn_params *params;
Johan Hedbergf4869e22014-07-02 17:37:32 +03005037 u8 store_hint;
Johan Hedberg348d50b2014-07-02 17:37:30 +03005038
5039 hci_dev_lock(hdev);
5040
5041 params = hci_conn_params_lookup(hdev, &hcon->dst,
5042 hcon->dst_type);
5043 if (params) {
5044 params->conn_min_interval = min;
5045 params->conn_max_interval = max;
5046 params->conn_latency = latency;
5047 params->supervision_timeout = timeout;
Johan Hedbergf4869e22014-07-02 17:37:32 +03005048 store_hint = 0x01;
5049 } else{
5050 store_hint = 0x00;
Johan Hedberg348d50b2014-07-02 17:37:30 +03005051 }
5052
5053 hci_dev_unlock(hdev);
5054
Johan Hedbergf4869e22014-07-02 17:37:32 +03005055 mgmt_new_conn_param(hdev, &hcon->dst, hcon->dst_type,
5056 store_hint, min, max, latency, timeout);
Johan Hedberg348d50b2014-07-02 17:37:30 +03005057 }
Andre Guedesffb5a8272014-07-01 18:10:11 -03005058
Andre Guedes8e75b462014-07-01 18:10:08 -03005059 cp.handle = ev->handle;
5060 cp.interval_min = ev->interval_min;
5061 cp.interval_max = ev->interval_max;
5062 cp.latency = ev->latency;
5063 cp.timeout = ev->timeout;
5064 cp.min_ce_len = 0;
5065 cp.max_ce_len = 0;
5066
5067 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_REPLY, sizeof(cp), &cp);
5068}
5069
Marcel Holtmann2f010b52014-12-05 16:20:13 +01005070static void hci_le_direct_adv_report_evt(struct hci_dev *hdev,
5071 struct sk_buff *skb)
5072{
5073 u8 num_reports = skb->data[0];
5074 void *ptr = &skb->data[1];
5075
5076 hci_dev_lock(hdev);
5077
5078 while (num_reports--) {
5079 struct hci_ev_le_direct_adv_info *ev = ptr;
5080
5081 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
5082 ev->bdaddr_type, &ev->direct_addr,
5083 ev->direct_addr_type, ev->rssi, NULL, 0);
5084
5085 ptr += sizeof(*ev);
5086 }
5087
5088 hci_dev_unlock(hdev);
5089}
5090
Gustavo Padovan6039aa732012-05-23 04:04:18 -03005091static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03005092{
5093 struct hci_ev_le_meta *le_ev = (void *) skb->data;
5094
5095 skb_pull(skb, sizeof(*le_ev));
5096
5097 switch (le_ev->subevent) {
5098 case HCI_EV_LE_CONN_COMPLETE:
5099 hci_le_conn_complete_evt(hdev, skb);
5100 break;
5101
Marcel Holtmann1855d922014-06-23 11:40:05 +02005102 case HCI_EV_LE_CONN_UPDATE_COMPLETE:
5103 hci_le_conn_update_complete_evt(hdev, skb);
5104 break;
5105
Andre Guedes9aa04c92011-05-26 16:23:51 -03005106 case HCI_EV_LE_ADVERTISING_REPORT:
5107 hci_le_adv_report_evt(hdev, skb);
5108 break;
5109
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07005110 case HCI_EV_LE_REMOTE_FEAT_COMPLETE:
5111 hci_le_remote_feat_complete_evt(hdev, skb);
5112 break;
5113
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005114 case HCI_EV_LE_LTK_REQ:
5115 hci_le_ltk_request_evt(hdev, skb);
5116 break;
5117
Andre Guedes8e75b462014-07-01 18:10:08 -03005118 case HCI_EV_LE_REMOTE_CONN_PARAM_REQ:
5119 hci_le_remote_conn_param_req_evt(hdev, skb);
5120 break;
5121
Marcel Holtmann2f010b52014-12-05 16:20:13 +01005122 case HCI_EV_LE_DIRECT_ADV_REPORT:
5123 hci_le_direct_adv_report_evt(hdev, skb);
5124 break;
5125
Ville Tervofcd89c02011-02-10 22:38:47 -03005126 default:
5127 break;
5128 }
5129}
5130
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005131static bool hci_get_cmd_complete(struct hci_dev *hdev, u16 opcode,
5132 u8 event, struct sk_buff *skb)
5133{
5134 struct hci_ev_cmd_complete *ev;
5135 struct hci_event_hdr *hdr;
5136
5137 if (!skb)
5138 return false;
5139
5140 if (skb->len < sizeof(*hdr)) {
5141 BT_ERR("Too short HCI event");
5142 return false;
5143 }
5144
5145 hdr = (void *) skb->data;
5146 skb_pull(skb, HCI_EVENT_HDR_SIZE);
5147
5148 if (event) {
5149 if (hdr->evt != event)
5150 return false;
5151 return true;
5152 }
5153
5154 if (hdr->evt != HCI_EV_CMD_COMPLETE) {
5155 BT_DBG("Last event is not cmd complete (0x%2.2x)", hdr->evt);
5156 return false;
5157 }
5158
5159 if (skb->len < sizeof(*ev)) {
5160 BT_ERR("Too short cmd_complete event");
5161 return false;
5162 }
5163
5164 ev = (void *) skb->data;
5165 skb_pull(skb, sizeof(*ev));
5166
5167 if (opcode != __le16_to_cpu(ev->opcode)) {
5168 BT_DBG("opcode doesn't match (0x%2.2x != 0x%2.2x)", opcode,
5169 __le16_to_cpu(ev->opcode));
5170 return false;
5171 }
5172
5173 return true;
5174}
5175
Linus Torvalds1da177e2005-04-16 15:20:36 -07005176void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
5177{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005178 struct hci_event_hdr *hdr = (void *) skb->data;
Johan Hedberge62144872015-04-02 13:41:08 +03005179 hci_req_complete_t req_complete = NULL;
5180 hci_req_complete_skb_t req_complete_skb = NULL;
5181 struct sk_buff *orig_skb = NULL;
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005182 u8 status = 0, event = hdr->evt, req_evt = 0;
Johan Hedberge62144872015-04-02 13:41:08 +03005183 u16 opcode = HCI_OP_NOP;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005184
Johan Hedbergdb6e3e82015-03-30 23:21:02 +03005185 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02005186 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
Johan Hedberge62144872015-04-02 13:41:08 +03005187 opcode = __le16_to_cpu(cmd_hdr->opcode);
5188 hci_req_cmd_complete(hdev, opcode, status, &req_complete,
5189 &req_complete_skb);
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005190 req_evt = event;
Johan Hedberg02350a72013-04-03 21:50:29 +03005191 }
5192
Johan Hedberge62144872015-04-02 13:41:08 +03005193 /* If it looks like we might end up having to call
5194 * req_complete_skb, store a pristine copy of the skb since the
5195 * various handlers may modify the original one through
5196 * skb_pull() calls, etc.
5197 */
5198 if (req_complete_skb || event == HCI_EV_CMD_STATUS ||
5199 event == HCI_EV_CMD_COMPLETE)
5200 orig_skb = skb_clone(skb, GFP_KERNEL);
5201
5202 skb_pull(skb, HCI_EVENT_HDR_SIZE);
5203
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005204 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005205 case HCI_EV_INQUIRY_COMPLETE:
5206 hci_inquiry_complete_evt(hdev, skb);
5207 break;
5208
5209 case HCI_EV_INQUIRY_RESULT:
5210 hci_inquiry_result_evt(hdev, skb);
5211 break;
5212
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005213 case HCI_EV_CONN_COMPLETE:
5214 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02005215 break;
5216
Linus Torvalds1da177e2005-04-16 15:20:36 -07005217 case HCI_EV_CONN_REQUEST:
5218 hci_conn_request_evt(hdev, skb);
5219 break;
5220
Linus Torvalds1da177e2005-04-16 15:20:36 -07005221 case HCI_EV_DISCONN_COMPLETE:
5222 hci_disconn_complete_evt(hdev, skb);
5223 break;
5224
Linus Torvalds1da177e2005-04-16 15:20:36 -07005225 case HCI_EV_AUTH_COMPLETE:
5226 hci_auth_complete_evt(hdev, skb);
5227 break;
5228
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005229 case HCI_EV_REMOTE_NAME:
5230 hci_remote_name_evt(hdev, skb);
5231 break;
5232
Linus Torvalds1da177e2005-04-16 15:20:36 -07005233 case HCI_EV_ENCRYPT_CHANGE:
5234 hci_encrypt_change_evt(hdev, skb);
5235 break;
5236
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005237 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
5238 hci_change_link_key_complete_evt(hdev, skb);
5239 break;
5240
5241 case HCI_EV_REMOTE_FEATURES:
5242 hci_remote_features_evt(hdev, skb);
5243 break;
5244
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005245 case HCI_EV_CMD_COMPLETE:
Johan Hedberge62144872015-04-02 13:41:08 +03005246 hci_cmd_complete_evt(hdev, skb, &opcode, &status,
5247 &req_complete, &req_complete_skb);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005248 break;
5249
5250 case HCI_EV_CMD_STATUS:
Johan Hedberge62144872015-04-02 13:41:08 +03005251 hci_cmd_status_evt(hdev, skb, &opcode, &status, &req_complete,
5252 &req_complete_skb);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005253 break;
5254
Marcel Holtmann24dfa342014-11-02 02:56:41 +01005255 case HCI_EV_HARDWARE_ERROR:
5256 hci_hardware_error_evt(hdev, skb);
5257 break;
5258
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005259 case HCI_EV_ROLE_CHANGE:
5260 hci_role_change_evt(hdev, skb);
5261 break;
5262
5263 case HCI_EV_NUM_COMP_PKTS:
5264 hci_num_comp_pkts_evt(hdev, skb);
5265 break;
5266
5267 case HCI_EV_MODE_CHANGE:
5268 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005269 break;
5270
5271 case HCI_EV_PIN_CODE_REQ:
5272 hci_pin_code_request_evt(hdev, skb);
5273 break;
5274
5275 case HCI_EV_LINK_KEY_REQ:
5276 hci_link_key_request_evt(hdev, skb);
5277 break;
5278
5279 case HCI_EV_LINK_KEY_NOTIFY:
5280 hci_link_key_notify_evt(hdev, skb);
5281 break;
5282
5283 case HCI_EV_CLOCK_OFFSET:
5284 hci_clock_offset_evt(hdev, skb);
5285 break;
5286
Marcel Holtmanna8746412008-07-14 20:13:46 +02005287 case HCI_EV_PKT_TYPE_CHANGE:
5288 hci_pkt_type_change_evt(hdev, skb);
5289 break;
5290
Marcel Holtmann85a1e932005-08-09 20:28:02 -07005291 case HCI_EV_PSCAN_REP_MODE:
5292 hci_pscan_rep_mode_evt(hdev, skb);
5293 break;
5294
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005295 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
5296 hci_inquiry_result_with_rssi_evt(hdev, skb);
5297 break;
5298
5299 case HCI_EV_REMOTE_EXT_FEATURES:
5300 hci_remote_ext_features_evt(hdev, skb);
5301 break;
5302
5303 case HCI_EV_SYNC_CONN_COMPLETE:
5304 hci_sync_conn_complete_evt(hdev, skb);
5305 break;
5306
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005307 case HCI_EV_EXTENDED_INQUIRY_RESULT:
5308 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005309 break;
5310
Johan Hedberg1c2e0042012-06-08 23:31:13 +08005311 case HCI_EV_KEY_REFRESH_COMPLETE:
5312 hci_key_refresh_complete_evt(hdev, skb);
5313 break;
5314
Marcel Holtmann04936842008-07-14 20:13:48 +02005315 case HCI_EV_IO_CAPA_REQUEST:
5316 hci_io_capa_request_evt(hdev, skb);
5317 break;
5318
Johan Hedberg03b555e2011-01-04 15:40:05 +02005319 case HCI_EV_IO_CAPA_REPLY:
5320 hci_io_capa_reply_evt(hdev, skb);
5321 break;
5322
Johan Hedberga5c29682011-02-19 12:05:57 -03005323 case HCI_EV_USER_CONFIRM_REQUEST:
5324 hci_user_confirm_request_evt(hdev, skb);
5325 break;
5326
Brian Gix1143d452011-11-23 08:28:34 -08005327 case HCI_EV_USER_PASSKEY_REQUEST:
5328 hci_user_passkey_request_evt(hdev, skb);
5329 break;
5330
Johan Hedberg92a25252012-09-06 18:39:26 +03005331 case HCI_EV_USER_PASSKEY_NOTIFY:
5332 hci_user_passkey_notify_evt(hdev, skb);
5333 break;
5334
5335 case HCI_EV_KEYPRESS_NOTIFY:
5336 hci_keypress_notify_evt(hdev, skb);
5337 break;
5338
Marcel Holtmann04936842008-07-14 20:13:48 +02005339 case HCI_EV_SIMPLE_PAIR_COMPLETE:
5340 hci_simple_pair_complete_evt(hdev, skb);
5341 break;
5342
Marcel Holtmann41a96212008-07-14 20:13:48 +02005343 case HCI_EV_REMOTE_HOST_FEATURES:
5344 hci_remote_host_features_evt(hdev, skb);
5345 break;
5346
Ville Tervofcd89c02011-02-10 22:38:47 -03005347 case HCI_EV_LE_META:
5348 hci_le_meta_evt(hdev, skb);
5349 break;
5350
Szymon Janc2763eda2011-03-22 13:12:22 +01005351 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
5352 hci_remote_oob_data_request_evt(hdev, skb);
5353 break;
5354
Arron Wanga77a6a12015-07-24 17:13:15 +08005355#if IS_ENABLED(CONFIG_BT_HS)
5356 case HCI_EV_CHANNEL_SELECTED:
5357 hci_chan_selected_evt(hdev, skb);
5358 break;
5359
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03005360 case HCI_EV_PHY_LINK_COMPLETE:
5361 hci_phy_link_complete_evt(hdev, skb);
5362 break;
5363
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03005364 case HCI_EV_LOGICAL_LINK_COMPLETE:
5365 hci_loglink_complete_evt(hdev, skb);
5366 break;
5367
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02005368 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
5369 hci_disconn_loglink_complete_evt(hdev, skb);
5370 break;
5371
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02005372 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
5373 hci_disconn_phylink_complete_evt(hdev, skb);
5374 break;
Arron Wanga77a6a12015-07-24 17:13:15 +08005375#endif
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02005376
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02005377 case HCI_EV_NUM_COMP_BLOCKS:
5378 hci_num_comp_blocks_evt(hdev, skb);
5379 break;
5380
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005381 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03005382 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005383 break;
5384 }
5385
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005386 if (req_complete) {
Johan Hedberge62144872015-04-02 13:41:08 +03005387 req_complete(hdev, status, opcode);
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005388 } else if (req_complete_skb) {
5389 if (!hci_get_cmd_complete(hdev, opcode, req_evt, orig_skb)) {
5390 kfree_skb(orig_skb);
5391 orig_skb = NULL;
5392 }
Johan Hedberge62144872015-04-02 13:41:08 +03005393 req_complete_skb(hdev, status, opcode, orig_skb);
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005394 }
Johan Hedberge62144872015-04-02 13:41:08 +03005395
5396 kfree_skb(orig_skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005397 kfree_skb(skb);
5398 hdev->stat.evt_rx++;
5399}