blob: a9a8e453817e1907d7478e538a0d05b2dd2db85d [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 Holtmanna93661202015-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
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300840static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
841 struct sk_buff *skb)
842{
843 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
844 struct amp_assoc *assoc = &hdev->loc_assoc;
845 size_t rem_len, frag_len;
846
847 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
848
849 if (rp->status)
850 goto a2mp_rsp;
851
852 frag_len = skb->len - sizeof(*rp);
853 rem_len = __le16_to_cpu(rp->rem_len);
854
855 if (rem_len > frag_len) {
Andrei Emeltchenko2e430be32012-09-28 14:44:23 +0300856 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300857
858 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
859 assoc->offset += frag_len;
860
861 /* Read other fragments */
862 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
863
864 return;
865 }
866
867 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
868 assoc->len = assoc->offset + rem_len;
869 assoc->offset = 0;
870
871a2mp_rsp:
872 /* Send A2MP Rsp when all fragments are received */
873 a2mp_send_getampassoc_rsp(hdev, rp->status);
Andrei Emeltchenko9495b2e2012-09-27 17:26:22 +0300874 a2mp_send_create_phy_link_req(hdev, rp->status);
Andrei Emeltchenko903e4542012-09-27 17:26:09 +0300875}
876
Johan Hedbergd5859e22011-01-25 01:19:58 +0200877static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300878 struct sk_buff *skb)
Johan Hedbergd5859e22011-01-25 01:19:58 +0200879{
Marcel Holtmann91c4e9b2012-03-11 19:27:21 -0700880 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200881
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300882 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedbergd5859e22011-01-25 01:19:58 +0200883
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200884 if (rp->status)
885 return;
886
887 hdev->inq_tx_power = rp->tx_power;
Johan Hedbergd5859e22011-01-25 01:19:58 +0200888}
889
Johan Hedberg980e1a52011-01-22 06:10:07 +0200890static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
891{
892 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
893 struct hci_cp_pin_code_reply *cp;
894 struct hci_conn *conn;
895
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300896 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200897
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200898 hci_dev_lock(hdev);
899
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700900 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg744cf192011-11-08 20:40:14 +0200901 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200902
Mikel Astizfa1bd912012-08-09 09:52:29 +0200903 if (rp->status)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200904 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200905
906 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
907 if (!cp)
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200908 goto unlock;
Johan Hedberg980e1a52011-01-22 06:10:07 +0200909
910 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
911 if (conn)
912 conn->pin_length = cp->pin_len;
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200913
914unlock:
915 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200916}
917
918static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
919{
920 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
921
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300922 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200923
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200924 hci_dev_lock(hdev);
925
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700926 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg744cf192011-11-08 20:40:14 +0200927 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300928 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200929
930 hci_dev_unlock(hdev);
Johan Hedberg980e1a52011-01-22 06:10:07 +0200931}
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200932
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300933static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
934 struct sk_buff *skb)
935{
936 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
937
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300938 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300939
940 if (rp->status)
941 return;
942
943 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
944 hdev->le_pkts = rp->le_max_pkt;
945
946 hdev->le_cnt = hdev->le_pkts;
947
948 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
Ville Tervo6ed58ec2011-02-10 22:38:48 -0300949}
Johan Hedberg980e1a52011-01-22 06:10:07 +0200950
Johan Hedberg60e77322013-01-22 14:01:59 +0200951static void hci_cc_le_read_local_features(struct hci_dev *hdev,
952 struct sk_buff *skb)
953{
954 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
955
956 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
957
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200958 if (rp->status)
959 return;
960
961 memcpy(hdev->le_features, rp->features, 8);
Johan Hedberg60e77322013-01-22 14:01:59 +0200962}
963
Johan Hedberg8fa19092012-10-19 20:57:49 +0300964static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
965 struct sk_buff *skb)
966{
967 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
968
969 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
970
Marcel Holtmann45296ac2014-07-05 10:48:01 +0200971 if (rp->status)
972 return;
973
974 hdev->adv_tx_power = rp->tx_power;
Johan Hedberg8fa19092012-10-19 20:57:49 +0300975}
976
Johan Hedberga5c29682011-02-19 12:05:57 -0300977static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
978{
979 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
980
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300981 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300982
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200983 hci_dev_lock(hdev);
984
Marcel Holtmannd7a5a112015-03-13 02:11:00 -0700985 if (hci_dev_test_flag(hdev, HCI_MGMT))
Gustavo F. Padovan04124682012-03-08 01:25:00 -0300986 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
987 rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200988
989 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -0300990}
991
992static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -0300993 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -0300994{
995 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
996
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +0300997 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Johan Hedberga5c29682011-02-19 12:05:57 -0300998
Johan Hedberg56e5cb82011-11-08 20:40:16 +0200999 hci_dev_lock(hdev);
1000
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001001 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg744cf192011-11-08 20:40:14 +02001002 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001003 ACL_LINK, 0, rp->status);
Johan Hedberg56e5cb82011-11-08 20:40:16 +02001004
1005 hci_dev_unlock(hdev);
Johan Hedberga5c29682011-02-19 12:05:57 -03001006}
1007
Brian Gix1143d452011-11-23 08:28:34 -08001008static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
1009{
1010 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
1011
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001012 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001013
1014 hci_dev_lock(hdev);
1015
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001016 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg272d90d2012-02-09 15:26:12 +02001017 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001018 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001019
1020 hci_dev_unlock(hdev);
1021}
1022
1023static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001024 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08001025{
1026 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
1027
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001028 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001029
1030 hci_dev_lock(hdev);
1031
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001032 if (hci_dev_test_flag(hdev, HCI_MGMT))
Brian Gix1143d452011-11-23 08:28:34 -08001033 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001034 ACL_LINK, 0, rp->status);
Brian Gix1143d452011-11-23 08:28:34 -08001035
1036 hci_dev_unlock(hdev);
1037}
1038
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08001039static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
1040 struct sk_buff *skb)
Szymon Jancc35938b2011-03-22 13:12:21 +01001041{
1042 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
1043
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001044 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08001045}
1046
1047static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
1048 struct sk_buff *skb)
1049{
1050 struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;
1051
1052 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
Szymon Jancc35938b2011-03-22 13:12:21 +01001053}
1054
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08001055static void hci_cc_le_set_random_addr(struct hci_dev *hdev, struct sk_buff *skb)
1056{
1057 __u8 status = *((__u8 *) skb->data);
1058 bdaddr_t *sent;
1059
1060 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1061
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001062 if (status)
1063 return;
1064
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08001065 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
1066 if (!sent)
1067 return;
1068
1069 hci_dev_lock(hdev);
1070
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001071 bacpy(&hdev->random_addr, sent);
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08001072
1073 hci_dev_unlock(hdev);
1074}
1075
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001076static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
1077{
1078 __u8 *sent, status = *((__u8 *) skb->data);
1079
1080 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1081
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001082 if (status)
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001083 return;
1084
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001085 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
1086 if (!sent)
Johan Hedberg3c857752014-03-25 10:30:49 +02001087 return;
1088
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001089 hci_dev_lock(hdev);
1090
Stephen Hemminger49c922b2014-10-27 21:12:20 -07001091 /* If we're doing connection initiation as peripheral. Set a
Johan Hedberg3c857752014-03-25 10:30:49 +02001092 * timeout in case something goes wrong.
1093 */
1094 if (*sent) {
1095 struct hci_conn *conn;
1096
Marcel Holtmanna1536da2015-03-13 02:11:01 -07001097 hci_dev_set_flag(hdev, HCI_LE_ADV);
Johan Hedberg66c417c2014-07-08 15:07:47 +03001098
Johan Hedberg3c857752014-03-25 10:30:49 +02001099 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
1100 if (conn)
1101 queue_delayed_work(hdev->workqueue,
1102 &conn->le_conn_timeout,
Johan Hedberg09ae2602014-07-06 13:41:15 +03001103 conn->conn_timeout);
Johan Hedberg66c417c2014-07-08 15:07:47 +03001104 } else {
Marcel Holtmanna358dc12015-03-13 02:11:02 -07001105 hci_dev_clear_flag(hdev, HCI_LE_ADV);
Johan Hedberg3c857752014-03-25 10:30:49 +02001106 }
1107
Johan Hedberg04b4edc2013-03-15 17:07:01 -05001108 hci_dev_unlock(hdev);
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01001109}
1110
Marcel Holtmann533553f2014-03-21 12:18:10 -07001111static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
1112{
1113 struct hci_cp_le_set_scan_param *cp;
1114 __u8 status = *((__u8 *) skb->data);
1115
1116 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1117
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001118 if (status)
1119 return;
1120
Marcel Holtmann533553f2014-03-21 12:18:10 -07001121 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
1122 if (!cp)
1123 return;
1124
1125 hci_dev_lock(hdev);
1126
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001127 hdev->le_scan_type = cp->type;
Marcel Holtmann533553f2014-03-21 12:18:10 -07001128
1129 hci_dev_unlock(hdev);
1130}
1131
Johan Hedbergb9a63282014-03-25 10:51:52 +02001132static bool has_pending_adv_report(struct hci_dev *hdev)
1133{
1134 struct discovery_state *d = &hdev->discovery;
1135
1136 return bacmp(&d->last_adv_addr, BDADDR_ANY);
1137}
1138
1139static void clear_pending_adv_report(struct hci_dev *hdev)
1140{
1141 struct discovery_state *d = &hdev->discovery;
1142
1143 bacpy(&d->last_adv_addr, BDADDR_ANY);
1144 d->last_adv_data_len = 0;
1145}
1146
1147static void store_pending_adv_report(struct hci_dev *hdev, bdaddr_t *bdaddr,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02001148 u8 bdaddr_type, s8 rssi, u32 flags,
1149 u8 *data, u8 len)
Johan Hedbergb9a63282014-03-25 10:51:52 +02001150{
1151 struct discovery_state *d = &hdev->discovery;
1152
1153 bacpy(&d->last_adv_addr, bdaddr);
1154 d->last_adv_addr_type = bdaddr_type;
Johan Hedbergff5cd292014-03-25 14:40:52 +02001155 d->last_adv_rssi = rssi;
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02001156 d->last_adv_flags = flags;
Johan Hedbergb9a63282014-03-25 10:51:52 +02001157 memcpy(d->last_adv_data, data, len);
1158 d->last_adv_data_len = len;
1159}
1160
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001161static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001162 struct sk_buff *skb)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001163{
1164 struct hci_cp_le_set_scan_enable *cp;
1165 __u8 status = *((__u8 *) skb->data);
1166
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001167 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001168
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001169 if (status)
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001170 return;
1171
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001172 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1173 if (!cp)
Andre Guedes3fd319b2013-04-30 15:29:36 -03001174 return;
1175
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301176 hci_dev_lock(hdev);
1177
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001178 switch (cp->enable) {
Andre Guedes76a388b2013-04-04 20:21:02 -03001179 case LE_SCAN_ENABLE:
Marcel Holtmanna1536da2015-03-13 02:11:01 -07001180 hci_dev_set_flag(hdev, HCI_LE_SCAN);
Johan Hedbergb9a63282014-03-25 10:51:52 +02001181 if (hdev->le_scan_type == LE_SCAN_ACTIVE)
1182 clear_pending_adv_report(hdev);
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001183 break;
1184
Andre Guedes76a388b2013-04-04 20:21:02 -03001185 case LE_SCAN_DISABLE:
Johan Hedbergb9a63282014-03-25 10:51:52 +02001186 /* We do this here instead of when setting DISCOVERY_STOPPED
1187 * since the latter would potentially require waiting for
1188 * inquiry to stop too.
1189 */
1190 if (has_pending_adv_report(hdev)) {
1191 struct discovery_state *d = &hdev->discovery;
1192
1193 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergab0aa432014-03-26 14:17:12 +02001194 d->last_adv_addr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02001195 d->last_adv_rssi, d->last_adv_flags,
Johan Hedbergab0aa432014-03-26 14:17:12 +02001196 d->last_adv_data,
Johan Hedbergb9a63282014-03-25 10:51:52 +02001197 d->last_adv_data_len, NULL, 0);
1198 }
1199
Johan Hedberg317ac8c2014-02-28 20:26:12 +02001200 /* Cancel this timer so that we don't try to disable scanning
1201 * when it's already disabled.
1202 */
1203 cancel_delayed_work(&hdev->le_scan_disable);
1204
Marcel Holtmanna358dc12015-03-13 02:11:02 -07001205 hci_dev_clear_flag(hdev, HCI_LE_SCAN);
Johan Hedberge8bb6b92014-07-08 15:07:53 +03001206
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001207 /* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
1208 * interrupted scanning due to a connect request. Mark
Johan Hedberge8bb6b92014-07-08 15:07:53 +03001209 * therefore discovery as stopped. If this was not
1210 * because of a connect request advertising might have
1211 * been disabled because of active scanning, so
1212 * re-enable it again if necessary.
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001213 */
Marcel Holtmanna69d8922015-03-13 02:11:05 -07001214 if (hci_dev_test_and_clear_flag(hdev, HCI_LE_SCAN_INTERRUPTED))
Johan Hedberg81ad6fd2014-02-28 20:26:13 +02001215 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001216 else if (!hci_dev_test_flag(hdev, HCI_LE_ADV) &&
Johan Hedberg34722272014-07-08 16:05:05 +03001217 hdev->discovery.state == DISCOVERY_FINDING)
Johan Hedberge8bb6b92014-07-08 15:07:53 +03001218 mgmt_reenable_advertising(hdev);
1219
Andrei Emeltchenko68a8aea2011-12-19 16:14:18 +02001220 break;
1221
1222 default:
1223 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1224 break;
Andre Guedes35815082011-05-26 16:23:53 -03001225 }
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301226
1227 hci_dev_unlock(hdev);
Andre Guedeseb9d91f2011-05-26 16:23:52 -03001228}
1229
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001230static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1231 struct sk_buff *skb)
1232{
1233 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1234
1235 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1236
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001237 if (rp->status)
1238 return;
1239
1240 hdev->le_white_list_size = rp->size;
Johan Hedbergcf1d0812013-01-22 14:02:00 +02001241}
1242
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001243static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
1244 struct sk_buff *skb)
1245{
1246 __u8 status = *((__u8 *) skb->data);
1247
1248 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1249
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001250 if (status)
1251 return;
1252
Johan Hedbergdcc36c12014-07-09 12:59:13 +03001253 hci_bdaddr_list_clear(&hdev->le_white_list);
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001254}
1255
1256static void hci_cc_le_add_to_white_list(struct hci_dev *hdev,
1257 struct sk_buff *skb)
1258{
1259 struct hci_cp_le_add_to_white_list *sent;
1260 __u8 status = *((__u8 *) skb->data);
1261
1262 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1263
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001264 if (status)
1265 return;
1266
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001267 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_WHITE_LIST);
1268 if (!sent)
1269 return;
1270
Johan Hedbergdcc36c12014-07-09 12:59:13 +03001271 hci_bdaddr_list_add(&hdev->le_white_list, &sent->bdaddr,
1272 sent->bdaddr_type);
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001273}
1274
1275static void hci_cc_le_del_from_white_list(struct hci_dev *hdev,
1276 struct sk_buff *skb)
1277{
1278 struct hci_cp_le_del_from_white_list *sent;
1279 __u8 status = *((__u8 *) skb->data);
1280
1281 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1282
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001283 if (status)
1284 return;
1285
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001286 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_WHITE_LIST);
1287 if (!sent)
1288 return;
1289
Johan Hedbergdcc36c12014-07-09 12:59:13 +03001290 hci_bdaddr_list_del(&hdev->le_white_list, &sent->bdaddr,
1291 sent->bdaddr_type);
Marcel Holtmann0f36b582014-02-27 20:37:31 -08001292}
1293
Johan Hedberg9b008c02013-01-22 14:02:01 +02001294static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1295 struct sk_buff *skb)
1296{
1297 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1298
1299 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1300
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001301 if (rp->status)
1302 return;
1303
1304 memcpy(hdev->le_states, rp->le_states, 8);
Johan Hedberg9b008c02013-01-22 14:02:01 +02001305}
1306
Marcel Holtmanna8e1bfa2014-12-20 16:28:40 +01001307static void hci_cc_le_read_def_data_len(struct hci_dev *hdev,
1308 struct sk_buff *skb)
1309{
1310 struct hci_rp_le_read_def_data_len *rp = (void *) skb->data;
1311
1312 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1313
1314 if (rp->status)
1315 return;
1316
1317 hdev->le_def_tx_len = le16_to_cpu(rp->tx_len);
1318 hdev->le_def_tx_time = le16_to_cpu(rp->tx_time);
1319}
1320
1321static void hci_cc_le_write_def_data_len(struct hci_dev *hdev,
1322 struct sk_buff *skb)
1323{
1324 struct hci_cp_le_write_def_data_len *sent;
1325 __u8 status = *((__u8 *) skb->data);
1326
1327 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1328
1329 if (status)
1330 return;
1331
1332 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_WRITE_DEF_DATA_LEN);
1333 if (!sent)
1334 return;
1335
1336 hdev->le_def_tx_len = le16_to_cpu(sent->tx_len);
1337 hdev->le_def_tx_time = le16_to_cpu(sent->tx_time);
1338}
1339
1340static void hci_cc_le_read_max_data_len(struct hci_dev *hdev,
1341 struct sk_buff *skb)
1342{
1343 struct hci_rp_le_read_max_data_len *rp = (void *) skb->data;
1344
1345 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1346
1347 if (rp->status)
1348 return;
1349
1350 hdev->le_max_tx_len = le16_to_cpu(rp->tx_len);
1351 hdev->le_max_tx_time = le16_to_cpu(rp->tx_time);
1352 hdev->le_max_rx_len = le16_to_cpu(rp->rx_len);
1353 hdev->le_max_rx_time = le16_to_cpu(rp->rx_time);
1354}
1355
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001356static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1357 struct sk_buff *skb)
Andre Guedesf9b49302011-06-30 19:20:53 -03001358{
Johan Hedberg06199cf2012-02-22 16:37:11 +02001359 struct hci_cp_write_le_host_supported *sent;
Andre Guedesf9b49302011-06-30 19:20:53 -03001360 __u8 status = *((__u8 *) skb->data);
1361
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001362 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andre Guedesf9b49302011-06-30 19:20:53 -03001363
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001364 if (status)
1365 return;
1366
Johan Hedberg06199cf2012-02-22 16:37:11 +02001367 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001368 if (!sent)
Andre Guedesf9b49302011-06-30 19:20:53 -03001369 return;
1370
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301371 hci_dev_lock(hdev);
1372
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001373 if (sent->le) {
1374 hdev->features[1][0] |= LMP_HOST_LE;
Marcel Holtmanna1536da2015-03-13 02:11:01 -07001375 hci_dev_set_flag(hdev, HCI_LE_ENABLED);
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001376 } else {
1377 hdev->features[1][0] &= ~LMP_HOST_LE;
Marcel Holtmanna358dc12015-03-13 02:11:02 -07001378 hci_dev_clear_flag(hdev, HCI_LE_ENABLED);
1379 hci_dev_clear_flag(hdev, HCI_ADVERTISING);
Johan Hedberg8f984df2012-02-28 01:07:22 +02001380 }
Marcel Holtmann45296ac2014-07-05 10:48:01 +02001381
1382 if (sent->simul)
1383 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
1384 else
1385 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
Jaganath Kanakkassery5c1a4c82014-12-11 18:58:15 +05301386
1387 hci_dev_unlock(hdev);
Andre Guedesf9b49302011-06-30 19:20:53 -03001388}
1389
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02001390static void hci_cc_set_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
1391{
1392 struct hci_cp_le_set_adv_param *cp;
1393 u8 status = *((u8 *) skb->data);
1394
1395 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1396
1397 if (status)
1398 return;
1399
1400 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_PARAM);
1401 if (!cp)
1402 return;
1403
1404 hci_dev_lock(hdev);
1405 hdev->adv_addr_type = cp->own_address_type;
1406 hci_dev_unlock(hdev);
1407}
1408
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001409static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1410 struct sk_buff *skb)
1411{
1412 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1413
1414 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1415 hdev->name, rp->status, rp->phy_handle);
1416
1417 if (rp->status)
1418 return;
1419
1420 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1421}
1422
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02001423static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
1424{
1425 struct hci_rp_read_rssi *rp = (void *) skb->data;
1426 struct hci_conn *conn;
1427
1428 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1429
1430 if (rp->status)
1431 return;
1432
1433 hci_dev_lock(hdev);
1434
1435 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
1436 if (conn)
1437 conn->rssi = rp->rssi;
1438
1439 hci_dev_unlock(hdev);
1440}
1441
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001442static void hci_cc_read_tx_power(struct hci_dev *hdev, struct sk_buff *skb)
1443{
1444 struct hci_cp_read_tx_power *sent;
1445 struct hci_rp_read_tx_power *rp = (void *) skb->data;
1446 struct hci_conn *conn;
1447
1448 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1449
1450 if (rp->status)
1451 return;
1452
1453 sent = hci_sent_cmd_data(hdev, HCI_OP_READ_TX_POWER);
1454 if (!sent)
1455 return;
1456
1457 hci_dev_lock(hdev);
1458
1459 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001460 if (!conn)
1461 goto unlock;
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001462
Andrzej Kaczmarekd0455ed2014-05-14 13:43:05 +02001463 switch (sent->type) {
1464 case 0x00:
1465 conn->tx_power = rp->tx_power;
1466 break;
1467 case 0x01:
1468 conn->max_tx_power = rp->tx_power;
1469 break;
1470 }
1471
1472unlock:
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02001473 hci_dev_unlock(hdev);
1474}
1475
Marcel Holtmannc50b33c2015-01-31 15:07:52 -08001476static void hci_cc_write_ssp_debug_mode(struct hci_dev *hdev, struct sk_buff *skb)
1477{
1478 u8 status = *((u8 *) skb->data);
1479 u8 *mode;
1480
1481 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1482
1483 if (status)
1484 return;
1485
1486 mode = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_DEBUG_MODE);
1487 if (mode)
1488 hdev->ssp_debug_mode = *mode;
1489}
1490
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001491static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001492{
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001493 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001494
1495 if (status) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001496 hci_conn_check_pending(hdev);
Johan Hedberg314b2382011-04-27 10:29:57 -04001497 return;
1498 }
1499
Andre Guedes89352e72011-11-04 14:16:53 -03001500 set_bit(HCI_INQUIRY, &hdev->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001501}
1502
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001503static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001504{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001505 struct hci_cp_create_conn *cp;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001506 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001507
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001508 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001509
1510 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001511 if (!cp)
1512 return;
1513
1514 hci_dev_lock(hdev);
1515
1516 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1517
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03001518 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001519
1520 if (status) {
1521 if (conn && conn->state == BT_CONNECT) {
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001522 if (status != 0x0c || conn->attempt > 2) {
1523 conn->state = BT_CLOSED;
Johan Hedberg539c4962015-02-18 14:53:57 +02001524 hci_connect_cfm(conn, status);
Marcel Holtmann4c67bc72006-10-15 17:30:56 +02001525 hci_conn_del(conn);
1526 } else
1527 conn->state = BT_CONNECT2;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 }
1529 } else {
1530 if (!conn) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03001531 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr,
1532 HCI_ROLE_MASTER);
1533 if (!conn)
Gustavo F. Padovan893ef972010-07-18 15:13:37 -03001534 BT_ERR("No memory for new connection");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001535 }
1536 }
1537
1538 hci_dev_unlock(hdev);
1539}
1540
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001541static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001543 struct hci_cp_add_sco *cp;
1544 struct hci_conn *acl, *sco;
1545 __u16 handle;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001546
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001547 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001548
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001549 if (!status)
1550 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001551
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001552 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1553 if (!cp)
1554 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001555
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001556 handle = __le16_to_cpu(cp->handle);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001557
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001558 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001559
1560 hci_dev_lock(hdev);
1561
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001562 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001563 if (acl) {
1564 sco = acl->link;
1565 if (sco) {
1566 sco->state = BT_CLOSED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001567
Johan Hedberg539c4962015-02-18 14:53:57 +02001568 hci_connect_cfm(sco, status);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001569 hci_conn_del(sco);
1570 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001571 }
Marcel Holtmann6bd57412006-11-18 22:14:22 +01001572
1573 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001574}
1575
Marcel Holtmannf8558552008-07-14 20:13:49 +02001576static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1577{
1578 struct hci_cp_auth_requested *cp;
1579 struct hci_conn *conn;
1580
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001581 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001582
1583 if (!status)
1584 return;
1585
1586 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1587 if (!cp)
1588 return;
1589
1590 hci_dev_lock(hdev);
1591
1592 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1593 if (conn) {
1594 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001595 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001596 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001597 }
1598 }
1599
1600 hci_dev_unlock(hdev);
1601}
1602
1603static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1604{
1605 struct hci_cp_set_conn_encrypt *cp;
1606 struct hci_conn *conn;
1607
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001608 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001609
1610 if (!status)
1611 return;
1612
1613 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1614 if (!cp)
1615 return;
1616
1617 hci_dev_lock(hdev);
1618
1619 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1620 if (conn) {
1621 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001622 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001623 hci_conn_drop(conn);
Marcel Holtmannf8558552008-07-14 20:13:49 +02001624 }
1625 }
1626
1627 hci_dev_unlock(hdev);
1628}
1629
Johan Hedberg127178d2010-11-18 22:22:29 +02001630static int hci_outgoing_auth_needed(struct hci_dev *hdev,
Gustavo Padovan807deac2012-05-17 00:36:24 -03001631 struct hci_conn *conn)
Johan Hedberg392599b2010-11-18 22:22:28 +02001632{
Johan Hedberg392599b2010-11-18 22:22:28 +02001633 if (conn->state != BT_CONFIG || !conn->out)
1634 return 0;
1635
Johan Hedberg765c2a92011-01-19 12:06:52 +05301636 if (conn->pending_sec_level == BT_SECURITY_SDP)
Johan Hedberg392599b2010-11-18 22:22:28 +02001637 return 0;
1638
1639 /* Only request authentication for SSP connections or non-SSP
Johan Hedberg264b8b42014-01-08 16:40:39 +02001640 * devices with sec_level MEDIUM or HIGH or if MITM protection
1641 * is requested.
1642 */
Gustavo Padovan807deac2012-05-17 00:36:24 -03001643 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
Johan Hedberg7e3691e2014-05-30 14:45:19 +03001644 conn->pending_sec_level != BT_SECURITY_FIPS &&
Johan Hedberg264b8b42014-01-08 16:40:39 +02001645 conn->pending_sec_level != BT_SECURITY_HIGH &&
1646 conn->pending_sec_level != BT_SECURITY_MEDIUM)
Johan Hedberg392599b2010-11-18 22:22:28 +02001647 return 0;
1648
Johan Hedberg392599b2010-11-18 22:22:28 +02001649 return 1;
1650}
1651
Gustavo Padovan6039aa72012-05-23 04:04:18 -03001652static int hci_resolve_name(struct hci_dev *hdev,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001653 struct inquiry_entry *e)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001654{
1655 struct hci_cp_remote_name_req cp;
1656
1657 memset(&cp, 0, sizeof(cp));
1658
1659 bacpy(&cp.bdaddr, &e->data.bdaddr);
1660 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1661 cp.pscan_mode = e->data.pscan_mode;
1662 cp.clock_offset = e->data.clock_offset;
1663
1664 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1665}
1666
Johan Hedbergb644ba32012-01-17 21:48:47 +02001667static bool hci_resolve_next_name(struct hci_dev *hdev)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001668{
1669 struct discovery_state *discov = &hdev->discovery;
1670 struct inquiry_entry *e;
1671
Johan Hedbergb644ba32012-01-17 21:48:47 +02001672 if (list_empty(&discov->resolve))
1673 return false;
1674
1675 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
Ram Malovanyc8100892012-07-19 10:26:09 +03001676 if (!e)
1677 return false;
1678
Johan Hedbergb644ba32012-01-17 21:48:47 +02001679 if (hci_resolve_name(hdev, e) == 0) {
1680 e->name_state = NAME_PENDING;
1681 return true;
1682 }
1683
1684 return false;
1685}
1686
1687static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001688 bdaddr_t *bdaddr, u8 *name, u8 name_len)
Johan Hedbergb644ba32012-01-17 21:48:47 +02001689{
1690 struct discovery_state *discov = &hdev->discovery;
1691 struct inquiry_entry *e;
1692
Johan Hedberg60cb49d2014-11-11 11:33:24 +02001693 /* Update the mgmt connected state if necessary. Be careful with
1694 * conn objects that exist but are not (yet) connected however.
1695 * Only those in BT_CONFIG or BT_CONNECTED states can be
1696 * considered connected.
1697 */
1698 if (conn &&
1699 (conn->state == BT_CONFIG || conn->state == BT_CONNECTED) &&
Jaganath Kanakkasserycb77c3e2014-11-07 16:39:09 +05301700 !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00001701 mgmt_device_connected(hdev, conn, 0, name, name_len);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001702
1703 if (discov->state == DISCOVERY_STOPPED)
1704 return;
1705
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001706 if (discov->state == DISCOVERY_STOPPING)
1707 goto discov_complete;
1708
1709 if (discov->state != DISCOVERY_RESOLVING)
1710 return;
1711
1712 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
Ram Malovany7cc83802012-07-19 10:26:10 +03001713 /* If the device was not found in a list of found devices names of which
1714 * are pending. there is no need to continue resolving a next name as it
1715 * will be done upon receiving another Remote Name Request Complete
1716 * Event */
1717 if (!e)
1718 return;
1719
1720 list_del(&e->list);
1721 if (name) {
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001722 e->name_state = NAME_KNOWN;
Ram Malovany7cc83802012-07-19 10:26:10 +03001723 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1724 e->data.rssi, name, name_len);
Ram Malovanyc3e7c0d2012-07-19 10:26:11 +03001725 } else {
1726 e->name_state = NAME_NOT_KNOWN;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001727 }
1728
Johan Hedbergb644ba32012-01-17 21:48:47 +02001729 if (hci_resolve_next_name(hdev))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001730 return;
Johan Hedberg30dc78e2012-01-04 15:44:20 +02001731
1732discov_complete:
1733 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1734}
1735
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001736static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1737{
Johan Hedberg127178d2010-11-18 22:22:29 +02001738 struct hci_cp_remote_name_req *cp;
1739 struct hci_conn *conn;
1740
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001741 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Johan Hedberg127178d2010-11-18 22:22:29 +02001742
1743 /* If successful wait for the name req complete event before
1744 * checking for the need to do authentication */
1745 if (!status)
1746 return;
1747
1748 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1749 if (!cp)
1750 return;
1751
1752 hci_dev_lock(hdev);
1753
1754 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02001755
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07001756 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedbergb644ba32012-01-17 21:48:47 +02001757 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1758
Johan Hedberg79c6c702011-04-28 11:28:55 -07001759 if (!conn)
1760 goto unlock;
1761
1762 if (!hci_outgoing_auth_needed(hdev, conn))
1763 goto unlock;
1764
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001765 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02001766 struct hci_cp_auth_requested auth_cp;
1767
Johan Hedberg977f8fc2014-07-17 15:35:39 +03001768 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
1769
Johannes Bergc1f23a22013-10-07 18:19:16 +02001770 auth_cp.handle = __cpu_to_le16(conn->handle);
1771 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1772 sizeof(auth_cp), &auth_cp);
Johan Hedberg127178d2010-11-18 22:22:29 +02001773 }
1774
Johan Hedberg79c6c702011-04-28 11:28:55 -07001775unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02001776 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001777}
1778
Marcel Holtmann769be972008-07-14 20:13:49 +02001779static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1780{
1781 struct hci_cp_read_remote_features *cp;
1782 struct hci_conn *conn;
1783
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001784 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001785
1786 if (!status)
1787 return;
1788
1789 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1790 if (!cp)
1791 return;
1792
1793 hci_dev_lock(hdev);
1794
1795 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1796 if (conn) {
1797 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001798 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001799 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001800 }
1801 }
1802
1803 hci_dev_unlock(hdev);
1804}
1805
1806static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1807{
1808 struct hci_cp_read_remote_ext_features *cp;
1809 struct hci_conn *conn;
1810
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001811 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmann769be972008-07-14 20:13:49 +02001812
1813 if (!status)
1814 return;
1815
1816 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1817 if (!cp)
1818 return;
1819
1820 hci_dev_lock(hdev);
1821
1822 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1823 if (conn) {
1824 if (conn->state == BT_CONFIG) {
Johan Hedberg539c4962015-02-18 14:53:57 +02001825 hci_connect_cfm(conn, status);
David Herrmann76a68ba2013-04-06 20:28:37 +02001826 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02001827 }
1828 }
1829
1830 hci_dev_unlock(hdev);
1831}
1832
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001833static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1834{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001835 struct hci_cp_setup_sync_conn *cp;
1836 struct hci_conn *acl, *sco;
1837 __u16 handle;
1838
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001839 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001840
1841 if (!status)
1842 return;
1843
1844 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1845 if (!cp)
1846 return;
1847
1848 handle = __le16_to_cpu(cp->handle);
1849
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001850 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001851
1852 hci_dev_lock(hdev);
1853
1854 acl = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001855 if (acl) {
1856 sco = acl->link;
1857 if (sco) {
1858 sco->state = BT_CLOSED;
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001859
Johan Hedberg539c4962015-02-18 14:53:57 +02001860 hci_connect_cfm(sco, status);
Andrei Emeltchenko5a08ecc2011-01-11 17:20:20 +02001861 hci_conn_del(sco);
1862 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02001863 }
1864
1865 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001866}
1867
1868static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1869{
1870 struct hci_cp_sniff_mode *cp;
1871 struct hci_conn *conn;
1872
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001873 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001874
1875 if (!status)
1876 return;
1877
1878 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1879 if (!cp)
1880 return;
1881
1882 hci_dev_lock(hdev);
1883
1884 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001885 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001886 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001887
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001888 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001889 hci_sco_setup(conn, status);
1890 }
1891
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001892 hci_dev_unlock(hdev);
1893}
1894
1895static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1896{
1897 struct hci_cp_exit_sniff_mode *cp;
1898 struct hci_conn *conn;
1899
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03001900 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001901
1902 if (!status)
1903 return;
1904
1905 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1906 if (!cp)
1907 return;
1908
1909 hci_dev_lock(hdev);
1910
1911 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001912 if (conn) {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001913 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001914
Johan Hedberg51a8efd2012-01-16 06:10:31 +02001915 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04001916 hci_sco_setup(conn, status);
1917 }
1918
Marcel Holtmanna9de9242007-10-20 13:33:56 +02001919 hci_dev_unlock(hdev);
1920}
1921
Johan Hedberg88c3df12012-02-09 14:27:38 +02001922static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1923{
1924 struct hci_cp_disconnect *cp;
1925 struct hci_conn *conn;
1926
1927 if (!status)
1928 return;
1929
1930 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1931 if (!cp)
1932 return;
1933
1934 hci_dev_lock(hdev);
1935
1936 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1937 if (conn)
1938 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03001939 conn->dst_type, status);
Johan Hedberg88c3df12012-02-09 14:27:38 +02001940
1941 hci_dev_unlock(hdev);
1942}
1943
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001944static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1945{
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001946 struct hci_cp_create_phy_link *cp;
1947
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001948 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001949
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03001950 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1951 if (!cp)
1952 return;
1953
Andrei Emeltchenkoe58917b2012-10-31 15:46:33 +02001954 hci_dev_lock(hdev);
1955
1956 if (status) {
1957 struct hci_conn *hcon;
1958
1959 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1960 if (hcon)
1961 hci_conn_del(hcon);
1962 } else {
1963 amp_write_remote_assoc(hdev, cp->phy_handle);
1964 }
1965
1966 hci_dev_unlock(hdev);
Andrei Emeltchenkoa02226d2012-09-27 17:26:19 +03001967}
1968
Andrei Emeltchenko0b26ab92012-09-27 17:26:24 +03001969static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1970{
1971 struct hci_cp_accept_phy_link *cp;
1972
1973 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1974
1975 if (status)
1976 return;
1977
1978 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1979 if (!cp)
1980 return;
1981
1982 amp_write_remote_assoc(hdev, cp->phy_handle);
1983}
1984
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02001985static void hci_cs_le_create_conn(struct hci_dev *hdev, u8 status)
1986{
1987 struct hci_cp_le_create_conn *cp;
1988 struct hci_conn *conn;
1989
1990 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1991
1992 /* All connection failure handling is taken care of by the
1993 * hci_le_conn_failed function which is triggered by the HCI
1994 * request completion callbacks used for connecting.
1995 */
1996 if (status)
1997 return;
1998
1999 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
2000 if (!cp)
2001 return;
2002
2003 hci_dev_lock(hdev);
2004
2005 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
2006 if (!conn)
2007 goto unlock;
2008
2009 /* Store the initiator and responder address information which
2010 * is needed for SMP. These values will not change during the
2011 * lifetime of the connection.
2012 */
2013 conn->init_addr_type = cp->own_address_type;
2014 if (cp->own_address_type == ADDR_LE_DEV_RANDOM)
2015 bacpy(&conn->init_addr, &hdev->random_addr);
2016 else
2017 bacpy(&conn->init_addr, &hdev->bdaddr);
2018
2019 conn->resp_addr_type = cp->peer_addr_type;
2020 bacpy(&conn->resp_addr, &cp->peer_addr);
2021
Johan Hedberg9489eca2014-02-28 17:45:46 +02002022 /* We don't want the connection attempt to stick around
2023 * indefinitely since LE doesn't have a page timeout concept
2024 * like BR/EDR. Set a timer for any connection that doesn't use
2025 * the white list for connecting.
2026 */
2027 if (cp->filter_policy == HCI_LE_USE_PEER_ADDR)
2028 queue_delayed_work(conn->hdev->workqueue,
2029 &conn->le_conn_timeout,
Johan Hedberg09ae2602014-07-06 13:41:15 +03002030 conn->conn_timeout);
Johan Hedberg9489eca2014-02-28 17:45:46 +02002031
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02002032unlock:
2033 hci_dev_unlock(hdev);
2034}
2035
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07002036static void hci_cs_le_read_remote_features(struct hci_dev *hdev, u8 status)
2037{
2038 struct hci_cp_le_read_remote_features *cp;
2039 struct hci_conn *conn;
2040
2041 BT_DBG("%s status 0x%2.2x", hdev->name, status);
2042
2043 if (!status)
2044 return;
2045
2046 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_READ_REMOTE_FEATURES);
2047 if (!cp)
2048 return;
2049
2050 hci_dev_lock(hdev);
2051
2052 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2053 if (conn) {
2054 if (conn->state == BT_CONFIG) {
2055 hci_connect_cfm(conn, status);
2056 hci_conn_drop(conn);
2057 }
2058 }
2059
2060 hci_dev_unlock(hdev);
2061}
2062
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02002063static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
2064{
2065 struct hci_cp_le_start_enc *cp;
2066 struct hci_conn *conn;
2067
2068 BT_DBG("%s status 0x%2.2x", hdev->name, status);
2069
2070 if (!status)
2071 return;
2072
2073 hci_dev_lock(hdev);
2074
2075 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_START_ENC);
2076 if (!cp)
2077 goto unlock;
2078
2079 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2080 if (!conn)
2081 goto unlock;
2082
2083 if (conn->state != BT_CONNECTED)
2084 goto unlock;
2085
2086 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
2087 hci_conn_drop(conn);
2088
2089unlock:
2090 hci_dev_unlock(hdev);
2091}
2092
Kuba Pawlak50fc85f2014-11-06 19:36:52 +01002093static void hci_cs_switch_role(struct hci_dev *hdev, u8 status)
2094{
2095 struct hci_cp_switch_role *cp;
2096 struct hci_conn *conn;
2097
2098 BT_DBG("%s status 0x%2.2x", hdev->name, status);
2099
2100 if (!status)
2101 return;
2102
2103 cp = hci_sent_cmd_data(hdev, HCI_OP_SWITCH_ROLE);
2104 if (!cp)
2105 return;
2106
2107 hci_dev_lock(hdev);
2108
2109 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
2110 if (conn)
2111 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
2112
2113 hci_dev_unlock(hdev);
2114}
2115
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002116static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002117{
2118 __u8 status = *((__u8 *) skb->data);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002119 struct discovery_state *discov = &hdev->discovery;
2120 struct inquiry_entry *e;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002121
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002122 BT_DBG("%s status 0x%2.2x", hdev->name, status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002123
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002124 hci_conn_check_pending(hdev);
Andre Guedes89352e72011-11-04 14:16:53 -03002125
2126 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
2127 return;
2128
Peter Zijlstra4e857c52014-03-17 18:06:10 +01002129 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
Andre Guedes3e13fa12013-03-27 20:04:56 -03002130 wake_up_bit(&hdev->flags, HCI_INQUIRY);
2131
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002132 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002133 return;
2134
Johan Hedberg56e5cb82011-11-08 20:40:16 +02002135 hci_dev_lock(hdev);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002136
Andre Guedes343f9352012-02-17 20:39:37 -03002137 if (discov->state != DISCOVERY_FINDING)
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002138 goto unlock;
2139
2140 if (list_empty(&discov->resolve)) {
Jakub Pawlowski07d23342015-03-17 09:04:14 -07002141 /* When BR/EDR inquiry is active and no LE scanning is in
2142 * progress, then change discovery state to indicate completion.
2143 *
2144 * When running LE scanning and BR/EDR inquiry simultaneously
2145 * and the LE scan already finished, then change the discovery
2146 * state to indicate completion.
2147 */
2148 if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
2149 !test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks))
2150 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002151 goto unlock;
2152 }
2153
2154 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
2155 if (e && hci_resolve_name(hdev, e) == 0) {
2156 e->name_state = NAME_PENDING;
2157 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
2158 } else {
Jakub Pawlowski07d23342015-03-17 09:04:14 -07002159 /* When BR/EDR inquiry is active and no LE scanning is in
2160 * progress, then change discovery state to indicate completion.
2161 *
2162 * When running LE scanning and BR/EDR inquiry simultaneously
2163 * and the LE scan already finished, then change the discovery
2164 * state to indicate completion.
2165 */
2166 if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
2167 !test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks))
2168 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
Johan Hedberg30dc78e2012-01-04 15:44:20 +02002169 }
2170
2171unlock:
Johan Hedberg56e5cb82011-11-08 20:40:16 +02002172 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002173}
2174
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002175static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002176{
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002177 struct inquiry_data data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002178 struct inquiry_info *info = (void *) (skb->data + 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002179 int num_rsp = *((__u8 *) skb->data);
2180
2181 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2182
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002183 if (!num_rsp)
2184 return;
2185
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002186 if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
Andre Guedes1519cc12012-03-21 00:03:38 -03002187 return;
2188
Linus Torvalds1da177e2005-04-16 15:20:36 -07002189 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002190
Johan Hedberge17acd42011-03-30 23:57:16 +03002191 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02002192 u32 flags;
Johan Hedberg31754052012-01-04 13:39:52 +02002193
Linus Torvalds1da177e2005-04-16 15:20:36 -07002194 bacpy(&data.bdaddr, &info->bdaddr);
2195 data.pscan_rep_mode = info->pscan_rep_mode;
2196 data.pscan_period_mode = info->pscan_period_mode;
2197 data.pscan_mode = info->pscan_mode;
2198 memcpy(data.dev_class, info->dev_class, 3);
2199 data.clock_offset = info->clock_offset;
Marcel Holtmannefb25132014-12-05 13:03:34 +01002200 data.rssi = HCI_RSSI_INVALID;
Marcel Holtmann41a96212008-07-14 20:13:48 +02002201 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02002202
Marcel Holtmannaf589252014-07-01 14:11:20 +02002203 flags = hci_inquiry_cache_update(hdev, &data, false);
2204
Johan Hedberg48264f02011-11-09 13:58:58 +02002205 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Marcel Holtmannefb25132014-12-05 13:03:34 +01002206 info->dev_class, HCI_RSSI_INVALID,
2207 flags, NULL, 0, NULL, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002208 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002209
Linus Torvalds1da177e2005-04-16 15:20:36 -07002210 hci_dev_unlock(hdev);
2211}
2212
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002213static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002214{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002215 struct hci_ev_conn_complete *ev = (void *) skb->data;
2216 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002217
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002218 BT_DBG("%s", hdev->name);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002219
Linus Torvalds1da177e2005-04-16 15:20:36 -07002220 hci_dev_lock(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002221
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002222 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann94992372009-04-19 19:30:03 +02002223 if (!conn) {
2224 if (ev->link_type != SCO_LINK)
2225 goto unlock;
2226
2227 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2228 if (!conn)
2229 goto unlock;
2230
2231 conn->type = SCO_LINK;
2232 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002233
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002234 if (!ev->status) {
2235 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann769be972008-07-14 20:13:49 +02002236
2237 if (conn->type == ACL_LINK) {
2238 conn->state = BT_CONFIG;
2239 hci_conn_hold(conn);
Szymon Janca9ea3ed2012-07-19 14:46:08 +02002240
2241 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
2242 !hci_find_link_key(hdev, &ev->bdaddr))
2243 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2244 else
2245 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
Marcel Holtmann769be972008-07-14 20:13:49 +02002246 } else
2247 conn->state = BT_CONNECTED;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002248
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01002249 hci_debugfs_create_conn(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002250 hci_conn_add_sysfs(conn);
2251
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002252 if (test_bit(HCI_AUTH, &hdev->flags))
Johan Hedberg4dae2792014-06-24 17:03:50 +03002253 set_bit(HCI_CONN_AUTH, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002254
2255 if (test_bit(HCI_ENCRYPT, &hdev->flags))
Johan Hedberg4dae2792014-06-24 17:03:50 +03002256 set_bit(HCI_CONN_ENCRYPT, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002257
2258 /* Get remote features */
2259 if (conn->type == ACL_LINK) {
2260 struct hci_cp_read_remote_features cp;
2261 cp.handle = ev->handle;
Marcel Holtmann769be972008-07-14 20:13:49 +02002262 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002263 sizeof(cp), &cp);
Johan Hedberg22f433d2014-08-01 11:13:32 +03002264
Johan Hedberg1d2dc5b2014-12-19 13:40:19 +02002265 hci_update_page_scan(hdev);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002266 }
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002267
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002268 /* Set packet type for incoming connection */
Andrei Emeltchenkod095c1e2011-12-01 14:33:27 +02002269 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002270 struct hci_cp_change_conn_ptype cp;
2271 cp.handle = ev->handle;
Marcel Holtmanna8746412008-07-14 20:13:46 +02002272 cp.pkt_type = cpu_to_le16(conn->pkt_type);
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002273 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
2274 &cp);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002275 }
Johan Hedberg17d5c042011-01-22 06:09:08 +02002276 } else {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002277 conn->state = BT_CLOSED;
Johan Hedberg17d5c042011-01-22 06:09:08 +02002278 if (conn->type == ACL_LINK)
Marcel Holtmann64c7b772014-02-18 14:22:20 -08002279 mgmt_connect_failed(hdev, &conn->dst, conn->type,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002280 conn->dst_type, ev->status);
Johan Hedberg17d5c042011-01-22 06:09:08 +02002281 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002282
Marcel Holtmanne73439d2010-07-26 10:06:00 -04002283 if (conn->type == ACL_LINK)
2284 hci_sco_setup(conn, ev->status);
Marcel Holtmann45bb4bf2005-08-09 20:27:49 -07002285
Marcel Holtmann769be972008-07-14 20:13:49 +02002286 if (ev->status) {
Johan Hedberg539c4962015-02-18 14:53:57 +02002287 hci_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002288 hci_conn_del(conn);
Marcel Holtmannc89b6e62009-01-15 21:57:03 +01002289 } else if (ev->link_type != ACL_LINK)
Johan Hedberg539c4962015-02-18 14:53:57 +02002290 hci_connect_cfm(conn, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002291
2292unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002293 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002294
2295 hci_conn_check_pending(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002296}
2297
Johan Hedberg70c46422014-07-09 12:59:17 +03002298static void hci_reject_conn(struct hci_dev *hdev, bdaddr_t *bdaddr)
2299{
2300 struct hci_cp_reject_conn_req cp;
2301
2302 bacpy(&cp.bdaddr, bdaddr);
2303 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
2304 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
2305}
2306
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002307static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002308{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002309 struct hci_ev_conn_request *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002310 int mask = hdev->link_mode;
Johan Hedberg70c46422014-07-09 12:59:17 +03002311 struct inquiry_entry *ie;
2312 struct hci_conn *conn;
Frédéric Dalleau20714bfe2012-11-21 10:51:12 +01002313 __u8 flags = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002314
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03002315 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002316 ev->link_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002317
Frédéric Dalleau20714bfe2012-11-21 10:51:12 +01002318 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
2319 &flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002320
Johan Hedberg70c46422014-07-09 12:59:17 +03002321 if (!(mask & HCI_LM_ACCEPT)) {
2322 hci_reject_conn(hdev, &ev->bdaddr);
2323 return;
2324 }
2325
Johan Hedberg46c4c942014-07-16 16:19:21 +03002326 if (hci_bdaddr_list_lookup(&hdev->blacklist, &ev->bdaddr,
2327 BDADDR_BREDR)) {
2328 hci_reject_conn(hdev, &ev->bdaddr);
2329 return;
2330 }
2331
Johan Hedberg6a8fc952014-12-24 20:43:11 +02002332 /* Require HCI_CONNECTABLE or a whitelist entry to accept the
2333 * connection. These features are only touched through mgmt so
2334 * only do the checks if HCI_MGMT is set.
2335 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002336 if (hci_dev_test_flag(hdev, HCI_MGMT) &&
2337 !hci_dev_test_flag(hdev, HCI_CONNECTABLE) &&
Johan Hedberg46c4c942014-07-16 16:19:21 +03002338 !hci_bdaddr_list_lookup(&hdev->whitelist, &ev->bdaddr,
2339 BDADDR_BREDR)) {
2340 hci_reject_conn(hdev, &ev->bdaddr);
2341 return;
Johan Hedberg70c46422014-07-09 12:59:17 +03002342 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002343
Johan Hedberg70c46422014-07-09 12:59:17 +03002344 /* Connection accepted */
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002345
Johan Hedberg70c46422014-07-09 12:59:17 +03002346 hci_dev_lock(hdev);
Marcel Holtmannc7bdd502008-07-14 20:13:47 +02002347
Johan Hedberg70c46422014-07-09 12:59:17 +03002348 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2349 if (ie)
2350 memcpy(ie->data.dev_class, ev->dev_class, 3);
2351
2352 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
2353 &ev->bdaddr);
2354 if (!conn) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03002355 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr,
2356 HCI_ROLE_SLAVE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002357 if (!conn) {
Johan Hedberg70c46422014-07-09 12:59:17 +03002358 BT_ERR("No memory for new connection");
2359 hci_dev_unlock(hdev);
2360 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002361 }
Johan Hedberg70c46422014-07-09 12:59:17 +03002362 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002363
Johan Hedberg70c46422014-07-09 12:59:17 +03002364 memcpy(conn->dev_class, ev->dev_class, 3);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02002365
Johan Hedberg70c46422014-07-09 12:59:17 +03002366 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002367
Johan Hedberg70c46422014-07-09 12:59:17 +03002368 if (ev->link_type == ACL_LINK ||
2369 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
2370 struct hci_cp_accept_conn_req cp;
2371 conn->state = BT_CONNECT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002372
2373 bacpy(&cp.bdaddr, &ev->bdaddr);
Johan Hedberg70c46422014-07-09 12:59:17 +03002374
2375 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
2376 cp.role = 0x00; /* Become master */
2377 else
2378 cp.role = 0x01; /* Remain slave */
2379
2380 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp), &cp);
2381 } else if (!(flags & HCI_PROTO_DEFER)) {
2382 struct hci_cp_accept_sync_conn_req cp;
2383 conn->state = BT_CONNECT;
2384
2385 bacpy(&cp.bdaddr, &ev->bdaddr);
2386 cp.pkt_type = cpu_to_le16(conn->pkt_type);
2387
2388 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
2389 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
2390 cp.max_latency = cpu_to_le16(0xffff);
2391 cp.content_format = cpu_to_le16(hdev->voice_setting);
2392 cp.retrans_effort = 0xff;
2393
2394 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ, sizeof(cp),
2395 &cp);
2396 } else {
2397 conn->state = BT_CONNECT2;
Johan Hedberg539c4962015-02-18 14:53:57 +02002398 hci_connect_cfm(conn, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002399 }
2400}
2401
Mikel Astizf0d6a0e2012-08-09 09:52:30 +02002402static u8 hci_to_mgmt_reason(u8 err)
2403{
2404 switch (err) {
2405 case HCI_ERROR_CONNECTION_TIMEOUT:
2406 return MGMT_DEV_DISCONN_TIMEOUT;
2407 case HCI_ERROR_REMOTE_USER_TERM:
2408 case HCI_ERROR_REMOTE_LOW_RESOURCES:
2409 case HCI_ERROR_REMOTE_POWER_OFF:
2410 return MGMT_DEV_DISCONN_REMOTE;
2411 case HCI_ERROR_LOCAL_HOST_TERM:
2412 return MGMT_DEV_DISCONN_LOCAL_HOST;
2413 default:
2414 return MGMT_DEV_DISCONN_UNKNOWN;
2415 }
2416}
2417
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002418static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002419{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002420 struct hci_ev_disconn_complete *ev = (void *) skb->data;
Andre Guedesabf54a52013-11-07 17:36:09 -03002421 u8 reason = hci_to_mgmt_reason(ev->reason);
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002422 struct hci_conn_params *params;
Marcel Holtmann04837f62006-07-03 10:02:33 +02002423 struct hci_conn *conn;
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002424 bool mgmt_connected;
Andre Guedes38462202013-11-07 17:36:10 -03002425 u8 type;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002426
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002427 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002428
Linus Torvalds1da177e2005-04-16 15:20:36 -07002429 hci_dev_lock(hdev);
2430
Marcel Holtmann04837f62006-07-03 10:02:33 +02002431 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergf7520542011-01-20 12:34:39 +02002432 if (!conn)
2433 goto unlock;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02002434
Andre Guedesabf54a52013-11-07 17:36:09 -03002435 if (ev->status) {
2436 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2437 conn->dst_type, ev->status);
2438 goto unlock;
Johan Hedberg37d9ef72011-11-10 15:54:39 +02002439 }
Johan Hedbergf7520542011-01-20 12:34:39 +02002440
Andre Guedes38462202013-11-07 17:36:10 -03002441 conn->state = BT_CLOSED;
2442
Johan Hedberg12d4a3b2014-02-24 14:52:18 +02002443 mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2444 mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
2445 reason, mgmt_connected);
Andre Guedesabf54a52013-11-07 17:36:09 -03002446
Johan Hedberg22f433d2014-08-01 11:13:32 +03002447 if (conn->type == ACL_LINK) {
2448 if (test_bit(HCI_CONN_FLUSH_KEY, &conn->flags))
2449 hci_remove_link_key(hdev, &conn->dst);
2450
Johan Hedberg1d2dc5b2014-12-19 13:40:19 +02002451 hci_update_page_scan(hdev);
Johan Hedberg22f433d2014-08-01 11:13:32 +03002452 }
Johan Hedberg22102462013-10-05 12:01:06 +02002453
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002454 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
2455 if (params) {
2456 switch (params->auto_connect) {
2457 case HCI_AUTO_CONN_LINK_LOSS:
2458 if (ev->reason != HCI_ERROR_CONNECTION_TIMEOUT)
2459 break;
2460 /* Fall through */
2461
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02002462 case HCI_AUTO_CONN_DIRECT:
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002463 case HCI_AUTO_CONN_ALWAYS:
Johan Hedberg418025d2014-07-04 12:37:24 +03002464 list_del_init(&params->action);
2465 list_add(&params->action, &hdev->pend_le_conns);
2466 hci_update_background_scan(hdev);
Andre Guedes9fcb18e2014-02-26 20:21:48 -03002467 break;
2468
2469 default:
2470 break;
2471 }
2472 }
2473
Andre Guedes38462202013-11-07 17:36:10 -03002474 type = conn->type;
Johan Hedberg22102462013-10-05 12:01:06 +02002475
Johan Hedberg3a6d5762015-02-18 14:53:58 +02002476 hci_disconn_cfm(conn, ev->reason);
Andre Guedes38462202013-11-07 17:36:10 -03002477 hci_conn_del(conn);
2478
2479 /* Re-enable advertising if necessary, since it might
2480 * have been disabled by the connection. From the
2481 * HCI_LE_Set_Advertise_Enable command description in
2482 * the core specification (v4.0):
2483 * "The Controller shall continue advertising until the Host
2484 * issues an LE_Set_Advertise_Enable command with
2485 * Advertising_Enable set to 0x00 (Advertising is disabled)
2486 * or until a connection is created or until the Advertising
2487 * is timed out due to Directed Advertising."
2488 */
2489 if (type == LE_LINK)
2490 mgmt_reenable_advertising(hdev);
Johan Hedbergf7520542011-01-20 12:34:39 +02002491
2492unlock:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002493 hci_dev_unlock(hdev);
2494}
2495
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002496static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002497{
2498 struct hci_ev_auth_complete *ev = (void *) skb->data;
2499 struct hci_conn *conn;
2500
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002501 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002502
2503 hci_dev_lock(hdev);
2504
2505 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002506 if (!conn)
2507 goto unlock;
2508
2509 if (!ev->status) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002510 if (!hci_conn_ssp_enabled(conn) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03002511 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002512 BT_INFO("re-auth of legacy device is not possible.");
Johan Hedberg2a611692011-02-19 12:06:00 -03002513 } else {
Johan Hedberg4dae2792014-06-24 17:03:50 +03002514 set_bit(HCI_CONN_AUTH, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002515 conn->sec_level = conn->pending_sec_level;
Johan Hedberg2a611692011-02-19 12:06:00 -03002516 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002517 } else {
Johan Hedberge1e930f2014-09-08 17:09:49 -07002518 mgmt_auth_failed(conn, ev->status);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002519 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002520
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002521 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2522 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002523
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002524 if (conn->state == BT_CONFIG) {
Johan Hedbergaa64a8b2012-01-18 21:33:12 +02002525 if (!ev->status && hci_conn_ssp_enabled(conn)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002526 struct hci_cp_set_conn_encrypt cp;
2527 cp.handle = ev->handle;
2528 cp.encrypt = 0x01;
2529 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002530 &cp);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002531 } else {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002532 conn->state = BT_CONNECTED;
Johan Hedberg539c4962015-02-18 14:53:57 +02002533 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002534 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002535 }
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002536 } else {
2537 hci_auth_cfm(conn, ev->status);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02002538
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002539 hci_conn_hold(conn);
2540 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02002541 hci_conn_drop(conn);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002542 }
2543
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002544 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002545 if (!ev->status) {
2546 struct hci_cp_set_conn_encrypt cp;
2547 cp.handle = ev->handle;
2548 cp.encrypt = 0x01;
2549 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
Gustavo Padovan807deac2012-05-17 00:36:24 -03002550 &cp);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002551 } else {
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002552 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002553 hci_encrypt_cfm(conn, ev->status, 0x00);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002554 }
2555 }
2556
Waldemar Rymarkiewiczd7556e22011-05-31 15:49:26 +02002557unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002558 hci_dev_unlock(hdev);
2559}
2560
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002561static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002562{
Johan Hedberg127178d2010-11-18 22:22:29 +02002563 struct hci_ev_remote_name *ev = (void *) skb->data;
2564 struct hci_conn *conn;
2565
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002566 BT_DBG("%s", hdev->name);
2567
2568 hci_conn_check_pending(hdev);
Johan Hedberg127178d2010-11-18 22:22:29 +02002569
2570 hci_dev_lock(hdev);
2571
2572 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002573
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07002574 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedbergb644ba32012-01-17 21:48:47 +02002575 goto check_auth;
2576
2577 if (ev->status == 0)
2578 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03002579 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
Johan Hedbergb644ba32012-01-17 21:48:47 +02002580 else
2581 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2582
2583check_auth:
Johan Hedberg79c6c702011-04-28 11:28:55 -07002584 if (!conn)
2585 goto unlock;
2586
2587 if (!hci_outgoing_auth_needed(hdev, conn))
2588 goto unlock;
2589
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002590 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002591 struct hci_cp_auth_requested cp;
Johan Hedberg977f8fc2014-07-17 15:35:39 +03002592
2593 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
2594
Johan Hedberg127178d2010-11-18 22:22:29 +02002595 cp.handle = __cpu_to_le16(conn->handle);
2596 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2597 }
2598
Johan Hedberg79c6c702011-04-28 11:28:55 -07002599unlock:
Johan Hedberg127178d2010-11-18 22:22:29 +02002600 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002601}
2602
Johan Hedberg821f3762015-06-11 13:52:29 +03002603static void read_enc_key_size_complete(struct hci_dev *hdev, u8 status,
2604 u16 opcode, struct sk_buff *skb)
2605{
2606 const struct hci_rp_read_enc_key_size *rp;
2607 struct hci_conn *conn;
2608 u16 handle;
2609
2610 BT_DBG("%s status 0x%02x", hdev->name, status);
2611
2612 if (!skb || skb->len < sizeof(*rp)) {
2613 BT_ERR("%s invalid HCI Read Encryption Key Size response",
2614 hdev->name);
2615 return;
2616 }
2617
2618 rp = (void *)skb->data;
2619 handle = le16_to_cpu(rp->handle);
2620
2621 hci_dev_lock(hdev);
2622
2623 conn = hci_conn_hash_lookup_handle(hdev, handle);
2624 if (!conn)
2625 goto unlock;
2626
2627 /* If we fail to read the encryption key size, assume maximum
2628 * (which is the same we do also when this HCI command isn't
2629 * supported.
2630 */
2631 if (rp->status) {
2632 BT_ERR("%s failed to read key size for handle %u", hdev->name,
2633 handle);
2634 conn->enc_key_size = HCI_LINK_KEY_SIZE;
2635 } else {
2636 conn->enc_key_size = rp->key_size;
2637 }
2638
2639 if (conn->state == BT_CONFIG) {
2640 conn->state = BT_CONNECTED;
2641 hci_connect_cfm(conn, 0);
2642 hci_conn_drop(conn);
2643 } else {
2644 u8 encrypt;
2645
2646 if (!test_bit(HCI_CONN_ENCRYPT, &conn->flags))
2647 encrypt = 0x00;
Johan Hedberg5d667ef2015-06-12 13:04:47 +03002648 else if (test_bit(HCI_CONN_AES_CCM, &conn->flags))
Johan Hedberg821f3762015-06-11 13:52:29 +03002649 encrypt = 0x02;
2650 else
2651 encrypt = 0x01;
2652
2653 hci_encrypt_cfm(conn, 0, encrypt);
2654 }
2655
2656unlock:
2657 hci_dev_unlock(hdev);
2658}
2659
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002660static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002661{
2662 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2663 struct hci_conn *conn;
2664
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002665 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002666
2667 hci_dev_lock(hdev);
2668
2669 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002670 if (!conn)
2671 goto unlock;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002672
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002673 if (!ev->status) {
2674 if (ev->encrypt) {
2675 /* Encryption implies authentication */
Johan Hedberg4dae2792014-06-24 17:03:50 +03002676 set_bit(HCI_CONN_AUTH, &conn->flags);
2677 set_bit(HCI_CONN_ENCRYPT, &conn->flags);
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002678 conn->sec_level = conn->pending_sec_level;
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002679
Marcel Holtmann914a6ff2014-02-01 11:52:02 -08002680 /* P-256 authentication key implies FIPS */
2681 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
Johan Hedberg4dae2792014-06-24 17:03:50 +03002682 set_bit(HCI_CONN_FIPS, &conn->flags);
Marcel Holtmann914a6ff2014-02-01 11:52:02 -08002683
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002684 if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
2685 conn->type == LE_LINK)
2686 set_bit(HCI_CONN_AES_CCM, &conn->flags);
2687 } else {
Johan Hedberg4dae2792014-06-24 17:03:50 +03002688 clear_bit(HCI_CONN_ENCRYPT, &conn->flags);
Marcel Holtmannabf76ba2014-01-31 16:24:28 -08002689 clear_bit(HCI_CONN_AES_CCM, &conn->flags);
2690 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002691 }
2692
Johan Hedberg7ed3fa22014-09-10 22:16:35 -07002693 /* We should disregard the current RPA and generate a new one
2694 * whenever the encryption procedure fails.
2695 */
2696 if (ev->status && conn->type == LE_LINK)
Marcel Holtmanna1536da2015-03-13 02:11:01 -07002697 hci_dev_set_flag(hdev, HCI_RPA_EXPIRED);
Johan Hedberg7ed3fa22014-09-10 22:16:35 -07002698
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002699 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2700
2701 if (ev->status && conn->state == BT_CONNECTED) {
2702 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
2703 hci_conn_drop(conn);
2704 goto unlock;
2705 }
2706
Johan Hedberg035ad622015-06-11 13:52:28 +03002707 /* In Secure Connections Only mode, do not allow any connections
2708 * that are not encrypted with AES-CCM using a P-256 authenticated
2709 * combination key.
2710 */
2711 if (hci_dev_test_flag(hdev, HCI_SC_ONLY) &&
2712 (!test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
2713 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)) {
2714 hci_connect_cfm(conn, HCI_ERROR_AUTH_FAILURE);
2715 hci_conn_drop(conn);
2716 goto unlock;
2717 }
2718
Johan Hedberg821f3762015-06-11 13:52:29 +03002719 /* Try reading the encryption key size for encrypted ACL links */
2720 if (!ev->status && ev->encrypt && conn->type == ACL_LINK) {
2721 struct hci_cp_read_enc_key_size cp;
2722 struct hci_request req;
2723
2724 /* Only send HCI_Read_Encryption_Key_Size if the
2725 * controller really supports it. If it doesn't, assume
2726 * the default size (16).
2727 */
2728 if (!(hdev->commands[20] & 0x10)) {
2729 conn->enc_key_size = HCI_LINK_KEY_SIZE;
2730 goto notify;
2731 }
2732
2733 hci_req_init(&req, hdev);
2734
2735 cp.handle = cpu_to_le16(conn->handle);
2736 hci_req_add(&req, HCI_OP_READ_ENC_KEY_SIZE, sizeof(cp), &cp);
2737
2738 if (hci_req_run_skb(&req, read_enc_key_size_complete)) {
2739 BT_ERR("Sending HCI Read Encryption Key Size failed");
2740 conn->enc_key_size = HCI_LINK_KEY_SIZE;
2741 goto notify;
2742 }
2743
2744 goto unlock;
2745 }
2746
2747notify:
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002748 if (conn->state == BT_CONFIG) {
2749 if (!ev->status)
2750 conn->state = BT_CONNECTED;
2751
Johan Hedberg539c4962015-02-18 14:53:57 +02002752 hci_connect_cfm(conn, ev->status);
Marcel Holtmanndc8357c2014-01-31 16:24:27 -08002753 hci_conn_drop(conn);
2754 } else
2755 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
2756
Gustavo Padovana7d77232012-05-13 03:20:07 -03002757unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002758 hci_dev_unlock(hdev);
2759}
2760
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002761static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2762 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002763{
2764 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2765 struct hci_conn *conn;
2766
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002767 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002768
2769 hci_dev_lock(hdev);
2770
2771 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2772 if (conn) {
2773 if (!ev->status)
Johan Hedberg4dae2792014-06-24 17:03:50 +03002774 set_bit(HCI_CONN_SECURE, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002775
Johan Hedberg51a8efd2012-01-16 06:10:31 +02002776 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002777
2778 hci_key_change_cfm(conn, ev->status);
2779 }
2780
2781 hci_dev_unlock(hdev);
2782}
2783
Gustavo Padovan6039aa72012-05-23 04:04:18 -03002784static void hci_remote_features_evt(struct hci_dev *hdev,
2785 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002786{
2787 struct hci_ev_remote_features *ev = (void *) skb->data;
2788 struct hci_conn *conn;
2789
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03002790 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002791
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002792 hci_dev_lock(hdev);
2793
2794 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02002795 if (!conn)
2796 goto unlock;
Marcel Holtmann769be972008-07-14 20:13:49 +02002797
Johan Hedbergccd556f2010-11-10 17:11:51 +02002798 if (!ev->status)
Johan Hedbergcad718e2013-04-17 15:00:51 +03002799 memcpy(conn->features[0], ev->features, 8);
Johan Hedbergccd556f2010-11-10 17:11:51 +02002800
2801 if (conn->state != BT_CONFIG)
2802 goto unlock;
2803
Szymon Jancac363cf2015-01-29 16:36:59 +01002804 if (!ev->status && lmp_ext_feat_capable(hdev) &&
2805 lmp_ext_feat_capable(conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002806 struct hci_cp_read_remote_ext_features cp;
2807 cp.handle = ev->handle;
2808 cp.page = 0x01;
2809 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
Gustavo Padovan807deac2012-05-17 00:36:24 -03002810 sizeof(cp), &cp);
Johan Hedberg392599b2010-11-18 22:22:28 +02002811 goto unlock;
2812 }
2813
Johan Hedberg671267b2012-05-12 16:11:50 -03002814 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02002815 struct hci_cp_remote_name_req cp;
2816 memset(&cp, 0, sizeof(cp));
2817 bacpy(&cp.bdaddr, &conn->dst);
2818 cp.pscan_rep_mode = 0x02;
2819 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02002820 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00002821 mgmt_device_connected(hdev, conn, 0, NULL, 0);
Johan Hedberg392599b2010-11-18 22:22:28 +02002822
Johan Hedberg127178d2010-11-18 22:22:29 +02002823 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02002824 conn->state = BT_CONNECTED;
Johan Hedberg539c4962015-02-18 14:53:57 +02002825 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02002826 hci_conn_drop(conn);
Marcel Holtmann769be972008-07-14 20:13:49 +02002827 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002828
Johan Hedbergccd556f2010-11-10 17:11:51 +02002829unlock:
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002830 hci_dev_unlock(hdev);
2831}
2832
Johan Hedberge62144872015-04-02 13:41:08 +03002833static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb,
2834 u16 *opcode, u8 *status,
2835 hci_req_complete_t *req_complete,
2836 hci_req_complete_skb_t *req_complete_skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002837{
2838 struct hci_ev_cmd_complete *ev = (void *) skb->data;
Johan Hedberge62144872015-04-02 13:41:08 +03002839
2840 *opcode = __le16_to_cpu(ev->opcode);
2841 *status = skb->data[sizeof(*ev)];
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002842
2843 skb_pull(skb, sizeof(*ev));
2844
Johan Hedberge62144872015-04-02 13:41:08 +03002845 switch (*opcode) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002846 case HCI_OP_INQUIRY_CANCEL:
2847 hci_cc_inquiry_cancel(hdev, skb);
2848 break;
2849
Andre Guedes4d934832012-03-21 00:03:35 -03002850 case HCI_OP_PERIODIC_INQ:
2851 hci_cc_periodic_inq(hdev, skb);
2852 break;
2853
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002854 case HCI_OP_EXIT_PERIODIC_INQ:
2855 hci_cc_exit_periodic_inq(hdev, skb);
2856 break;
2857
2858 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2859 hci_cc_remote_name_req_cancel(hdev, skb);
2860 break;
2861
2862 case HCI_OP_ROLE_DISCOVERY:
2863 hci_cc_role_discovery(hdev, skb);
2864 break;
2865
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002866 case HCI_OP_READ_LINK_POLICY:
2867 hci_cc_read_link_policy(hdev, skb);
2868 break;
2869
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002870 case HCI_OP_WRITE_LINK_POLICY:
2871 hci_cc_write_link_policy(hdev, skb);
2872 break;
2873
Marcel Holtmanne4e8e372008-07-14 20:13:47 +02002874 case HCI_OP_READ_DEF_LINK_POLICY:
2875 hci_cc_read_def_link_policy(hdev, skb);
2876 break;
2877
2878 case HCI_OP_WRITE_DEF_LINK_POLICY:
2879 hci_cc_write_def_link_policy(hdev, skb);
2880 break;
2881
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002882 case HCI_OP_RESET:
2883 hci_cc_reset(hdev, skb);
2884 break;
2885
Marcel Holtmannc2f0f972015-01-12 09:21:25 -08002886 case HCI_OP_READ_STORED_LINK_KEY:
2887 hci_cc_read_stored_link_key(hdev, skb);
2888 break;
2889
Marcel Holtmanna93661202015-01-12 09:21:28 -08002890 case HCI_OP_DELETE_STORED_LINK_KEY:
2891 hci_cc_delete_stored_link_key(hdev, skb);
2892 break;
2893
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002894 case HCI_OP_WRITE_LOCAL_NAME:
2895 hci_cc_write_local_name(hdev, skb);
2896 break;
2897
2898 case HCI_OP_READ_LOCAL_NAME:
2899 hci_cc_read_local_name(hdev, skb);
2900 break;
2901
2902 case HCI_OP_WRITE_AUTH_ENABLE:
2903 hci_cc_write_auth_enable(hdev, skb);
2904 break;
2905
2906 case HCI_OP_WRITE_ENCRYPT_MODE:
2907 hci_cc_write_encrypt_mode(hdev, skb);
2908 break;
2909
2910 case HCI_OP_WRITE_SCAN_ENABLE:
2911 hci_cc_write_scan_enable(hdev, skb);
2912 break;
2913
2914 case HCI_OP_READ_CLASS_OF_DEV:
2915 hci_cc_read_class_of_dev(hdev, skb);
2916 break;
2917
2918 case HCI_OP_WRITE_CLASS_OF_DEV:
2919 hci_cc_write_class_of_dev(hdev, skb);
2920 break;
2921
2922 case HCI_OP_READ_VOICE_SETTING:
2923 hci_cc_read_voice_setting(hdev, skb);
2924 break;
2925
2926 case HCI_OP_WRITE_VOICE_SETTING:
2927 hci_cc_write_voice_setting(hdev, skb);
2928 break;
2929
Marcel Holtmannb4cb9fb2013-10-14 13:56:16 -07002930 case HCI_OP_READ_NUM_SUPPORTED_IAC:
2931 hci_cc_read_num_supported_iac(hdev, skb);
2932 break;
2933
Marcel Holtmann333140b2008-07-14 20:13:48 +02002934 case HCI_OP_WRITE_SSP_MODE:
2935 hci_cc_write_ssp_mode(hdev, skb);
2936 break;
2937
Marcel Holtmanneac83dc2014-01-10 02:07:23 -08002938 case HCI_OP_WRITE_SC_SUPPORT:
2939 hci_cc_write_sc_support(hdev, skb);
2940 break;
2941
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002942 case HCI_OP_READ_LOCAL_VERSION:
2943 hci_cc_read_local_version(hdev, skb);
2944 break;
2945
2946 case HCI_OP_READ_LOCAL_COMMANDS:
2947 hci_cc_read_local_commands(hdev, skb);
2948 break;
2949
2950 case HCI_OP_READ_LOCAL_FEATURES:
2951 hci_cc_read_local_features(hdev, skb);
2952 break;
2953
Andre Guedes971e3a42011-06-30 19:20:52 -03002954 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2955 hci_cc_read_local_ext_features(hdev, skb);
2956 break;
2957
Marcel Holtmanna9de9242007-10-20 13:33:56 +02002958 case HCI_OP_READ_BUFFER_SIZE:
2959 hci_cc_read_buffer_size(hdev, skb);
2960 break;
2961
2962 case HCI_OP_READ_BD_ADDR:
2963 hci_cc_read_bd_addr(hdev, skb);
2964 break;
2965
Johan Hedbergf332ec62013-03-15 17:07:11 -05002966 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2967 hci_cc_read_page_scan_activity(hdev, skb);
2968 break;
2969
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002970 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2971 hci_cc_write_page_scan_activity(hdev, skb);
2972 break;
2973
Johan Hedbergf332ec62013-03-15 17:07:11 -05002974 case HCI_OP_READ_PAGE_SCAN_TYPE:
2975 hci_cc_read_page_scan_type(hdev, skb);
2976 break;
2977
Johan Hedberg4a3ee762013-03-15 17:07:12 -05002978 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2979 hci_cc_write_page_scan_type(hdev, skb);
2980 break;
2981
Andrei Emeltchenko350ee4c2011-12-07 15:56:51 +02002982 case HCI_OP_READ_DATA_BLOCK_SIZE:
2983 hci_cc_read_data_block_size(hdev, skb);
2984 break;
2985
Andrei Emeltchenko1e89cff2011-11-24 14:52:02 +02002986 case HCI_OP_READ_FLOW_CONTROL_MODE:
2987 hci_cc_read_flow_control_mode(hdev, skb);
2988 break;
2989
Andrei Emeltchenko928abaa2011-10-12 10:53:57 +03002990 case HCI_OP_READ_LOCAL_AMP_INFO:
2991 hci_cc_read_local_amp_info(hdev, skb);
2992 break;
2993
Johan Hedberg33f35722014-06-28 17:54:06 +03002994 case HCI_OP_READ_CLOCK:
2995 hci_cc_read_clock(hdev, skb);
2996 break;
2997
Andrei Emeltchenko903e4542012-09-27 17:26:09 +03002998 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2999 hci_cc_read_local_amp_assoc(hdev, skb);
3000 break;
3001
Johan Hedbergd5859e22011-01-25 01:19:58 +02003002 case HCI_OP_READ_INQ_RSP_TX_POWER:
3003 hci_cc_read_inq_rsp_tx_power(hdev, skb);
3004 break;
3005
Johan Hedberg980e1a52011-01-22 06:10:07 +02003006 case HCI_OP_PIN_CODE_REPLY:
3007 hci_cc_pin_code_reply(hdev, skb);
3008 break;
3009
3010 case HCI_OP_PIN_CODE_NEG_REPLY:
3011 hci_cc_pin_code_neg_reply(hdev, skb);
3012 break;
3013
Szymon Jancc35938b2011-03-22 13:12:21 +01003014 case HCI_OP_READ_LOCAL_OOB_DATA:
Marcel Holtmann4d2d2792014-01-10 02:07:26 -08003015 hci_cc_read_local_oob_data(hdev, skb);
3016 break;
3017
3018 case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
3019 hci_cc_read_local_oob_ext_data(hdev, skb);
Szymon Jancc35938b2011-03-22 13:12:21 +01003020 break;
3021
Ville Tervo6ed58ec2011-02-10 22:38:48 -03003022 case HCI_OP_LE_READ_BUFFER_SIZE:
3023 hci_cc_le_read_buffer_size(hdev, skb);
3024 break;
3025
Johan Hedberg60e77322013-01-22 14:01:59 +02003026 case HCI_OP_LE_READ_LOCAL_FEATURES:
3027 hci_cc_le_read_local_features(hdev, skb);
3028 break;
3029
Johan Hedberg8fa19092012-10-19 20:57:49 +03003030 case HCI_OP_LE_READ_ADV_TX_POWER:
3031 hci_cc_le_read_adv_tx_power(hdev, skb);
3032 break;
3033
Johan Hedberga5c29682011-02-19 12:05:57 -03003034 case HCI_OP_USER_CONFIRM_REPLY:
3035 hci_cc_user_confirm_reply(hdev, skb);
3036 break;
3037
3038 case HCI_OP_USER_CONFIRM_NEG_REPLY:
3039 hci_cc_user_confirm_neg_reply(hdev, skb);
3040 break;
3041
Brian Gix1143d452011-11-23 08:28:34 -08003042 case HCI_OP_USER_PASSKEY_REPLY:
3043 hci_cc_user_passkey_reply(hdev, skb);
3044 break;
3045
3046 case HCI_OP_USER_PASSKEY_NEG_REPLY:
3047 hci_cc_user_passkey_neg_reply(hdev, skb);
Szymon Janc16cde992012-04-13 12:32:42 +02003048 break;
Andre Guedes07f7fa52011-12-02 21:13:31 +09003049
Marcel Holtmann7a4cd512014-02-19 19:52:13 -08003050 case HCI_OP_LE_SET_RANDOM_ADDR:
3051 hci_cc_le_set_random_addr(hdev, skb);
3052 break;
3053
Johan Hedbergc1d5dc42012-11-08 01:23:01 +01003054 case HCI_OP_LE_SET_ADV_ENABLE:
3055 hci_cc_le_set_adv_enable(hdev, skb);
3056 break;
3057
Marcel Holtmann533553f2014-03-21 12:18:10 -07003058 case HCI_OP_LE_SET_SCAN_PARAM:
3059 hci_cc_le_set_scan_param(hdev, skb);
3060 break;
3061
Andre Guedeseb9d91f2011-05-26 16:23:52 -03003062 case HCI_OP_LE_SET_SCAN_ENABLE:
3063 hci_cc_le_set_scan_enable(hdev, skb);
3064 break;
3065
Johan Hedbergcf1d0812013-01-22 14:02:00 +02003066 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
3067 hci_cc_le_read_white_list_size(hdev, skb);
3068 break;
3069
Marcel Holtmann0f36b582014-02-27 20:37:31 -08003070 case HCI_OP_LE_CLEAR_WHITE_LIST:
3071 hci_cc_le_clear_white_list(hdev, skb);
3072 break;
3073
3074 case HCI_OP_LE_ADD_TO_WHITE_LIST:
3075 hci_cc_le_add_to_white_list(hdev, skb);
3076 break;
3077
3078 case HCI_OP_LE_DEL_FROM_WHITE_LIST:
3079 hci_cc_le_del_from_white_list(hdev, skb);
3080 break;
3081
Johan Hedberg9b008c02013-01-22 14:02:01 +02003082 case HCI_OP_LE_READ_SUPPORTED_STATES:
3083 hci_cc_le_read_supported_states(hdev, skb);
3084 break;
3085
Marcel Holtmanna8e1bfa2014-12-20 16:28:40 +01003086 case HCI_OP_LE_READ_DEF_DATA_LEN:
3087 hci_cc_le_read_def_data_len(hdev, skb);
3088 break;
3089
3090 case HCI_OP_LE_WRITE_DEF_DATA_LEN:
3091 hci_cc_le_write_def_data_len(hdev, skb);
3092 break;
3093
3094 case HCI_OP_LE_READ_MAX_DATA_LEN:
3095 hci_cc_le_read_max_data_len(hdev, skb);
3096 break;
3097
Andre Guedesf9b49302011-06-30 19:20:53 -03003098 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
3099 hci_cc_write_le_host_supported(hdev, skb);
3100 break;
3101
Johan Hedberg56ed2cb2014-02-27 14:05:40 +02003102 case HCI_OP_LE_SET_ADV_PARAM:
3103 hci_cc_set_adv_param(hdev, skb);
3104 break;
3105
Andrei Emeltchenko93c284e2012-09-27 17:26:20 +03003106 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
3107 hci_cc_write_remote_amp_assoc(hdev, skb);
3108 break;
3109
Andrzej Kaczmarek5ae76a92014-05-08 15:32:08 +02003110 case HCI_OP_READ_RSSI:
3111 hci_cc_read_rssi(hdev, skb);
3112 break;
3113
Andrzej Kaczmarek5a134fa2014-05-09 21:35:28 +02003114 case HCI_OP_READ_TX_POWER:
3115 hci_cc_read_tx_power(hdev, skb);
3116 break;
3117
Marcel Holtmannc50b33c2015-01-31 15:07:52 -08003118 case HCI_OP_WRITE_SSP_DEBUG_MODE:
3119 hci_cc_write_ssp_debug_mode(hdev, skb);
3120 break;
3121
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003122 default:
Johan Hedberge62144872015-04-02 13:41:08 +03003123 BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003124 break;
3125 }
3126
Johan Hedberge62144872015-04-02 13:41:08 +03003127 if (*opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02003128 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02003129
Johan Hedberg600b2152015-03-28 11:17:36 +02003130 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags))
3131 atomic_set(&hdev->cmd_cnt, 1);
3132
Johan Hedberge62144872015-04-02 13:41:08 +03003133 hci_req_cmd_complete(hdev, *opcode, *status, req_complete,
3134 req_complete_skb);
Johan Hedberg9238f362013-03-05 20:37:48 +02003135
Johan Hedberg600b2152015-03-28 11:17:36 +02003136 if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
3137 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003138}
3139
Johan Hedberge62144872015-04-02 13:41:08 +03003140static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb,
3141 u16 *opcode, u8 *status,
3142 hci_req_complete_t *req_complete,
3143 hci_req_complete_skb_t *req_complete_skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003144{
3145 struct hci_ev_cmd_status *ev = (void *) skb->data;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003146
3147 skb_pull(skb, sizeof(*ev));
3148
Johan Hedberge62144872015-04-02 13:41:08 +03003149 *opcode = __le16_to_cpu(ev->opcode);
3150 *status = ev->status;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003151
Johan Hedberge62144872015-04-02 13:41:08 +03003152 switch (*opcode) {
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003153 case HCI_OP_INQUIRY:
3154 hci_cs_inquiry(hdev, ev->status);
3155 break;
3156
3157 case HCI_OP_CREATE_CONN:
3158 hci_cs_create_conn(hdev, ev->status);
3159 break;
3160
Kuba Pawlak9645c762014-11-06 19:36:53 +01003161 case HCI_OP_DISCONNECT:
3162 hci_cs_disconnect(hdev, ev->status);
3163 break;
3164
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003165 case HCI_OP_ADD_SCO:
3166 hci_cs_add_sco(hdev, ev->status);
3167 break;
3168
Marcel Holtmannf8558552008-07-14 20:13:49 +02003169 case HCI_OP_AUTH_REQUESTED:
3170 hci_cs_auth_requested(hdev, ev->status);
3171 break;
3172
3173 case HCI_OP_SET_CONN_ENCRYPT:
3174 hci_cs_set_conn_encrypt(hdev, ev->status);
3175 break;
3176
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003177 case HCI_OP_REMOTE_NAME_REQ:
3178 hci_cs_remote_name_req(hdev, ev->status);
3179 break;
3180
Marcel Holtmann769be972008-07-14 20:13:49 +02003181 case HCI_OP_READ_REMOTE_FEATURES:
3182 hci_cs_read_remote_features(hdev, ev->status);
3183 break;
3184
3185 case HCI_OP_READ_REMOTE_EXT_FEATURES:
3186 hci_cs_read_remote_ext_features(hdev, ev->status);
3187 break;
3188
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003189 case HCI_OP_SETUP_SYNC_CONN:
3190 hci_cs_setup_sync_conn(hdev, ev->status);
3191 break;
3192
Kuba Pawlak9645c762014-11-06 19:36:53 +01003193 case HCI_OP_CREATE_PHY_LINK:
3194 hci_cs_create_phylink(hdev, ev->status);
3195 break;
3196
3197 case HCI_OP_ACCEPT_PHY_LINK:
3198 hci_cs_accept_phylink(hdev, ev->status);
3199 break;
3200
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003201 case HCI_OP_SNIFF_MODE:
3202 hci_cs_sniff_mode(hdev, ev->status);
3203 break;
3204
3205 case HCI_OP_EXIT_SNIFF_MODE:
3206 hci_cs_exit_sniff_mode(hdev, ev->status);
3207 break;
3208
Kuba Pawlak50fc85f2014-11-06 19:36:52 +01003209 case HCI_OP_SWITCH_ROLE:
3210 hci_cs_switch_role(hdev, ev->status);
3211 break;
3212
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02003213 case HCI_OP_LE_CREATE_CONN:
3214 hci_cs_le_create_conn(hdev, ev->status);
3215 break;
3216
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07003217 case HCI_OP_LE_READ_REMOTE_FEATURES:
3218 hci_cs_le_read_remote_features(hdev, ev->status);
3219 break;
3220
Johan Hedberg81d0c8a2014-03-24 14:39:04 +02003221 case HCI_OP_LE_START_ENC:
3222 hci_cs_le_start_enc(hdev, ev->status);
3223 break;
3224
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003225 default:
Johan Hedberge62144872015-04-02 13:41:08 +03003226 BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003227 break;
3228 }
3229
Johan Hedberge62144872015-04-02 13:41:08 +03003230 if (*opcode != HCI_OP_NOP)
Marcel Holtmann65cc2b42014-06-16 12:30:56 +02003231 cancel_delayed_work(&hdev->cmd_timer);
Ville Tervo6bd32322011-02-16 16:32:41 +02003232
Johan Hedberg600b2152015-03-28 11:17:36 +02003233 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags))
3234 atomic_set(&hdev->cmd_cnt, 1);
3235
Johan Hedberg444c6dd2015-04-02 13:41:07 +03003236 /* Indicate request completion if the command failed. Also, if
3237 * we're not waiting for a special event and we get a success
3238 * command status we should try to flag the request as completed
3239 * (since for this kind of commands there will not be a command
3240 * complete event).
3241 */
Johan Hedberg02350a72013-04-03 21:50:29 +03003242 if (ev->status ||
Johan Hedbergdb6e3e82015-03-30 23:21:02 +03003243 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
Johan Hedberge62144872015-04-02 13:41:08 +03003244 hci_req_cmd_complete(hdev, *opcode, ev->status, req_complete,
3245 req_complete_skb);
Johan Hedberg9238f362013-03-05 20:37:48 +02003246
Johan Hedberg600b2152015-03-28 11:17:36 +02003247 if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
3248 queue_work(hdev->workqueue, &hdev->cmd_work);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003249}
3250
Marcel Holtmann24dfa342014-11-02 02:56:41 +01003251static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
3252{
3253 struct hci_ev_hardware_error *ev = (void *) skb->data;
3254
Marcel Holtmannc7741d12015-01-28 11:09:55 -08003255 hdev->hw_error_code = ev->code;
3256
3257 queue_work(hdev->req_workqueue, &hdev->error_reset);
Marcel Holtmann24dfa342014-11-02 02:56:41 +01003258}
3259
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003260static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003261{
3262 struct hci_ev_role_change *ev = (void *) skb->data;
3263 struct hci_conn *conn;
3264
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003265 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003266
3267 hci_dev_lock(hdev);
3268
3269 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3270 if (conn) {
Johan Hedberg40bef302014-07-16 11:42:27 +03003271 if (!ev->status)
3272 conn->role = ev->role;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003273
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003274 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003275
3276 hci_role_switch_cfm(conn, ev->status, ev->role);
3277 }
3278
3279 hci_dev_unlock(hdev);
3280}
3281
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003282static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003283{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003284 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003285 int i;
3286
Andrei Emeltchenko32ac5b92011-12-19 16:31:29 +02003287 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
3288 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
3289 return;
3290 }
3291
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02003292 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03003293 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003294 BT_DBG("%s bad parameters", hdev->name);
3295 return;
3296 }
3297
Andrei Emeltchenkoc5993de2011-12-30 12:07:47 +02003298 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
3299
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02003300 for (i = 0; i < ev->num_hndl; i++) {
3301 struct hci_comp_pkts_info *info = &ev->handles[i];
Linus Torvalds1da177e2005-04-16 15:20:36 -07003302 struct hci_conn *conn;
3303 __u16 handle, count;
3304
Andrei Emeltchenko613a1c02011-12-19 16:31:30 +02003305 handle = __le16_to_cpu(info->handle);
3306 count = __le16_to_cpu(info->count);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003307
3308 conn = hci_conn_hash_lookup_handle(hdev, handle);
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02003309 if (!conn)
3310 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003311
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02003312 conn->sent -= count;
3313
3314 switch (conn->type) {
3315 case ACL_LINK:
3316 hdev->acl_cnt += count;
3317 if (hdev->acl_cnt > hdev->acl_pkts)
3318 hdev->acl_cnt = hdev->acl_pkts;
3319 break;
3320
3321 case LE_LINK:
3322 if (hdev->le_pkts) {
3323 hdev->le_cnt += count;
3324 if (hdev->le_cnt > hdev->le_pkts)
3325 hdev->le_cnt = hdev->le_pkts;
3326 } else {
Andrei Emeltchenko70f230202010-12-01 16:58:25 +02003327 hdev->acl_cnt += count;
3328 if (hdev->acl_cnt > hdev->acl_pkts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003329 hdev->acl_cnt = hdev->acl_pkts;
3330 }
Andrei Emeltchenkof4280912011-12-07 15:56:52 +02003331 break;
3332
3333 case SCO_LINK:
3334 hdev->sco_cnt += count;
3335 if (hdev->sco_cnt > hdev->sco_pkts)
3336 hdev->sco_cnt = hdev->sco_pkts;
3337 break;
3338
3339 default:
3340 BT_ERR("Unknown type %d conn %p", conn->type, conn);
3341 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003342 }
3343 }
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003344
Gustavo F. Padovan3eff45e2011-12-15 00:50:02 -02003345 queue_work(hdev->workqueue, &hdev->tx_work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003346}
3347
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03003348static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
3349 __u16 handle)
3350{
3351 struct hci_chan *chan;
3352
3353 switch (hdev->dev_type) {
3354 case HCI_BREDR:
3355 return hci_conn_hash_lookup_handle(hdev, handle);
3356 case HCI_AMP:
3357 chan = hci_chan_lookup_handle(hdev, handle);
3358 if (chan)
3359 return chan->conn;
3360 break;
3361 default:
3362 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
3363 break;
3364 }
3365
3366 return NULL;
3367}
3368
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003369static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003370{
3371 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
3372 int i;
3373
3374 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
3375 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
3376 return;
3377 }
3378
3379 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
Gustavo Padovan807deac2012-05-17 00:36:24 -03003380 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003381 BT_DBG("%s bad parameters", hdev->name);
3382 return;
3383 }
3384
3385 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003386 ev->num_hndl);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003387
3388 for (i = 0; i < ev->num_hndl; i++) {
3389 struct hci_comp_blocks_info *info = &ev->handles[i];
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03003390 struct hci_conn *conn = NULL;
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003391 __u16 handle, block_count;
3392
3393 handle = __le16_to_cpu(info->handle);
3394 block_count = __le16_to_cpu(info->blocks);
3395
Andrei Emeltchenko76ef7cf2012-10-10 17:38:29 +03003396 conn = __hci_conn_lookup_handle(hdev, handle);
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003397 if (!conn)
3398 continue;
3399
3400 conn->sent -= block_count;
3401
3402 switch (conn->type) {
3403 case ACL_LINK:
Andrei Emeltchenkobd1eb662012-10-10 17:38:30 +03003404 case AMP_LINK:
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02003405 hdev->block_cnt += block_count;
3406 if (hdev->block_cnt > hdev->num_blocks)
3407 hdev->block_cnt = hdev->num_blocks;
3408 break;
3409
3410 default:
3411 BT_ERR("Unknown type %d conn %p", conn->type, conn);
3412 break;
3413 }
3414 }
3415
3416 queue_work(hdev->workqueue, &hdev->tx_work);
3417}
3418
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003419static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003420{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003421 struct hci_ev_mode_change *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003422 struct hci_conn *conn;
Linus Torvalds1da177e2005-04-16 15:20:36 -07003423
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003424 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003425
3426 hci_dev_lock(hdev);
3427
Marcel Holtmann04837f62006-07-03 10:02:33 +02003428 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3429 if (conn) {
3430 conn->mode = ev->mode;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003431
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003432 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
3433 &conn->flags)) {
Marcel Holtmann04837f62006-07-03 10:02:33 +02003434 if (conn->mode == HCI_CM_ACTIVE)
Johan Hedberg58a681e2012-01-16 06:47:28 +02003435 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003436 else
Johan Hedberg58a681e2012-01-16 06:47:28 +02003437 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003438 }
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003439
Johan Hedberg51a8efd2012-01-16 06:10:31 +02003440 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
Marcel Holtmanne73439d2010-07-26 10:06:00 -04003441 hci_sco_setup(conn, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003442 }
3443
3444 hci_dev_unlock(hdev);
3445}
3446
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003447static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003448{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003449 struct hci_ev_pin_code_req *ev = (void *) skb->data;
3450 struct hci_conn *conn;
3451
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003452 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003453
3454 hci_dev_lock(hdev);
3455
3456 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003457 if (!conn)
3458 goto unlock;
3459
3460 if (conn->state == BT_CONNECTED) {
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003461 hci_conn_hold(conn);
3462 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003463 hci_conn_drop(conn);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003464 }
3465
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003466 if (!hci_dev_test_flag(hdev, HCI_BONDABLE) &&
Johan Hedberg2f407f02014-07-17 15:35:40 +03003467 !test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags)) {
Johan Hedberg03b555e2011-01-04 15:40:05 +02003468 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03003469 sizeof(ev->bdaddr), &ev->bdaddr);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003470 } else if (hci_dev_test_flag(hdev, HCI_MGMT)) {
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003471 u8 secure;
3472
3473 if (conn->pending_sec_level == BT_SECURITY_HIGH)
3474 secure = 1;
3475 else
3476 secure = 0;
3477
Johan Hedberg744cf192011-11-08 20:40:14 +02003478 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
Waldemar Rymarkiewicza770bb52011-04-28 12:07:59 +02003479 }
Johan Hedberg980e1a52011-01-22 06:10:07 +02003480
Waldemar Rymarkiewiczb6f98042011-09-23 10:01:30 +02003481unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003482 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003483}
3484
Johan Hedbergcb6f3f72014-11-19 14:53:04 +02003485static void conn_set_key(struct hci_conn *conn, u8 key_type, u8 pin_len)
3486{
3487 if (key_type == HCI_LK_CHANGED_COMBINATION)
3488 return;
3489
3490 conn->pin_length = pin_len;
3491 conn->key_type = key_type;
3492
3493 switch (key_type) {
3494 case HCI_LK_LOCAL_UNIT:
3495 case HCI_LK_REMOTE_UNIT:
3496 case HCI_LK_DEBUG_COMBINATION:
3497 return;
3498 case HCI_LK_COMBINATION:
3499 if (pin_len == 16)
3500 conn->pending_sec_level = BT_SECURITY_HIGH;
3501 else
3502 conn->pending_sec_level = BT_SECURITY_MEDIUM;
3503 break;
3504 case HCI_LK_UNAUTH_COMBINATION_P192:
3505 case HCI_LK_UNAUTH_COMBINATION_P256:
3506 conn->pending_sec_level = BT_SECURITY_MEDIUM;
3507 break;
3508 case HCI_LK_AUTH_COMBINATION_P192:
3509 conn->pending_sec_level = BT_SECURITY_HIGH;
3510 break;
3511 case HCI_LK_AUTH_COMBINATION_P256:
3512 conn->pending_sec_level = BT_SECURITY_FIPS;
3513 break;
3514 }
3515}
3516
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003517static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003518{
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003519 struct hci_ev_link_key_req *ev = (void *) skb->data;
3520 struct hci_cp_link_key_reply cp;
3521 struct hci_conn *conn;
3522 struct link_key *key;
3523
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003524 BT_DBG("%s", hdev->name);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003525
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003526 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003527 return;
3528
3529 hci_dev_lock(hdev);
3530
3531 key = hci_find_link_key(hdev, &ev->bdaddr);
3532 if (!key) {
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003533 BT_DBG("%s link key not found for %pMR", hdev->name,
3534 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003535 goto not_found;
3536 }
3537
Andrei Emeltchenko6ed93dc2012-09-25 12:49:43 +03003538 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
3539 &ev->bdaddr);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003540
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003541 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003542 if (conn) {
Johan Hedbergfe8bc5a2014-08-14 12:33:17 +03003543 clear_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);
3544
Marcel Holtmann66138ce2014-01-10 02:07:20 -08003545 if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
3546 key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
Gustavo Padovan807deac2012-05-17 00:36:24 -03003547 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003548 BT_DBG("%s ignoring unauthenticated key", hdev->name);
3549 goto not_found;
3550 }
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003551
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003552 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
Johan Hedbergf3fb0b52014-06-02 10:12:44 +03003553 (conn->pending_sec_level == BT_SECURITY_HIGH ||
3554 conn->pending_sec_level == BT_SECURITY_FIPS)) {
Gustavo Padovan8fc9ced2012-05-23 04:04:21 -03003555 BT_DBG("%s ignoring key unauthenticated for high security",
3556 hdev->name);
Waldemar Rymarkiewicz60b83f52011-04-28 12:07:56 +02003557 goto not_found;
3558 }
3559
Johan Hedbergcb6f3f72014-11-19 14:53:04 +02003560 conn_set_key(conn, key->type, key->pin_len);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003561 }
3562
3563 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9b3b4462012-05-23 11:31:20 +03003564 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003565
3566 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
3567
3568 hci_dev_unlock(hdev);
3569
3570 return;
3571
3572not_found:
3573 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
3574 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003575}
3576
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003577static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003578{
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003579 struct hci_ev_link_key_notify *ev = (void *) skb->data;
3580 struct hci_conn *conn;
Johan Hedberg7652ff62014-06-24 13:15:49 +03003581 struct link_key *key;
3582 bool persistent;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003583 u8 pin_len = 0;
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003584
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003585 BT_DBG("%s", hdev->name);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003586
3587 hci_dev_lock(hdev);
3588
3589 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg82c13d42014-12-03 11:03:06 +02003590 if (!conn)
3591 goto unlock;
3592
3593 hci_conn_hold(conn);
3594 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3595 hci_conn_drop(conn);
3596
Johan Hedbergfe8bc5a2014-08-14 12:33:17 +03003597 set_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);
Johan Hedberg82c13d42014-12-03 11:03:06 +02003598 conn_set_key(conn, ev->key_type, conn->pin_length);
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003599
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003600 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg7652ff62014-06-24 13:15:49 +03003601 goto unlock;
Johan Hedberg55ed8ca12011-01-17 14:41:05 +02003602
Johan Hedberg7652ff62014-06-24 13:15:49 +03003603 key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
3604 ev->key_type, pin_len, &persistent);
3605 if (!key)
3606 goto unlock;
3607
Johan Hedbergcb6f3f72014-11-19 14:53:04 +02003608 /* Update connection information since adding the key will have
3609 * fixed up the type in the case of changed combination keys.
3610 */
3611 if (ev->key_type == HCI_LK_CHANGED_COMBINATION)
3612 conn_set_key(conn, key->type, key->pin_len);
3613
Johan Hedberg7652ff62014-06-24 13:15:49 +03003614 mgmt_new_link_key(hdev, key, persistent);
3615
Johan Hedberg6d5650c2014-06-24 13:15:51 +03003616 /* Keep debug keys around only if the HCI_KEEP_DEBUG_KEYS flag
3617 * is set. If it's not set simply remove the key from the kernel
3618 * list (we've still notified user space about it but with
3619 * store_hint being 0).
3620 */
3621 if (key->type == HCI_LK_DEBUG_COMBINATION &&
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003622 !hci_dev_test_flag(hdev, HCI_KEEP_DEBUG_KEYS)) {
Johan Hedberg0378b592014-11-19 15:22:22 +02003623 list_del_rcu(&key->list);
3624 kfree_rcu(key, rcu);
Johan Hedberg82c13d42014-12-03 11:03:06 +02003625 goto unlock;
Johan Hedberg6d5650c2014-06-24 13:15:51 +03003626 }
Johan Hedberg7652ff62014-06-24 13:15:49 +03003627
Johan Hedberg82c13d42014-12-03 11:03:06 +02003628 if (persistent)
3629 clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3630 else
3631 set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3632
Johan Hedberg7652ff62014-06-24 13:15:49 +03003633unlock:
Marcel Holtmann052b30b2009-04-26 20:01:22 +02003634 hci_dev_unlock(hdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07003635}
3636
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003637static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04837f62006-07-03 10:02:33 +02003638{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003639 struct hci_ev_clock_offset *ev = (void *) skb->data;
Marcel Holtmann04837f62006-07-03 10:02:33 +02003640 struct hci_conn *conn;
3641
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003642 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmann04837f62006-07-03 10:02:33 +02003643
3644 hci_dev_lock(hdev);
3645
3646 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003647 if (conn && !ev->status) {
3648 struct inquiry_entry *ie;
3649
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003650 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3651 if (ie) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07003652 ie->data.clock_offset = ev->clock_offset;
3653 ie->timestamp = jiffies;
3654 }
3655 }
3656
3657 hci_dev_unlock(hdev);
3658}
3659
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003660static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmanna8746412008-07-14 20:13:46 +02003661{
3662 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
3663 struct hci_conn *conn;
3664
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003665 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmanna8746412008-07-14 20:13:46 +02003666
3667 hci_dev_lock(hdev);
3668
3669 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3670 if (conn && !ev->status)
3671 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
3672
3673 hci_dev_unlock(hdev);
3674}
3675
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003676static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003677{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003678 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003679 struct inquiry_entry *ie;
3680
3681 BT_DBG("%s", hdev->name);
3682
3683 hci_dev_lock(hdev);
3684
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003685 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3686 if (ie) {
Marcel Holtmann85a1e932005-08-09 20:28:02 -07003687 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
3688 ie->timestamp = jiffies;
3689 }
3690
3691 hci_dev_unlock(hdev);
3692}
3693
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003694static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
3695 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003696{
3697 struct inquiry_data data;
3698 int num_rsp = *((__u8 *) skb->data);
3699
3700 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3701
3702 if (!num_rsp)
3703 return;
3704
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003705 if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
Andre Guedes1519cc12012-03-21 00:03:38 -03003706 return;
3707
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003708 hci_dev_lock(hdev);
3709
3710 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
Szymon Janc138d22e2011-02-17 16:44:23 +01003711 struct inquiry_info_with_rssi_and_pscan_mode *info;
3712 info = (void *) (skb->data + 1);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003713
Johan Hedberge17acd42011-03-30 23:57:16 +03003714 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02003715 u32 flags;
3716
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003717 bacpy(&data.bdaddr, &info->bdaddr);
3718 data.pscan_rep_mode = info->pscan_rep_mode;
3719 data.pscan_period_mode = info->pscan_period_mode;
3720 data.pscan_mode = info->pscan_mode;
3721 memcpy(data.dev_class, info->dev_class, 3);
3722 data.clock_offset = info->clock_offset;
3723 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003724 data.ssp_mode = 0x00;
Johan Hedberg31754052012-01-04 13:39:52 +02003725
Marcel Holtmannaf589252014-07-01 14:11:20 +02003726 flags = hci_inquiry_cache_update(hdev, &data, false);
3727
Johan Hedberg48264f02011-11-09 13:58:58 +02003728 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003729 info->dev_class, info->rssi,
Marcel Holtmannaf589252014-07-01 14:11:20 +02003730 flags, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003731 }
3732 } else {
3733 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
3734
Johan Hedberge17acd42011-03-30 23:57:16 +03003735 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02003736 u32 flags;
3737
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003738 bacpy(&data.bdaddr, &info->bdaddr);
3739 data.pscan_rep_mode = info->pscan_rep_mode;
3740 data.pscan_period_mode = info->pscan_period_mode;
3741 data.pscan_mode = 0x00;
3742 memcpy(data.dev_class, info->dev_class, 3);
3743 data.clock_offset = info->clock_offset;
3744 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003745 data.ssp_mode = 0x00;
Marcel Holtmannaf589252014-07-01 14:11:20 +02003746
3747 flags = hci_inquiry_cache_update(hdev, &data, false);
3748
Johan Hedberg48264f02011-11-09 13:58:58 +02003749 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003750 info->dev_class, info->rssi,
Marcel Holtmannaf589252014-07-01 14:11:20 +02003751 flags, NULL, 0, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003752 }
3753 }
3754
3755 hci_dev_unlock(hdev);
3756}
3757
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003758static void hci_remote_ext_features_evt(struct hci_dev *hdev,
3759 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003760{
Marcel Holtmann41a96212008-07-14 20:13:48 +02003761 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
3762 struct hci_conn *conn;
3763
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003764 BT_DBG("%s", hdev->name);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003765
Marcel Holtmann41a96212008-07-14 20:13:48 +02003766 hci_dev_lock(hdev);
3767
3768 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Johan Hedbergccd556f2010-11-10 17:11:51 +02003769 if (!conn)
3770 goto unlock;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003771
Johan Hedbergcad718e2013-04-17 15:00:51 +03003772 if (ev->page < HCI_MAX_PAGES)
3773 memcpy(conn->features[ev->page], ev->features, 8);
3774
Johan Hedbergccd556f2010-11-10 17:11:51 +02003775 if (!ev->status && ev->page == 0x01) {
3776 struct inquiry_entry *ie;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003777
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02003778 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3779 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02003780 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann769be972008-07-14 20:13:49 +02003781
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303782 if (ev->features[0] & LMP_HOST_SSP) {
Johan Hedberg58a681e2012-01-16 06:47:28 +02003783 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
Jaganath Kanakkasserybbb0ead2013-04-16 20:16:30 +05303784 } else {
3785 /* It is mandatory by the Bluetooth specification that
3786 * Extended Inquiry Results are only used when Secure
3787 * Simple Pairing is enabled, but some devices violate
3788 * this.
3789 *
3790 * To make these devices work, the internal SSP
3791 * enabled flag needs to be cleared if the remote host
3792 * features do not indicate SSP support */
3793 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
3794 }
Marcel Holtmanneb9a8f32014-01-15 22:37:38 -08003795
3796 if (ev->features[0] & LMP_HOST_SC)
3797 set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
Marcel Holtmann41a96212008-07-14 20:13:48 +02003798 }
3799
Johan Hedbergccd556f2010-11-10 17:11:51 +02003800 if (conn->state != BT_CONFIG)
3801 goto unlock;
3802
Johan Hedberg671267b2012-05-12 16:11:50 -03003803 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
Johan Hedberg127178d2010-11-18 22:22:29 +02003804 struct hci_cp_remote_name_req cp;
3805 memset(&cp, 0, sizeof(cp));
3806 bacpy(&cp.bdaddr, &conn->dst);
3807 cp.pscan_rep_mode = 0x02;
3808 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
Johan Hedbergb644ba32012-01-17 21:48:47 +02003809 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00003810 mgmt_device_connected(hdev, conn, 0, NULL, 0);
Johan Hedberg392599b2010-11-18 22:22:28 +02003811
Johan Hedberg127178d2010-11-18 22:22:29 +02003812 if (!hci_outgoing_auth_needed(hdev, conn)) {
Johan Hedbergccd556f2010-11-10 17:11:51 +02003813 conn->state = BT_CONNECTED;
Johan Hedberg539c4962015-02-18 14:53:57 +02003814 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003815 hci_conn_drop(conn);
Johan Hedbergccd556f2010-11-10 17:11:51 +02003816 }
3817
3818unlock:
Marcel Holtmann41a96212008-07-14 20:13:48 +02003819 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003820}
3821
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003822static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3823 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003824{
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003825 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3826 struct hci_conn *conn;
3827
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003828 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003829
3830 hci_dev_lock(hdev);
3831
3832 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
Marcel Holtmann9dc0a3a2008-07-14 20:13:46 +02003833 if (!conn) {
3834 if (ev->link_type == ESCO_LINK)
3835 goto unlock;
3836
3837 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3838 if (!conn)
3839 goto unlock;
3840
3841 conn->type = SCO_LINK;
3842 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003843
Marcel Holtmann732547f2009-04-19 19:14:14 +02003844 switch (ev->status) {
3845 case 0x00:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003846 conn->handle = __le16_to_cpu(ev->handle);
3847 conn->state = BT_CONNECTED;
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003848
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01003849 hci_debugfs_create_conn(conn);
Marcel Holtmann7d0db0a2008-07-14 20:13:51 +02003850 hci_conn_add_sysfs(conn);
Marcel Holtmann732547f2009-04-19 19:14:14 +02003851 break;
3852
Nick Pelly81218d22014-06-30 11:25:01 +05303853 case 0x10: /* Connection Accept Timeout */
Frédéric Dalleau1a4c9582013-08-19 14:24:02 +02003854 case 0x0d: /* Connection Rejected due to Limited Resources */
Stephen Coe705e5712010-02-16 11:29:44 -05003855 case 0x11: /* Unsupported Feature or Parameter Value */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003856 case 0x1c: /* SCO interval rejected */
Nick Pelly1038a002010-02-03 11:42:26 -08003857 case 0x1a: /* Unsupported Remote Feature */
Marcel Holtmann732547f2009-04-19 19:14:14 +02003858 case 0x1f: /* Unspecified error */
Andrew Earl27539bc2014-03-10 10:31:04 +00003859 case 0x20: /* Unsupported LMP Parameter value */
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003860 if (conn->out) {
Marcel Holtmann732547f2009-04-19 19:14:14 +02003861 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3862 (hdev->esco_type & EDR_ESCO_MASK);
Frédéric Dalleau2dea6322013-08-19 14:24:03 +02003863 if (hci_setup_sync(conn, conn->link->handle))
3864 goto unlock;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003865 }
3866 /* fall through */
3867
3868 default:
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003869 conn->state = BT_CLOSED;
Marcel Holtmann732547f2009-04-19 19:14:14 +02003870 break;
3871 }
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003872
Johan Hedberg539c4962015-02-18 14:53:57 +02003873 hci_connect_cfm(conn, ev->status);
Marcel Holtmannb6a0dc82007-10-20 14:55:10 +02003874 if (ev->status)
3875 hci_conn_del(conn);
3876
3877unlock:
3878 hci_dev_unlock(hdev);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003879}
3880
Marcel Holtmannefdcf8e2013-10-15 10:31:12 -07003881static inline size_t eir_get_length(u8 *eir, size_t eir_len)
3882{
3883 size_t parsed = 0;
3884
3885 while (parsed < eir_len) {
3886 u8 field_len = eir[0];
3887
3888 if (field_len == 0)
3889 return parsed;
3890
3891 parsed += field_len + 1;
3892 eir += field_len + 1;
3893 }
3894
3895 return eir_len;
3896}
3897
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003898static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3899 struct sk_buff *skb)
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003900{
3901 struct inquiry_data data;
3902 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3903 int num_rsp = *((__u8 *) skb->data);
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303904 size_t eir_len;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003905
3906 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3907
3908 if (!num_rsp)
3909 return;
3910
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003911 if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
Andre Guedes1519cc12012-03-21 00:03:38 -03003912 return;
3913
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003914 hci_dev_lock(hdev);
3915
Johan Hedberge17acd42011-03-30 23:57:16 +03003916 for (; num_rsp; num_rsp--, info++) {
Marcel Holtmannaf589252014-07-01 14:11:20 +02003917 u32 flags;
3918 bool name_known;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003919
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003920 bacpy(&data.bdaddr, &info->bdaddr);
Szymon Janc138d22e2011-02-17 16:44:23 +01003921 data.pscan_rep_mode = info->pscan_rep_mode;
3922 data.pscan_period_mode = info->pscan_period_mode;
3923 data.pscan_mode = 0x00;
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003924 memcpy(data.dev_class, info->dev_class, 3);
Szymon Janc138d22e2011-02-17 16:44:23 +01003925 data.clock_offset = info->clock_offset;
3926 data.rssi = info->rssi;
Marcel Holtmann41a96212008-07-14 20:13:48 +02003927 data.ssp_mode = 0x01;
Johan Hedberg561aafb2012-01-04 13:31:59 +02003928
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07003929 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg4ddb1932012-01-15 20:04:43 +02003930 name_known = eir_has_data_type(info->data,
Gustavo F. Padovan04124682012-03-08 01:25:00 -03003931 sizeof(info->data),
3932 EIR_NAME_COMPLETE);
Johan Hedberg561aafb2012-01-04 13:31:59 +02003933 else
3934 name_known = true;
3935
Marcel Holtmannaf589252014-07-01 14:11:20 +02003936 flags = hci_inquiry_cache_update(hdev, &data, name_known);
3937
Vishal Agarwal9d939d92012-04-26 19:19:56 +05303938 eir_len = eir_get_length(info->data, sizeof(info->data));
Marcel Holtmannaf589252014-07-01 14:11:20 +02003939
Johan Hedberg48264f02011-11-09 13:58:58 +02003940 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
Marcel Holtmannaf589252014-07-01 14:11:20 +02003941 info->dev_class, info->rssi,
3942 flags, info->data, eir_len, NULL, 0);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02003943 }
3944
3945 hci_dev_unlock(hdev);
3946}
3947
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003948static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3949 struct sk_buff *skb)
3950{
3951 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3952 struct hci_conn *conn;
3953
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03003954 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003955 __le16_to_cpu(ev->handle));
3956
3957 hci_dev_lock(hdev);
3958
3959 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3960 if (!conn)
3961 goto unlock;
3962
Johan Hedberg9eb1fbf2014-04-11 12:02:31 -07003963 /* For BR/EDR the necessary steps are taken through the
3964 * auth_complete event.
3965 */
3966 if (conn->type != LE_LINK)
3967 goto unlock;
3968
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003969 if (!ev->status)
3970 conn->sec_level = conn->pending_sec_level;
3971
3972 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3973
3974 if (ev->status && conn->state == BT_CONNECTED) {
Andre Guedesbed71742013-01-30 11:50:56 -03003975 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
David Herrmann76a68ba2013-04-06 20:28:37 +02003976 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003977 goto unlock;
3978 }
3979
3980 if (conn->state == BT_CONFIG) {
3981 if (!ev->status)
3982 conn->state = BT_CONNECTED;
3983
Johan Hedberg539c4962015-02-18 14:53:57 +02003984 hci_connect_cfm(conn, ev->status);
David Herrmann76a68ba2013-04-06 20:28:37 +02003985 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003986 } else {
3987 hci_auth_cfm(conn, ev->status);
3988
3989 hci_conn_hold(conn);
3990 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02003991 hci_conn_drop(conn);
Johan Hedberg1c2e0042012-06-08 23:31:13 +08003992 }
3993
3994unlock:
3995 hci_dev_unlock(hdev);
3996}
3997
Gustavo Padovan6039aa72012-05-23 04:04:18 -03003998static u8 hci_get_auth_req(struct hci_conn *conn)
Johan Hedberg17fa4b92011-01-25 13:28:33 +02003999{
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004000 /* If remote requests no-bonding follow that lead */
Mikel Astizacabae92013-06-28 10:56:28 +02004001 if (conn->remote_auth == HCI_AT_NO_BONDING ||
4002 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
Waldemar Rymarkiewicz58797bf2011-04-28 12:07:58 +02004003 return conn->remote_auth | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004004
Mikel Astizb7f94c82014-04-08 14:21:31 +02004005 /* If both remote and local have enough IO capabilities, require
4006 * MITM protection
4007 */
4008 if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
4009 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
4010 return conn->remote_auth | 0x01;
4011
Timo Mueller7e741702014-04-08 14:21:33 +02004012 /* No MITM protection possible so ignore remote requirement */
4013 return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004014}
4015
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08004016static u8 bredr_oob_data_present(struct hci_conn *conn)
4017{
4018 struct hci_dev *hdev = conn->hdev;
4019 struct oob_data *data;
4020
4021 data = hci_find_remote_oob_data(hdev, &conn->dst, BDADDR_BREDR);
4022 if (!data)
4023 return 0x00;
4024
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07004025 if (bredr_sc_enabled(hdev)) {
4026 /* When Secure Connections is enabled, then just
4027 * return the present value stored with the OOB
4028 * data. The stored value contains the right present
4029 * information. However it can only be trusted when
4030 * not in Secure Connection Only mode.
Marcel Holtmann659c7fb2015-01-30 23:20:56 -08004031 */
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07004032 if (!hci_dev_test_flag(hdev, HCI_SC_ONLY))
4033 return data->present;
4034
4035 /* When Secure Connections Only mode is enabled, then
4036 * the P-256 values are required. If they are not
4037 * available, then do not declare that OOB data is
4038 * present.
4039 */
4040 if (!memcmp(data->rand256, ZERO_KEY, 16) ||
4041 !memcmp(data->hash256, ZERO_KEY, 16))
Marcel Holtmann659c7fb2015-01-30 23:20:56 -08004042 return 0x00;
4043
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07004044 return 0x02;
Marcel Holtmann659c7fb2015-01-30 23:20:56 -08004045 }
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08004046
Marcel Holtmann455c2ff2015-03-15 16:42:53 -07004047 /* When Secure Connections is not enabled or actually
4048 * not supported by the hardware, then check that if
4049 * P-192 data values are present.
4050 */
4051 if (!memcmp(data->rand192, ZERO_KEY, 16) ||
4052 !memcmp(data->hash192, ZERO_KEY, 16))
4053 return 0x00;
4054
4055 return 0x01;
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08004056}
4057
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004058static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02004059{
4060 struct hci_ev_io_capa_request *ev = (void *) skb->data;
4061 struct hci_conn *conn;
4062
4063 BT_DBG("%s", hdev->name);
4064
4065 hci_dev_lock(hdev);
4066
4067 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg03b555e2011-01-04 15:40:05 +02004068 if (!conn)
4069 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02004070
Johan Hedberg03b555e2011-01-04 15:40:05 +02004071 hci_conn_hold(conn);
4072
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004073 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg03b555e2011-01-04 15:40:05 +02004074 goto unlock;
4075
Johan Hedberg2f407f02014-07-17 15:35:40 +03004076 /* Allow pairing if we're pairable, the initiators of the
4077 * pairing or if the remote is not requesting bonding.
4078 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004079 if (hci_dev_test_flag(hdev, HCI_BONDABLE) ||
Johan Hedberg2f407f02014-07-17 15:35:40 +03004080 test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags) ||
Gustavo Padovan807deac2012-05-17 00:36:24 -03004081 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004082 struct hci_cp_io_capability_reply cp;
4083
4084 bacpy(&cp.bdaddr, &ev->bdaddr);
Hemant Gupta7a7f1e72012-01-16 13:34:29 +05304085 /* Change the IO capability from KeyboardDisplay
4086 * to DisplayYesNo as it is not supported by BT spec. */
4087 cp.capability = (conn->io_capability == 0x04) ?
Mikel Astiza7676312013-06-28 10:56:29 +02004088 HCI_IO_DISPLAY_YESNO : conn->io_capability;
Mikel Astizb7f94c82014-04-08 14:21:31 +02004089
4090 /* If we are initiators, there is no remote information yet */
4091 if (conn->remote_auth == 0xff) {
Mikel Astizb16c6602014-04-08 14:21:34 +02004092 /* Request MITM protection if our IO caps allow it
Johan Hedberg4ad51a72014-06-09 14:41:25 +03004093 * except for the no-bonding case.
Mikel Astizb16c6602014-04-08 14:21:34 +02004094 */
Mikel Astiz6fd6b912014-04-08 14:21:32 +02004095 if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
Johan Hedberg9f743d72014-07-17 11:56:33 +03004096 conn->auth_type != HCI_AT_NO_BONDING)
Johan Hedberg6c538232014-07-11 15:32:23 +03004097 conn->auth_type |= 0x01;
Mikel Astizb7f94c82014-04-08 14:21:31 +02004098 } else {
4099 conn->auth_type = hci_get_auth_req(conn);
Mikel Astizb7f94c82014-04-08 14:21:31 +02004100 }
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004101
Johan Hedberg82c295b2014-07-30 09:22:24 +03004102 /* If we're not bondable, force one of the non-bondable
4103 * authentication requirement values.
4104 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004105 if (!hci_dev_test_flag(hdev, HCI_BONDABLE))
Johan Hedberg82c295b2014-07-30 09:22:24 +03004106 conn->auth_type &= HCI_AT_NO_BONDING_MITM;
4107
4108 cp.authentication = conn->auth_type;
Marcel Holtmanna83ed81e2015-01-27 16:04:32 -08004109 cp.oob_data = bredr_oob_data_present(conn);
Szymon Jancce85ee12011-03-22 13:12:23 +01004110
Johan Hedberg17fa4b92011-01-25 13:28:33 +02004111 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004112 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02004113 } else {
4114 struct hci_cp_io_capability_neg_reply cp;
4115
4116 bacpy(&cp.bdaddr, &ev->bdaddr);
Andrei Emeltchenko9f5a0d72011-11-07 14:20:25 +02004117 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
Johan Hedberg03b555e2011-01-04 15:40:05 +02004118
4119 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004120 sizeof(cp), &cp);
Johan Hedberg03b555e2011-01-04 15:40:05 +02004121 }
4122
4123unlock:
4124 hci_dev_unlock(hdev);
4125}
4126
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004127static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
Johan Hedberg03b555e2011-01-04 15:40:05 +02004128{
4129 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
4130 struct hci_conn *conn;
4131
4132 BT_DBG("%s", hdev->name);
4133
4134 hci_dev_lock(hdev);
4135
4136 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4137 if (!conn)
4138 goto unlock;
4139
Johan Hedberg03b555e2011-01-04 15:40:05 +02004140 conn->remote_cap = ev->capability;
Johan Hedberg03b555e2011-01-04 15:40:05 +02004141 conn->remote_auth = ev->authentication;
4142
4143unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02004144 hci_dev_unlock(hdev);
4145}
4146
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004147static void hci_user_confirm_request_evt(struct hci_dev *hdev,
4148 struct sk_buff *skb)
Johan Hedberga5c29682011-02-19 12:05:57 -03004149{
4150 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004151 int loc_mitm, rem_mitm, confirm_hint = 0;
Johan Hedberg7a828902011-04-28 11:28:53 -07004152 struct hci_conn *conn;
Johan Hedberga5c29682011-02-19 12:05:57 -03004153
4154 BT_DBG("%s", hdev->name);
4155
4156 hci_dev_lock(hdev);
4157
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004158 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg7a828902011-04-28 11:28:53 -07004159 goto unlock;
Johan Hedberga5c29682011-02-19 12:05:57 -03004160
Johan Hedberg7a828902011-04-28 11:28:53 -07004161 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4162 if (!conn)
4163 goto unlock;
4164
4165 loc_mitm = (conn->auth_type & 0x01);
4166 rem_mitm = (conn->remote_auth & 0x01);
4167
4168 /* If we require MITM but the remote device can't provide that
Johan Hedberg6c538232014-07-11 15:32:23 +03004169 * (it has NoInputNoOutput) then reject the confirmation
4170 * request. We check the security level here since it doesn't
4171 * necessarily match conn->auth_type.
Mikel Astiz6fd6b912014-04-08 14:21:32 +02004172 */
Johan Hedberg6c538232014-07-11 15:32:23 +03004173 if (conn->pending_sec_level > BT_SECURITY_MEDIUM &&
4174 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
Johan Hedberg7a828902011-04-28 11:28:53 -07004175 BT_DBG("Rejecting request: remote device can't provide MITM");
4176 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004177 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07004178 goto unlock;
4179 }
4180
4181 /* If no side requires MITM protection; auto-accept */
Mikel Astiza7676312013-06-28 10:56:29 +02004182 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
4183 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004184
4185 /* If we're not the initiators request authorization to
4186 * proceed from user space (mgmt_user_confirm with
Johan Hedbergba15a582014-06-09 13:58:14 +03004187 * confirm_hint set to 1). The exception is if neither
Johan Hedberg02f3e252014-07-16 15:09:13 +03004188 * side had MITM or if the local IO capability is
4189 * NoInputNoOutput, in which case we do auto-accept
Johan Hedbergba15a582014-06-09 13:58:14 +03004190 */
4191 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
Johan Hedberg02f3e252014-07-16 15:09:13 +03004192 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
Johan Hedbergba15a582014-06-09 13:58:14 +03004193 (loc_mitm || rem_mitm)) {
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004194 BT_DBG("Confirming auto-accept as acceptor");
4195 confirm_hint = 1;
4196 goto confirm;
4197 }
4198
Johan Hedberg9f616562011-04-28 11:28:54 -07004199 BT_DBG("Auto-accept of user confirmation with %ums delay",
Gustavo Padovan807deac2012-05-17 00:36:24 -03004200 hdev->auto_accept_delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07004201
4202 if (hdev->auto_accept_delay > 0) {
4203 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
Johan Hedberg7bc18d92013-10-16 18:11:39 +03004204 queue_delayed_work(conn->hdev->workqueue,
4205 &conn->auto_accept_work, delay);
Johan Hedberg9f616562011-04-28 11:28:54 -07004206 goto unlock;
4207 }
4208
Johan Hedberg7a828902011-04-28 11:28:53 -07004209 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
Gustavo Padovan807deac2012-05-17 00:36:24 -03004210 sizeof(ev->bdaddr), &ev->bdaddr);
Johan Hedberg7a828902011-04-28 11:28:53 -07004211 goto unlock;
4212 }
4213
Johan Hedberg55bc1a32011-04-28 11:28:56 -07004214confirm:
Johan Hedberg39adbff2014-03-20 08:18:14 +02004215 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
4216 le32_to_cpu(ev->passkey), confirm_hint);
Johan Hedberg7a828902011-04-28 11:28:53 -07004217
4218unlock:
Johan Hedberga5c29682011-02-19 12:05:57 -03004219 hci_dev_unlock(hdev);
4220}
4221
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004222static void hci_user_passkey_request_evt(struct hci_dev *hdev,
4223 struct sk_buff *skb)
Brian Gix1143d452011-11-23 08:28:34 -08004224{
4225 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
4226
4227 BT_DBG("%s", hdev->name);
4228
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004229 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg272d90d2012-02-09 15:26:12 +02004230 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
Brian Gix1143d452011-11-23 08:28:34 -08004231}
4232
Johan Hedberg92a25252012-09-06 18:39:26 +03004233static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
4234 struct sk_buff *skb)
4235{
4236 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
4237 struct hci_conn *conn;
4238
4239 BT_DBG("%s", hdev->name);
4240
4241 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4242 if (!conn)
4243 return;
4244
4245 conn->passkey_notify = __le32_to_cpu(ev->passkey);
4246 conn->passkey_entered = 0;
4247
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004248 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg92a25252012-09-06 18:39:26 +03004249 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
4250 conn->dst_type, conn->passkey_notify,
4251 conn->passkey_entered);
4252}
4253
4254static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
4255{
4256 struct hci_ev_keypress_notify *ev = (void *) skb->data;
4257 struct hci_conn *conn;
4258
4259 BT_DBG("%s", hdev->name);
4260
4261 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4262 if (!conn)
4263 return;
4264
4265 switch (ev->type) {
4266 case HCI_KEYPRESS_STARTED:
4267 conn->passkey_entered = 0;
4268 return;
4269
4270 case HCI_KEYPRESS_ENTERED:
4271 conn->passkey_entered++;
4272 break;
4273
4274 case HCI_KEYPRESS_ERASED:
4275 conn->passkey_entered--;
4276 break;
4277
4278 case HCI_KEYPRESS_CLEARED:
4279 conn->passkey_entered = 0;
4280 break;
4281
4282 case HCI_KEYPRESS_COMPLETED:
4283 return;
4284 }
4285
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004286 if (hci_dev_test_flag(hdev, HCI_MGMT))
Johan Hedberg92a25252012-09-06 18:39:26 +03004287 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
4288 conn->dst_type, conn->passkey_notify,
4289 conn->passkey_entered);
4290}
4291
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004292static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
4293 struct sk_buff *skb)
Marcel Holtmann04936842008-07-14 20:13:48 +02004294{
4295 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
4296 struct hci_conn *conn;
4297
4298 BT_DBG("%s", hdev->name);
4299
4300 hci_dev_lock(hdev);
4301
4302 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
Johan Hedberg2a611692011-02-19 12:06:00 -03004303 if (!conn)
4304 goto unlock;
Marcel Holtmann04936842008-07-14 20:13:48 +02004305
Johan Hedbergc1d4fa72014-07-17 15:14:50 +03004306 /* Reset the authentication requirement to unknown */
4307 conn->remote_auth = 0xff;
4308
Johan Hedberg2a611692011-02-19 12:06:00 -03004309 /* To avoid duplicate auth_failed events to user space we check
4310 * the HCI_CONN_AUTH_PEND flag which will be set if we
4311 * initiated the authentication. A traditional auth_complete
4312 * event gets always produced as initiator and is also mapped to
4313 * the mgmt_auth_failed event */
Mikel Astizfa1bd912012-08-09 09:52:29 +02004314 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
Johan Hedberge1e930f2014-09-08 17:09:49 -07004315 mgmt_auth_failed(conn, ev->status);
Johan Hedberg2a611692011-02-19 12:06:00 -03004316
David Herrmann76a68ba2013-04-06 20:28:37 +02004317 hci_conn_drop(conn);
Johan Hedberg2a611692011-02-19 12:06:00 -03004318
4319unlock:
Marcel Holtmann04936842008-07-14 20:13:48 +02004320 hci_dev_unlock(hdev);
4321}
4322
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004323static void hci_remote_host_features_evt(struct hci_dev *hdev,
4324 struct sk_buff *skb)
Marcel Holtmann41a96212008-07-14 20:13:48 +02004325{
4326 struct hci_ev_remote_host_features *ev = (void *) skb->data;
4327 struct inquiry_entry *ie;
Johan Hedbergcad718e2013-04-17 15:00:51 +03004328 struct hci_conn *conn;
Marcel Holtmann41a96212008-07-14 20:13:48 +02004329
4330 BT_DBG("%s", hdev->name);
4331
4332 hci_dev_lock(hdev);
4333
Johan Hedbergcad718e2013-04-17 15:00:51 +03004334 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4335 if (conn)
4336 memcpy(conn->features[1], ev->features, 8);
4337
Andrei Emeltchenkocc11b9c2010-11-22 13:21:37 +02004338 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
4339 if (ie)
Johan Hedberg02b7cc62012-02-28 02:28:43 +02004340 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
Marcel Holtmann41a96212008-07-14 20:13:48 +02004341
4342 hci_dev_unlock(hdev);
4343}
4344
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004345static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
4346 struct sk_buff *skb)
Szymon Janc2763eda2011-03-22 13:12:22 +01004347{
4348 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
4349 struct oob_data *data;
4350
4351 BT_DBG("%s", hdev->name);
4352
4353 hci_dev_lock(hdev);
4354
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004355 if (!hci_dev_test_flag(hdev, HCI_MGMT))
Szymon Jance1ba1f12011-04-06 13:01:59 +02004356 goto unlock;
4357
Johan Hedberg6928a922014-10-26 20:46:09 +01004358 data = hci_find_remote_oob_data(hdev, &ev->bdaddr, BDADDR_BREDR);
Marcel Holtmann6665d052015-01-27 16:04:31 -08004359 if (!data) {
Szymon Janc2763eda2011-03-22 13:12:22 +01004360 struct hci_cp_remote_oob_data_neg_reply cp;
4361
4362 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmann519ca9d2014-01-10 02:07:28 -08004363 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
4364 sizeof(cp), &cp);
Marcel Holtmann6665d052015-01-27 16:04:31 -08004365 goto unlock;
4366 }
4367
4368 if (bredr_sc_enabled(hdev)) {
4369 struct hci_cp_remote_oob_ext_data_reply cp;
4370
4371 bacpy(&cp.bdaddr, &ev->bdaddr);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004372 if (hci_dev_test_flag(hdev, HCI_SC_ONLY)) {
Marcel Holtmann6665d052015-01-27 16:04:31 -08004373 memset(cp.hash192, 0, sizeof(cp.hash192));
4374 memset(cp.rand192, 0, sizeof(cp.rand192));
4375 } else {
4376 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
4377 memcpy(cp.rand192, data->rand192, sizeof(cp.rand192));
4378 }
4379 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
4380 memcpy(cp.rand256, data->rand256, sizeof(cp.rand256));
4381
4382 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
4383 sizeof(cp), &cp);
4384 } else {
4385 struct hci_cp_remote_oob_data_reply cp;
4386
4387 bacpy(&cp.bdaddr, &ev->bdaddr);
4388 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
4389 memcpy(cp.rand, data->rand192, sizeof(cp.rand));
4390
4391 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
4392 sizeof(cp), &cp);
Szymon Janc2763eda2011-03-22 13:12:22 +01004393 }
4394
Szymon Jance1ba1f12011-04-06 13:01:59 +02004395unlock:
Szymon Janc2763eda2011-03-22 13:12:22 +01004396 hci_dev_unlock(hdev);
4397}
4398
Arron Wanga77a6a12015-07-24 17:13:15 +08004399#if IS_ENABLED(CONFIG_BT_HS)
4400static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
4401{
4402 struct hci_ev_channel_selected *ev = (void *)skb->data;
4403 struct hci_conn *hcon;
4404
4405 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
4406
4407 skb_pull(skb, sizeof(*ev));
4408
4409 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4410 if (!hcon)
4411 return;
4412
4413 amp_read_loc_assoc_final_data(hdev, hcon);
4414}
4415
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004416static void hci_phy_link_complete_evt(struct hci_dev *hdev,
4417 struct sk_buff *skb)
4418{
4419 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
4420 struct hci_conn *hcon, *bredr_hcon;
4421
4422 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
4423 ev->status);
4424
4425 hci_dev_lock(hdev);
4426
4427 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4428 if (!hcon) {
4429 hci_dev_unlock(hdev);
4430 return;
4431 }
4432
4433 if (ev->status) {
4434 hci_conn_del(hcon);
4435 hci_dev_unlock(hdev);
4436 return;
4437 }
4438
4439 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
4440
4441 hcon->state = BT_CONNECTED;
4442 bacpy(&hcon->dst, &bredr_hcon->dst);
4443
4444 hci_conn_hold(hcon);
4445 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
David Herrmann76a68ba2013-04-06 20:28:37 +02004446 hci_conn_drop(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004447
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01004448 hci_debugfs_create_conn(hcon);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004449 hci_conn_add_sysfs(hcon);
4450
Andrei Emeltchenkocf70ff22012-10-31 15:46:36 +02004451 amp_physical_cfm(bredr_hcon, hcon);
4452
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004453 hci_dev_unlock(hdev);
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03004454}
4455
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03004456static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
4457{
4458 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
4459 struct hci_conn *hcon;
4460 struct hci_chan *hchan;
4461 struct amp_mgr *mgr;
4462
4463 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
4464 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
4465 ev->status);
4466
4467 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4468 if (!hcon)
4469 return;
4470
4471 /* Create AMP hchan */
4472 hchan = hci_chan_create(hcon);
4473 if (!hchan)
4474 return;
4475
4476 hchan->handle = le16_to_cpu(ev->handle);
4477
4478 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
4479
4480 mgr = hcon->amp_mgr;
4481 if (mgr && mgr->bredr_chan) {
4482 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
4483
4484 l2cap_chan_lock(bredr_chan);
4485
4486 bredr_chan->conn->mtu = hdev->block_mtu;
4487 l2cap_logical_cfm(bredr_chan, hchan, 0);
4488 hci_conn_hold(hcon);
4489
4490 l2cap_chan_unlock(bredr_chan);
4491 }
4492}
4493
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02004494static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
4495 struct sk_buff *skb)
4496{
4497 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
4498 struct hci_chan *hchan;
4499
4500 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
4501 le16_to_cpu(ev->handle), ev->status);
4502
4503 if (ev->status)
4504 return;
4505
4506 hci_dev_lock(hdev);
4507
4508 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
4509 if (!hchan)
4510 goto unlock;
4511
4512 amp_destroy_logical_link(hchan, ev->reason);
4513
4514unlock:
4515 hci_dev_unlock(hdev);
4516}
4517
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02004518static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
4519 struct sk_buff *skb)
4520{
4521 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
4522 struct hci_conn *hcon;
4523
4524 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4525
4526 if (ev->status)
4527 return;
4528
4529 hci_dev_lock(hdev);
4530
4531 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4532 if (hcon) {
4533 hcon->state = BT_CLOSED;
4534 hci_conn_del(hcon);
4535 }
4536
4537 hci_dev_unlock(hdev);
4538}
Arron Wanga77a6a12015-07-24 17:13:15 +08004539#endif
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02004540
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004541static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03004542{
4543 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
Johan Hedberg912b42ef2014-07-03 19:33:49 +03004544 struct hci_conn_params *params;
Ville Tervofcd89c02011-02-10 22:38:47 -03004545 struct hci_conn *conn;
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02004546 struct smp_irk *irk;
Johan Hedberg837d5022014-07-02 09:36:22 +03004547 u8 addr_type;
Ville Tervofcd89c02011-02-10 22:38:47 -03004548
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03004549 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
Ville Tervofcd89c02011-02-10 22:38:47 -03004550
4551 hci_dev_lock(hdev);
4552
Johan Hedbergfbd96c12014-07-08 17:21:51 +03004553 /* All controllers implicitly stop advertising in the event of a
4554 * connection, so ensure that the state bit is cleared.
4555 */
Marcel Holtmanna358dc12015-03-13 02:11:02 -07004556 hci_dev_clear_flag(hdev, HCI_LE_ADV);
Johan Hedbergfbd96c12014-07-08 17:21:51 +03004557
Andre Guedesb47a09b2012-07-27 15:10:15 -03004558 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
Ville Tervob62f3282011-02-10 22:38:50 -03004559 if (!conn) {
Johan Hedberga5c4e302014-07-16 11:56:07 +03004560 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr, ev->role);
Ville Tervob62f3282011-02-10 22:38:50 -03004561 if (!conn) {
4562 BT_ERR("No memory for new connection");
Andre Guedes230fd162012-07-27 15:10:10 -03004563 goto unlock;
Ville Tervob62f3282011-02-10 22:38:50 -03004564 }
Andre Guedes29b79882011-05-31 14:20:54 -03004565
4566 conn->dst_type = ev->bdaddr_type;
Andre Guedesb9b343d2012-07-27 15:10:11 -03004567
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004568 /* If we didn't have a hci_conn object previously
4569 * but we're in master role this must be something
4570 * initiated using a white list. Since white list based
4571 * connections are not "first class citizens" we don't
4572 * have full tracking of them. Therefore, we go ahead
4573 * with a "best effort" approach of determining the
4574 * initiator address based on the HCI_PRIVACY flag.
4575 */
4576 if (conn->out) {
4577 conn->resp_addr_type = ev->bdaddr_type;
4578 bacpy(&conn->resp_addr, &ev->bdaddr);
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004579 if (hci_dev_test_flag(hdev, HCI_PRIVACY)) {
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004580 conn->init_addr_type = ADDR_LE_DEV_RANDOM;
4581 bacpy(&conn->init_addr, &hdev->rpa);
4582 } else {
4583 hci_copy_identity_address(hdev,
4584 &conn->init_addr,
4585 &conn->init_addr_type);
4586 }
Johan Hedbergcb1d68f2014-02-28 12:54:16 +02004587 }
Johan Hedberg9489eca2014-02-28 17:45:46 +02004588 } else {
4589 cancel_delayed_work(&conn->le_conn_timeout);
Ville Tervob62f3282011-02-10 22:38:50 -03004590 }
Ville Tervofcd89c02011-02-10 22:38:47 -03004591
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004592 if (!conn->out) {
4593 /* Set the responder (our side) address type based on
4594 * the advertising address type.
4595 */
4596 conn->resp_addr_type = hdev->adv_addr_type;
4597 if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM)
4598 bacpy(&conn->resp_addr, &hdev->random_addr);
4599 else
4600 bacpy(&conn->resp_addr, &hdev->bdaddr);
4601
4602 conn->init_addr_type = ev->bdaddr_type;
4603 bacpy(&conn->init_addr, &ev->bdaddr);
Marcel Holtmanna720d732014-06-23 12:14:51 +02004604
4605 /* For incoming connections, set the default minimum
4606 * and maximum connection interval. They will be used
4607 * to check if the parameters are in range and if not
4608 * trigger the connection update procedure.
4609 */
4610 conn->le_conn_min_interval = hdev->le_conn_min_interval;
4611 conn->le_conn_max_interval = hdev->le_conn_max_interval;
Johan Hedberg80c24ab2014-03-24 20:21:51 +02004612 }
Johan Hedberg7be2edb2014-02-23 19:42:17 +02004613
Marcel Holtmannedb4b462014-02-18 15:13:43 -08004614 /* Lookup the identity address from the stored connection
4615 * address and address type.
4616 *
4617 * When establishing connections to an identity address, the
4618 * connection procedure will store the resolvable random
4619 * address first. Now if it can be converted back into the
4620 * identity address, start using the identity address from
4621 * now on.
4622 */
4623 irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
Johan Hedberg68d6f6d2014-02-18 21:41:32 +02004624 if (irk) {
4625 bacpy(&conn->dst, &irk->bdaddr);
4626 conn->dst_type = irk->addr_type;
4627 }
4628
Johan Hedberg2d3c2262014-07-15 11:51:28 +03004629 if (ev->status) {
4630 hci_le_conn_failed(conn, ev->status);
Johan Hedberg837d5022014-07-02 09:36:22 +03004631 goto unlock;
4632 }
4633
Johan Hedberg08853f12014-08-15 21:06:55 +03004634 if (conn->dst_type == ADDR_LE_DEV_PUBLIC)
4635 addr_type = BDADDR_LE_PUBLIC;
4636 else
4637 addr_type = BDADDR_LE_RANDOM;
4638
Johan Hedberg2d3c2262014-07-15 11:51:28 +03004639 /* Drop the connection if the device is blocked */
4640 if (hci_bdaddr_list_lookup(&hdev->blacklist, &conn->dst, addr_type)) {
4641 hci_conn_drop(conn);
Andre Guedescd17dec2012-07-27 15:10:16 -03004642 goto unlock;
4643 }
4644
Johan Hedbergb644ba32012-01-17 21:48:47 +02004645 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
Alfonso Acosta48ec92f2014-10-07 08:44:10 +00004646 mgmt_device_connected(hdev, conn, 0, NULL, 0);
Vinicius Costa Gomes83bc71b2011-05-06 18:41:43 -03004647
Vinicius Costa Gomes7b5c0d52011-06-09 18:50:50 -03004648 conn->sec_level = BT_SECURITY_LOW;
Ville Tervofcd89c02011-02-10 22:38:47 -03004649 conn->handle = __le16_to_cpu(ev->handle);
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07004650 conn->state = BT_CONFIG;
Ville Tervofcd89c02011-02-10 22:38:47 -03004651
Marcel Holtmanne04fde62014-06-23 11:40:04 +02004652 conn->le_conn_interval = le16_to_cpu(ev->interval);
4653 conn->le_conn_latency = le16_to_cpu(ev->latency);
4654 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4655
Marcel Holtmann23b9ceb2014-12-20 17:13:41 +01004656 hci_debugfs_create_conn(conn);
Ville Tervofcd89c02011-02-10 22:38:47 -03004657 hci_conn_add_sysfs(conn);
4658
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07004659 if (!ev->status) {
4660 /* The remote features procedure is defined for master
4661 * role only. So only in case of an initiated connection
4662 * request the remote features.
4663 *
4664 * If the local controller supports slave-initiated features
4665 * exchange, then requesting the remote features in slave
4666 * role is possible. Otherwise just transition into the
4667 * connected state without requesting the remote features.
4668 */
4669 if (conn->out ||
4670 (hdev->le_features[0] & HCI_LE_SLAVE_FEATURES)) {
4671 struct hci_cp_le_read_remote_features cp;
4672
4673 cp.handle = __cpu_to_le16(conn->handle);
4674
4675 hci_send_cmd(hdev, HCI_OP_LE_READ_REMOTE_FEATURES,
4676 sizeof(cp), &cp);
4677
4678 hci_conn_hold(conn);
4679 } else {
4680 conn->state = BT_CONNECTED;
4681 hci_connect_cfm(conn, ev->status);
4682 }
4683 } else {
4684 hci_connect_cfm(conn, ev->status);
4685 }
Ville Tervofcd89c02011-02-10 22:38:47 -03004686
Johan Hedberg54776102014-08-15 21:06:56 +03004687 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
4688 conn->dst_type);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004689 if (params) {
Johan Hedberg95305ba2014-07-04 12:37:21 +03004690 list_del_init(&params->action);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004691 if (params->conn) {
4692 hci_conn_drop(params->conn);
Johan Hedbergf8aaf9b2014-08-17 23:28:57 +03004693 hci_conn_put(params->conn);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004694 params->conn = NULL;
4695 }
4696 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004697
Ville Tervofcd89c02011-02-10 22:38:47 -03004698unlock:
Johan Hedberg223683a2014-07-06 15:44:23 +03004699 hci_update_background_scan(hdev);
Ville Tervofcd89c02011-02-10 22:38:47 -03004700 hci_dev_unlock(hdev);
4701}
4702
Marcel Holtmann1855d922014-06-23 11:40:05 +02004703static void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
4704 struct sk_buff *skb)
4705{
4706 struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
4707 struct hci_conn *conn;
4708
4709 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4710
4711 if (ev->status)
4712 return;
4713
4714 hci_dev_lock(hdev);
4715
4716 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4717 if (conn) {
4718 conn->le_conn_interval = le16_to_cpu(ev->interval);
4719 conn->le_conn_latency = le16_to_cpu(ev->latency);
4720 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4721 }
4722
4723 hci_dev_unlock(hdev);
4724}
4725
Andre Guedesa4790db2014-02-26 20:21:47 -03004726/* This function requires the caller holds hdev->lock */
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004727static struct hci_conn *check_pending_le_conn(struct hci_dev *hdev,
4728 bdaddr_t *addr,
4729 u8 addr_type, u8 adv_type)
Andre Guedesa4790db2014-02-26 20:21:47 -03004730{
4731 struct hci_conn *conn;
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004732 struct hci_conn_params *params;
Andre Guedesa4790db2014-02-26 20:21:47 -03004733
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004734 /* If the event is not connectable don't proceed further */
4735 if (adv_type != LE_ADV_IND && adv_type != LE_ADV_DIRECT_IND)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004736 return NULL;
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004737
4738 /* Ignore if the device is blocked */
Johan Hedbergdcc36c12014-07-09 12:59:13 +03004739 if (hci_bdaddr_list_lookup(&hdev->blacklist, addr, addr_type))
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004740 return NULL;
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004741
Johan Hedbergf99353c2014-07-16 11:56:09 +03004742 /* Most controller will fail if we try to create new connections
4743 * while we have an existing one in slave role.
4744 */
4745 if (hdev->conn_hash.le_num_slave > 0)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004746 return NULL;
Johan Hedbergf99353c2014-07-16 11:56:09 +03004747
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004748 /* If we're not connectable only connect devices that we have in
4749 * our pend_le_conns list.
4750 */
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004751 params = hci_pend_le_action_lookup(&hdev->pend_le_conns,
4752 addr, addr_type);
4753 if (!params)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004754 return NULL;
Andre Guedesa4790db2014-02-26 20:21:47 -03004755
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004756 switch (params->auto_connect) {
4757 case HCI_AUTO_CONN_DIRECT:
4758 /* Only devices advertising with ADV_DIRECT_IND are
4759 * triggering a connection attempt. This is allowing
4760 * incoming connections from slave devices.
4761 */
4762 if (adv_type != LE_ADV_DIRECT_IND)
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004763 return NULL;
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004764 break;
4765 case HCI_AUTO_CONN_ALWAYS:
4766 /* Devices advertising with ADV_IND or ADV_DIRECT_IND
4767 * are triggering a connection attempt. This means
4768 * that incoming connectioms from slave device are
4769 * accepted and also outgoing connections to slave
4770 * devices are established when found.
4771 */
4772 break;
4773 default:
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004774 return NULL;
Marcel Holtmann4b9e7e72014-07-23 21:55:23 +02004775 }
4776
Andre Guedesa4790db2014-02-26 20:21:47 -03004777 conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
Johan Hedberge804d252014-07-16 11:42:28 +03004778 HCI_LE_AUTOCONN_TIMEOUT, HCI_ROLE_MASTER);
Johan Hedbergf161dd42014-08-15 21:06:54 +03004779 if (!IS_ERR(conn)) {
4780 /* Store the pointer since we don't really have any
4781 * other owner of the object besides the params that
4782 * triggered it. This way we can abort the connection if
4783 * the parameters get removed and keep the reference
4784 * count consistent once the connection is established.
4785 */
Johan Hedbergf8aaf9b2014-08-17 23:28:57 +03004786 params->conn = hci_conn_get(conn);
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004787 return conn;
Johan Hedbergf161dd42014-08-15 21:06:54 +03004788 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004789
4790 switch (PTR_ERR(conn)) {
4791 case -EBUSY:
4792 /* If hci_connect() returns -EBUSY it means there is already
4793 * an LE connection attempt going on. Since controllers don't
4794 * support more than one connection attempt at the time, we
4795 * don't consider this an error case.
4796 */
4797 break;
4798 default:
4799 BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004800 return NULL;
Andre Guedesa4790db2014-02-26 20:21:47 -03004801 }
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004802
4803 return NULL;
Andre Guedesa4790db2014-02-26 20:21:47 -03004804}
4805
Johan Hedberg4af605d2014-03-24 10:48:00 +02004806static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004807 u8 bdaddr_type, bdaddr_t *direct_addr,
4808 u8 direct_addr_type, s8 rssi, u8 *data, u8 len)
Johan Hedberg4af605d2014-03-24 10:48:00 +02004809{
Johan Hedbergb9a63282014-03-25 10:51:52 +02004810 struct discovery_state *d = &hdev->discovery;
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004811 struct smp_irk *irk;
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004812 struct hci_conn *conn;
Johan Hedberg474ee062014-03-25 14:34:59 +02004813 bool match;
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004814 u32 flags;
Johan Hedbergb9a63282014-03-25 10:51:52 +02004815
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004816 /* If the direct address is present, then this report is from
4817 * a LE Direct Advertising Report event. In that case it is
4818 * important to see if the address is matching the local
4819 * controller address.
4820 */
4821 if (direct_addr) {
4822 /* Only resolvable random addresses are valid for these
4823 * kind of reports and others can be ignored.
4824 */
4825 if (!hci_bdaddr_is_rpa(direct_addr, direct_addr_type))
4826 return;
4827
4828 /* If the controller is not using resolvable random
4829 * addresses, then this report can be ignored.
4830 */
Marcel Holtmannd7a5a112015-03-13 02:11:00 -07004831 if (!hci_dev_test_flag(hdev, HCI_PRIVACY))
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004832 return;
4833
4834 /* If the local IRK of the controller does not match
4835 * with the resolvable random address provided, then
4836 * this report can be ignored.
4837 */
4838 if (!smp_irk_matches(hdev, hdev->irk, direct_addr))
4839 return;
4840 }
4841
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004842 /* Check if we need to convert to identity address */
4843 irk = hci_get_irk(hdev, bdaddr, bdaddr_type);
4844 if (irk) {
4845 bdaddr = &irk->bdaddr;
4846 bdaddr_type = irk->addr_type;
4847 }
4848
4849 /* Check if we have been requested to connect to this device */
Alfonso Acostafd45ada2014-10-07 08:44:11 +00004850 conn = check_pending_le_conn(hdev, bdaddr, bdaddr_type, type);
4851 if (conn && type == LE_ADV_IND) {
4852 /* Store report for later inclusion by
4853 * mgmt_device_connected
4854 */
4855 memcpy(conn->le_adv_data, data, len);
4856 conn->le_adv_data_len = len;
4857 }
Johan Hedberg1c1abca2014-07-07 12:45:53 +03004858
Johan Hedberg0d2bf132014-07-02 22:42:02 +03004859 /* Passive scanning shouldn't trigger any device found events,
4860 * except for devices marked as CONN_REPORT for which we do send
4861 * device found events.
4862 */
Johan Hedbergca5c4be2014-03-25 10:30:46 +02004863 if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
Johan Hedberg0d2bf132014-07-02 22:42:02 +03004864 if (type == LE_ADV_DIRECT_IND)
4865 return;
4866
Johan Hedberg3a19b6f2014-07-15 08:07:59 +03004867 if (!hci_pend_le_action_lookup(&hdev->pend_le_reports,
4868 bdaddr, bdaddr_type))
Johan Hedberg0d2bf132014-07-02 22:42:02 +03004869 return;
4870
4871 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND)
4872 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4873 else
4874 flags = 0;
4875 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4876 rssi, flags, data, len, NULL, 0);
Johan Hedberg97bf2e92014-07-04 12:37:16 +03004877 return;
Johan Hedbergca5c4be2014-03-25 10:30:46 +02004878 }
Johan Hedberg4af605d2014-03-24 10:48:00 +02004879
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004880 /* When receiving non-connectable or scannable undirected
4881 * advertising reports, this means that the remote device is
4882 * not connectable and then clearly indicate this in the
4883 * device found event.
4884 *
4885 * When receiving a scan response, then there is no way to
4886 * know if the remote device is connectable or not. However
4887 * since scan responses are merged with a previously seen
4888 * advertising report, the flags field from that report
4889 * will be used.
4890 *
4891 * In the really unlikely case that a controller get confused
4892 * and just sends a scan response event, then it is marked as
4893 * not connectable as well.
4894 */
4895 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND ||
4896 type == LE_ADV_SCAN_RSP)
4897 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4898 else
4899 flags = 0;
4900
Johan Hedbergb9a63282014-03-25 10:51:52 +02004901 /* If there's nothing pending either store the data from this
4902 * event or send an immediate device found event if the data
4903 * should not be stored for later.
4904 */
4905 if (!has_pending_adv_report(hdev)) {
4906 /* If the report will trigger a SCAN_REQ store it for
4907 * later merging.
4908 */
4909 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4910 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004911 rssi, flags, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004912 return;
4913 }
4914
4915 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004916 rssi, flags, data, len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004917 return;
4918 }
4919
Johan Hedberg474ee062014-03-25 14:34:59 +02004920 /* Check if the pending report is for the same device as the new one */
4921 match = (!bacmp(bdaddr, &d->last_adv_addr) &&
4922 bdaddr_type == d->last_adv_addr_type);
4923
Johan Hedbergb9a63282014-03-25 10:51:52 +02004924 /* If the pending data doesn't match this report or this isn't a
4925 * scan response (e.g. we got a duplicate ADV_IND) then force
4926 * sending of the pending data.
4927 */
Johan Hedberg474ee062014-03-25 14:34:59 +02004928 if (type != LE_ADV_SCAN_RSP || !match) {
4929 /* Send out whatever is in the cache, but skip duplicates */
4930 if (!match)
4931 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004932 d->last_adv_addr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004933 d->last_adv_rssi, d->last_adv_flags,
Johan Hedbergff5cd292014-03-25 14:40:52 +02004934 d->last_adv_data,
Johan Hedberg474ee062014-03-25 14:34:59 +02004935 d->last_adv_data_len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004936
4937 /* If the new report will trigger a SCAN_REQ store it for
4938 * later merging.
4939 */
4940 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4941 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004942 rssi, flags, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004943 return;
4944 }
4945
4946 /* The advertising reports cannot be merged, so clear
4947 * the pending report and send out a device found event.
4948 */
4949 clear_pending_adv_report(hdev);
Johan Hedberg5c5b93e2014-03-29 08:39:53 +02004950 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004951 rssi, flags, data, len, NULL, 0);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004952 return;
4953 }
4954
4955 /* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
4956 * the new event is a SCAN_RSP. We can therefore proceed with
4957 * sending a merged device found event.
4958 */
4959 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
Marcel Holtmannc70a7e42014-07-01 14:11:21 +02004960 d->last_adv_addr_type, NULL, rssi, d->last_adv_flags,
Marcel Holtmann42bd6a52014-07-01 14:11:19 +02004961 d->last_adv_data, d->last_adv_data_len, data, len);
Johan Hedbergb9a63282014-03-25 10:51:52 +02004962 clear_pending_adv_report(hdev);
Johan Hedberg4af605d2014-03-24 10:48:00 +02004963}
4964
Gustavo Padovan6039aa72012-05-23 04:04:18 -03004965static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
Andre Guedes9aa04c92011-05-26 16:23:51 -03004966{
Andre Guedese95beb42011-09-26 20:48:35 -03004967 u8 num_reports = skb->data[0];
4968 void *ptr = &skb->data[1];
Andre Guedes9aa04c92011-05-26 16:23:51 -03004969
Andre Guedesa4790db2014-02-26 20:21:47 -03004970 hci_dev_lock(hdev);
4971
Andre Guedese95beb42011-09-26 20:48:35 -03004972 while (num_reports--) {
4973 struct hci_ev_le_advertising_info *ev = ptr;
Johan Hedberg4af605d2014-03-24 10:48:00 +02004974 s8 rssi;
Andre Guedesa4790db2014-02-26 20:21:47 -03004975
Andre Guedes3c9e9192012-01-10 18:20:50 -03004976 rssi = ev->data[ev->length];
Johan Hedberg4af605d2014-03-24 10:48:00 +02004977 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
Marcel Holtmann2f010b52014-12-05 16:20:13 +01004978 ev->bdaddr_type, NULL, 0, rssi,
4979 ev->data, ev->length);
Andre Guedes3c9e9192012-01-10 18:20:50 -03004980
Andre Guedese95beb42011-09-26 20:48:35 -03004981 ptr += sizeof(*ev) + ev->length + 1;
Andre Guedes9aa04c92011-05-26 16:23:51 -03004982 }
Andre Guedesa4790db2014-02-26 20:21:47 -03004983
4984 hci_dev_unlock(hdev);
Andre Guedes9aa04c92011-05-26 16:23:51 -03004985}
4986
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07004987static void hci_le_remote_feat_complete_evt(struct hci_dev *hdev,
4988 struct sk_buff *skb)
4989{
4990 struct hci_ev_le_remote_feat_complete *ev = (void *)skb->data;
4991 struct hci_conn *conn;
4992
4993 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4994
4995 hci_dev_lock(hdev);
4996
4997 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4998 if (conn) {
4999 if (!ev->status)
5000 memcpy(conn->features[0], ev->features, 8);
5001
5002 if (conn->state == BT_CONFIG) {
5003 __u8 status;
5004
5005 /* If the local controller supports slave-initiated
5006 * features exchange, but the remote controller does
5007 * not, then it is possible that the error code 0x1a
5008 * for unsupported remote feature gets returned.
5009 *
5010 * In this specific case, allow the connection to
5011 * transition into connected state and mark it as
5012 * successful.
5013 */
5014 if ((hdev->le_features[0] & HCI_LE_SLAVE_FEATURES) &&
5015 !conn->out && ev->status == 0x1a)
5016 status = 0x00;
5017 else
5018 status = ev->status;
5019
5020 conn->state = BT_CONNECTED;
5021 hci_connect_cfm(conn, status);
5022 hci_conn_drop(conn);
5023 }
5024 }
5025
5026 hci_dev_unlock(hdev);
5027}
5028
Gustavo Padovan6039aa72012-05-23 04:04:18 -03005029static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005030{
5031 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
5032 struct hci_cp_le_ltk_reply cp;
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03005033 struct hci_cp_le_ltk_neg_reply neg;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005034 struct hci_conn *conn;
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03005035 struct smp_ltk *ltk;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005036
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03005037 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005038
5039 hci_dev_lock(hdev);
5040
5041 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03005042 if (conn == NULL)
5043 goto not_found;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005044
Johan Hedbergf3a73d92014-05-29 15:02:59 +03005045 ltk = hci_find_ltk(hdev, &conn->dst, conn->dst_type, conn->role);
Johan Hedberg5378bc52014-05-29 14:00:39 +03005046 if (!ltk)
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03005047 goto not_found;
5048
Johan Hedberg5378bc52014-05-29 14:00:39 +03005049 if (smp_ltk_is_sc(ltk)) {
5050 /* With SC both EDiv and Rand are set to zero */
5051 if (ev->ediv || ev->rand)
5052 goto not_found;
5053 } else {
5054 /* For non-SC keys check that EDiv and Rand match */
5055 if (ev->ediv != ltk->ediv || ev->rand != ltk->rand)
5056 goto not_found;
5057 }
5058
Johan Hedberg8b76ce32015-06-08 18:14:39 +03005059 memcpy(cp.ltk, ltk->val, ltk->enc_size);
5060 memset(cp.ltk + ltk->enc_size, 0, sizeof(cp.ltk) - ltk->enc_size);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005061 cp.handle = cpu_to_le16(conn->handle);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03005062
Johan Hedberga6f78332014-09-10 17:37:45 -07005063 conn->pending_sec_level = smp_ltk_sec_level(ltk);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005064
Andre Guedes89cbb4d2013-07-31 16:25:29 -03005065 conn->enc_key_size = ltk->enc_size;
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005066
5067 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
5068
Claudio Takahasi5981a882013-07-25 16:34:24 -03005069 /* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
5070 * temporary key used to encrypt a connection following
5071 * pairing. It is used during the Encrypted Session Setup to
5072 * distribute the keys. Later, security can be re-established
5073 * using a distributed LTK.
5074 */
Johan Hedberg2ceba532014-06-16 19:25:16 +03005075 if (ltk->type == SMP_STK) {
Johan Hedbergfe59a052014-07-01 19:14:12 +03005076 set_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
Johan Hedberg970d0f12014-11-13 14:37:47 +02005077 list_del_rcu(&ltk->list);
5078 kfree_rcu(ltk, rcu);
Johan Hedbergfe59a052014-07-01 19:14:12 +03005079 } else {
5080 clear_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
Vinicius Costa Gomesc9839a12012-02-02 21:08:01 -03005081 }
5082
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005083 hci_dev_unlock(hdev);
Vinicius Costa Gomesbea710f2011-07-07 18:59:37 -03005084
5085 return;
5086
5087not_found:
5088 neg.handle = ev->handle;
5089 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
5090 hci_dev_unlock(hdev);
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005091}
5092
Andre Guedes8e75b462014-07-01 18:10:08 -03005093static void send_conn_param_neg_reply(struct hci_dev *hdev, u16 handle,
5094 u8 reason)
5095{
5096 struct hci_cp_le_conn_param_req_neg_reply cp;
5097
5098 cp.handle = cpu_to_le16(handle);
5099 cp.reason = reason;
5100
5101 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_NEG_REPLY, sizeof(cp),
5102 &cp);
5103}
5104
5105static void hci_le_remote_conn_param_req_evt(struct hci_dev *hdev,
5106 struct sk_buff *skb)
5107{
5108 struct hci_ev_le_remote_conn_param_req *ev = (void *) skb->data;
5109 struct hci_cp_le_conn_param_req_reply cp;
5110 struct hci_conn *hcon;
5111 u16 handle, min, max, latency, timeout;
5112
5113 handle = le16_to_cpu(ev->handle);
5114 min = le16_to_cpu(ev->interval_min);
5115 max = le16_to_cpu(ev->interval_max);
5116 latency = le16_to_cpu(ev->latency);
5117 timeout = le16_to_cpu(ev->timeout);
5118
5119 hcon = hci_conn_hash_lookup_handle(hdev, handle);
5120 if (!hcon || hcon->state != BT_CONNECTED)
5121 return send_conn_param_neg_reply(hdev, handle,
5122 HCI_ERROR_UNKNOWN_CONN_ID);
5123
5124 if (hci_check_conn_params(min, max, latency, timeout))
5125 return send_conn_param_neg_reply(hdev, handle,
5126 HCI_ERROR_INVALID_LL_PARAMS);
5127
Johan Hedberg40bef302014-07-16 11:42:27 +03005128 if (hcon->role == HCI_ROLE_MASTER) {
Johan Hedberg348d50b2014-07-02 17:37:30 +03005129 struct hci_conn_params *params;
Johan Hedbergf4869e22014-07-02 17:37:32 +03005130 u8 store_hint;
Johan Hedberg348d50b2014-07-02 17:37:30 +03005131
5132 hci_dev_lock(hdev);
5133
5134 params = hci_conn_params_lookup(hdev, &hcon->dst,
5135 hcon->dst_type);
5136 if (params) {
5137 params->conn_min_interval = min;
5138 params->conn_max_interval = max;
5139 params->conn_latency = latency;
5140 params->supervision_timeout = timeout;
Johan Hedbergf4869e22014-07-02 17:37:32 +03005141 store_hint = 0x01;
5142 } else{
5143 store_hint = 0x00;
Johan Hedberg348d50b2014-07-02 17:37:30 +03005144 }
5145
5146 hci_dev_unlock(hdev);
5147
Johan Hedbergf4869e22014-07-02 17:37:32 +03005148 mgmt_new_conn_param(hdev, &hcon->dst, hcon->dst_type,
5149 store_hint, min, max, latency, timeout);
Johan Hedberg348d50b2014-07-02 17:37:30 +03005150 }
Andre Guedesffb5a8272014-07-01 18:10:11 -03005151
Andre Guedes8e75b462014-07-01 18:10:08 -03005152 cp.handle = ev->handle;
5153 cp.interval_min = ev->interval_min;
5154 cp.interval_max = ev->interval_max;
5155 cp.latency = ev->latency;
5156 cp.timeout = ev->timeout;
5157 cp.min_ce_len = 0;
5158 cp.max_ce_len = 0;
5159
5160 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_REPLY, sizeof(cp), &cp);
5161}
5162
Marcel Holtmann2f010b52014-12-05 16:20:13 +01005163static void hci_le_direct_adv_report_evt(struct hci_dev *hdev,
5164 struct sk_buff *skb)
5165{
5166 u8 num_reports = skb->data[0];
5167 void *ptr = &skb->data[1];
5168
5169 hci_dev_lock(hdev);
5170
5171 while (num_reports--) {
5172 struct hci_ev_le_direct_adv_info *ev = ptr;
5173
5174 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
5175 ev->bdaddr_type, &ev->direct_addr,
5176 ev->direct_addr_type, ev->rssi, NULL, 0);
5177
5178 ptr += sizeof(*ev);
5179 }
5180
5181 hci_dev_unlock(hdev);
5182}
5183
Gustavo Padovan6039aa72012-05-23 04:04:18 -03005184static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
Ville Tervofcd89c02011-02-10 22:38:47 -03005185{
5186 struct hci_ev_le_meta *le_ev = (void *) skb->data;
5187
5188 skb_pull(skb, sizeof(*le_ev));
5189
5190 switch (le_ev->subevent) {
5191 case HCI_EV_LE_CONN_COMPLETE:
5192 hci_le_conn_complete_evt(hdev, skb);
5193 break;
5194
Marcel Holtmann1855d922014-06-23 11:40:05 +02005195 case HCI_EV_LE_CONN_UPDATE_COMPLETE:
5196 hci_le_conn_update_complete_evt(hdev, skb);
5197 break;
5198
Andre Guedes9aa04c92011-05-26 16:23:51 -03005199 case HCI_EV_LE_ADVERTISING_REPORT:
5200 hci_le_adv_report_evt(hdev, skb);
5201 break;
5202
Marcel Holtmann0fe29fd2015-04-08 09:05:27 -07005203 case HCI_EV_LE_REMOTE_FEAT_COMPLETE:
5204 hci_le_remote_feat_complete_evt(hdev, skb);
5205 break;
5206
Vinicius Costa Gomesa7a595f2011-06-09 18:50:47 -03005207 case HCI_EV_LE_LTK_REQ:
5208 hci_le_ltk_request_evt(hdev, skb);
5209 break;
5210
Andre Guedes8e75b462014-07-01 18:10:08 -03005211 case HCI_EV_LE_REMOTE_CONN_PARAM_REQ:
5212 hci_le_remote_conn_param_req_evt(hdev, skb);
5213 break;
5214
Marcel Holtmann2f010b52014-12-05 16:20:13 +01005215 case HCI_EV_LE_DIRECT_ADV_REPORT:
5216 hci_le_direct_adv_report_evt(hdev, skb);
5217 break;
5218
Ville Tervofcd89c02011-02-10 22:38:47 -03005219 default:
5220 break;
5221 }
5222}
5223
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005224static bool hci_get_cmd_complete(struct hci_dev *hdev, u16 opcode,
5225 u8 event, struct sk_buff *skb)
5226{
5227 struct hci_ev_cmd_complete *ev;
5228 struct hci_event_hdr *hdr;
5229
5230 if (!skb)
5231 return false;
5232
5233 if (skb->len < sizeof(*hdr)) {
5234 BT_ERR("Too short HCI event");
5235 return false;
5236 }
5237
5238 hdr = (void *) skb->data;
5239 skb_pull(skb, HCI_EVENT_HDR_SIZE);
5240
5241 if (event) {
5242 if (hdr->evt != event)
5243 return false;
5244 return true;
5245 }
5246
5247 if (hdr->evt != HCI_EV_CMD_COMPLETE) {
5248 BT_DBG("Last event is not cmd complete (0x%2.2x)", hdr->evt);
5249 return false;
5250 }
5251
5252 if (skb->len < sizeof(*ev)) {
5253 BT_ERR("Too short cmd_complete event");
5254 return false;
5255 }
5256
5257 ev = (void *) skb->data;
5258 skb_pull(skb, sizeof(*ev));
5259
5260 if (opcode != __le16_to_cpu(ev->opcode)) {
5261 BT_DBG("opcode doesn't match (0x%2.2x != 0x%2.2x)", opcode,
5262 __le16_to_cpu(ev->opcode));
5263 return false;
5264 }
5265
5266 return true;
5267}
5268
Linus Torvalds1da177e2005-04-16 15:20:36 -07005269void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
5270{
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005271 struct hci_event_hdr *hdr = (void *) skb->data;
Johan Hedberge62144872015-04-02 13:41:08 +03005272 hci_req_complete_t req_complete = NULL;
5273 hci_req_complete_skb_t req_complete_skb = NULL;
5274 struct sk_buff *orig_skb = NULL;
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005275 u8 status = 0, event = hdr->evt, req_evt = 0;
Johan Hedberge62144872015-04-02 13:41:08 +03005276 u16 opcode = HCI_OP_NOP;
Linus Torvalds1da177e2005-04-16 15:20:36 -07005277
Johan Hedbergdb6e3e82015-03-30 23:21:02 +03005278 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
Johannes Bergc1f23a22013-10-07 18:19:16 +02005279 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
Johan Hedberge62144872015-04-02 13:41:08 +03005280 opcode = __le16_to_cpu(cmd_hdr->opcode);
5281 hci_req_cmd_complete(hdev, opcode, status, &req_complete,
5282 &req_complete_skb);
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005283 req_evt = event;
Johan Hedberg02350a72013-04-03 21:50:29 +03005284 }
5285
Johan Hedberge62144872015-04-02 13:41:08 +03005286 /* If it looks like we might end up having to call
5287 * req_complete_skb, store a pristine copy of the skb since the
5288 * various handlers may modify the original one through
5289 * skb_pull() calls, etc.
5290 */
5291 if (req_complete_skb || event == HCI_EV_CMD_STATUS ||
5292 event == HCI_EV_CMD_COMPLETE)
5293 orig_skb = skb_clone(skb, GFP_KERNEL);
5294
5295 skb_pull(skb, HCI_EVENT_HDR_SIZE);
5296
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005297 switch (event) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07005298 case HCI_EV_INQUIRY_COMPLETE:
5299 hci_inquiry_complete_evt(hdev, skb);
5300 break;
5301
5302 case HCI_EV_INQUIRY_RESULT:
5303 hci_inquiry_result_evt(hdev, skb);
5304 break;
5305
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005306 case HCI_EV_CONN_COMPLETE:
5307 hci_conn_complete_evt(hdev, skb);
Marcel Holtmann21d9e302005-09-13 01:32:25 +02005308 break;
5309
Linus Torvalds1da177e2005-04-16 15:20:36 -07005310 case HCI_EV_CONN_REQUEST:
5311 hci_conn_request_evt(hdev, skb);
5312 break;
5313
Linus Torvalds1da177e2005-04-16 15:20:36 -07005314 case HCI_EV_DISCONN_COMPLETE:
5315 hci_disconn_complete_evt(hdev, skb);
5316 break;
5317
Linus Torvalds1da177e2005-04-16 15:20:36 -07005318 case HCI_EV_AUTH_COMPLETE:
5319 hci_auth_complete_evt(hdev, skb);
5320 break;
5321
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005322 case HCI_EV_REMOTE_NAME:
5323 hci_remote_name_evt(hdev, skb);
5324 break;
5325
Linus Torvalds1da177e2005-04-16 15:20:36 -07005326 case HCI_EV_ENCRYPT_CHANGE:
5327 hci_encrypt_change_evt(hdev, skb);
5328 break;
5329
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005330 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
5331 hci_change_link_key_complete_evt(hdev, skb);
5332 break;
5333
5334 case HCI_EV_REMOTE_FEATURES:
5335 hci_remote_features_evt(hdev, skb);
5336 break;
5337
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005338 case HCI_EV_CMD_COMPLETE:
Johan Hedberge62144872015-04-02 13:41:08 +03005339 hci_cmd_complete_evt(hdev, skb, &opcode, &status,
5340 &req_complete, &req_complete_skb);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005341 break;
5342
5343 case HCI_EV_CMD_STATUS:
Johan Hedberge62144872015-04-02 13:41:08 +03005344 hci_cmd_status_evt(hdev, skb, &opcode, &status, &req_complete,
5345 &req_complete_skb);
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005346 break;
5347
Marcel Holtmann24dfa342014-11-02 02:56:41 +01005348 case HCI_EV_HARDWARE_ERROR:
5349 hci_hardware_error_evt(hdev, skb);
5350 break;
5351
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005352 case HCI_EV_ROLE_CHANGE:
5353 hci_role_change_evt(hdev, skb);
5354 break;
5355
5356 case HCI_EV_NUM_COMP_PKTS:
5357 hci_num_comp_pkts_evt(hdev, skb);
5358 break;
5359
5360 case HCI_EV_MODE_CHANGE:
5361 hci_mode_change_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005362 break;
5363
5364 case HCI_EV_PIN_CODE_REQ:
5365 hci_pin_code_request_evt(hdev, skb);
5366 break;
5367
5368 case HCI_EV_LINK_KEY_REQ:
5369 hci_link_key_request_evt(hdev, skb);
5370 break;
5371
5372 case HCI_EV_LINK_KEY_NOTIFY:
5373 hci_link_key_notify_evt(hdev, skb);
5374 break;
5375
5376 case HCI_EV_CLOCK_OFFSET:
5377 hci_clock_offset_evt(hdev, skb);
5378 break;
5379
Marcel Holtmanna8746412008-07-14 20:13:46 +02005380 case HCI_EV_PKT_TYPE_CHANGE:
5381 hci_pkt_type_change_evt(hdev, skb);
5382 break;
5383
Marcel Holtmann85a1e932005-08-09 20:28:02 -07005384 case HCI_EV_PSCAN_REP_MODE:
5385 hci_pscan_rep_mode_evt(hdev, skb);
5386 break;
5387
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005388 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
5389 hci_inquiry_result_with_rssi_evt(hdev, skb);
5390 break;
5391
5392 case HCI_EV_REMOTE_EXT_FEATURES:
5393 hci_remote_ext_features_evt(hdev, skb);
5394 break;
5395
5396 case HCI_EV_SYNC_CONN_COMPLETE:
5397 hci_sync_conn_complete_evt(hdev, skb);
5398 break;
5399
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005400 case HCI_EV_EXTENDED_INQUIRY_RESULT:
5401 hci_extended_inquiry_result_evt(hdev, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005402 break;
5403
Johan Hedberg1c2e0042012-06-08 23:31:13 +08005404 case HCI_EV_KEY_REFRESH_COMPLETE:
5405 hci_key_refresh_complete_evt(hdev, skb);
5406 break;
5407
Marcel Holtmann04936842008-07-14 20:13:48 +02005408 case HCI_EV_IO_CAPA_REQUEST:
5409 hci_io_capa_request_evt(hdev, skb);
5410 break;
5411
Johan Hedberg03b555e2011-01-04 15:40:05 +02005412 case HCI_EV_IO_CAPA_REPLY:
5413 hci_io_capa_reply_evt(hdev, skb);
5414 break;
5415
Johan Hedberga5c29682011-02-19 12:05:57 -03005416 case HCI_EV_USER_CONFIRM_REQUEST:
5417 hci_user_confirm_request_evt(hdev, skb);
5418 break;
5419
Brian Gix1143d452011-11-23 08:28:34 -08005420 case HCI_EV_USER_PASSKEY_REQUEST:
5421 hci_user_passkey_request_evt(hdev, skb);
5422 break;
5423
Johan Hedberg92a25252012-09-06 18:39:26 +03005424 case HCI_EV_USER_PASSKEY_NOTIFY:
5425 hci_user_passkey_notify_evt(hdev, skb);
5426 break;
5427
5428 case HCI_EV_KEYPRESS_NOTIFY:
5429 hci_keypress_notify_evt(hdev, skb);
5430 break;
5431
Marcel Holtmann04936842008-07-14 20:13:48 +02005432 case HCI_EV_SIMPLE_PAIR_COMPLETE:
5433 hci_simple_pair_complete_evt(hdev, skb);
5434 break;
5435
Marcel Holtmann41a96212008-07-14 20:13:48 +02005436 case HCI_EV_REMOTE_HOST_FEATURES:
5437 hci_remote_host_features_evt(hdev, skb);
5438 break;
5439
Ville Tervofcd89c02011-02-10 22:38:47 -03005440 case HCI_EV_LE_META:
5441 hci_le_meta_evt(hdev, skb);
5442 break;
5443
Szymon Janc2763eda2011-03-22 13:12:22 +01005444 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
5445 hci_remote_oob_data_request_evt(hdev, skb);
5446 break;
5447
Arron Wanga77a6a12015-07-24 17:13:15 +08005448#if IS_ENABLED(CONFIG_BT_HS)
5449 case HCI_EV_CHANNEL_SELECTED:
5450 hci_chan_selected_evt(hdev, skb);
5451 break;
5452
Andrei Emeltchenkod5e91192012-10-25 15:20:44 +03005453 case HCI_EV_PHY_LINK_COMPLETE:
5454 hci_phy_link_complete_evt(hdev, skb);
5455 break;
5456
Andrei Emeltchenko27695fb2012-10-25 15:20:45 +03005457 case HCI_EV_LOGICAL_LINK_COMPLETE:
5458 hci_loglink_complete_evt(hdev, skb);
5459 break;
5460
Andrei Emeltchenko606e2a12012-10-31 15:46:31 +02005461 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
5462 hci_disconn_loglink_complete_evt(hdev, skb);
5463 break;
5464
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02005465 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
5466 hci_disconn_phylink_complete_evt(hdev, skb);
5467 break;
Arron Wanga77a6a12015-07-24 17:13:15 +08005468#endif
Andrei Emeltchenko9eef6b32012-10-31 15:46:32 +02005469
Andrei Emeltchenko25e89e92012-01-04 12:41:58 +02005470 case HCI_EV_NUM_COMP_BLOCKS:
5471 hci_num_comp_blocks_evt(hdev, skb);
5472 break;
5473
Marcel Holtmanna9de9242007-10-20 13:33:56 +02005474 default:
Andrei Emeltchenko9f1db002012-07-11 14:32:43 +03005475 BT_DBG("%s event 0x%2.2x", hdev->name, event);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005476 break;
5477 }
5478
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005479 if (req_complete) {
Johan Hedberge62144872015-04-02 13:41:08 +03005480 req_complete(hdev, status, opcode);
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005481 } else if (req_complete_skb) {
5482 if (!hci_get_cmd_complete(hdev, opcode, req_evt, orig_skb)) {
5483 kfree_skb(orig_skb);
5484 orig_skb = NULL;
5485 }
Johan Hedberge62144872015-04-02 13:41:08 +03005486 req_complete_skb(hdev, status, opcode, orig_skb);
Johan Hedberg757aa0b2015-04-02 13:41:12 +03005487 }
Johan Hedberge62144872015-04-02 13:41:08 +03005488
5489 kfree_skb(orig_skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005490 kfree_skb(skb);
5491 hdev->stat.evt_rx++;
5492}