]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - net/bluetooth/hci_event.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
Bluetooth: Add mgmt_set_secure_conn support for any LE adapter
[mirror_ubuntu-bionic-kernel.git] / net / bluetooth / hci_event.c
CommitLineData
8e87d142 1/*
1da177e4 2 BlueZ - Bluetooth protocol stack for Linux
2d0a0346 3 Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
1da177e4
LT		 4
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
8e87d142
YH		 15 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
1da177e4
LT		 18 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
8e87d142
YH		 20 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
1da177e4
LT		 22 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI event handling. */
26
1da177e4
LT		 27#include <asm/unaligned.h>
28
29#include <net/bluetooth/bluetooth.h>
30#include <net/bluetooth/hci_core.h>
f0d6a0ea 31#include <net/bluetooth/mgmt.h>
7ef9fbf0 32
7024728e 33#include "a2mp.h"
7ef9fbf0 34#include "amp.h"
2ceba539 35#include "smp.h"
1da177e4 36
1da177e4
LT		 37/* Handle HCI Event packets */
38
a9de9248 39static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 40{
a9de9248 41 __u8 status = *((__u8 *) skb->data);
1da177e4 42
9f1db00c 43 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 44
82f4785c 45 if (status)
a9de9248 46 return;
1da177e4 47
89352e7d 48 clear_bit(HCI_INQUIRY, &hdev->flags);
4e857c58 49 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
3e13fa1e 50 wake_up_bit(&hdev->flags, HCI_INQUIRY);
89352e7d 51
50143a43
JH		 52 hci_dev_lock(hdev);
53 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
54 hci_dev_unlock(hdev);
55
a9de9248
MH		 56 hci_conn_check_pending(hdev);
57}
6bd57416 58
4d93483b
AG		 59static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
60{
61 __u8 status = *((__u8 *) skb->data);
62
9f1db00c 63 BT_DBG("%s status 0x%2.2x", hdev->name, status);
ae854a70
AG		 64
65 if (status)
66 return;
67
68 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
4d93483b
AG		 69}
70
a9de9248
MH		 71static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
72{
73 __u8 status = *((__u8 *) skb->data);
6bd57416 74
9f1db00c 75 BT_DBG("%s status 0x%2.2x", hdev->name, status);
6bd57416 76
a9de9248
MH		 77 if (status)
78 return;
1da177e4 79
ae854a70
AG		 80 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
81
a9de9248
MH		 82 hci_conn_check_pending(hdev);
83}
84
807deac2
GP		 85static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
86 struct sk_buff *skb)
a9de9248
MH		 87{
88 BT_DBG("%s", hdev->name);
89}
90
91static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
92{
93 struct hci_rp_role_discovery *rp = (void *) skb->data;
94 struct hci_conn *conn;
95
9f1db00c 96 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH		 97
98 if (rp->status)
99 return;
100
101 hci_dev_lock(hdev);
102
103 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
40bef302
JH		 104 if (conn)
105 conn->role = rp->role;
a9de9248
MH		 106
107 hci_dev_unlock(hdev);
1da177e4
LT		 108}
109
e4e8e37c
MH		 110static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
111{
112 struct hci_rp_read_link_policy *rp = (void *) skb->data;
113 struct hci_conn *conn;
114
9f1db00c 115 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
e4e8e37c
MH		 116
117 if (rp->status)
118 return;
119
120 hci_dev_lock(hdev);
121
122 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
123 if (conn)
124 conn->link_policy = __le16_to_cpu(rp->policy);
125
126 hci_dev_unlock(hdev);
127}
128
a9de9248 129static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 130{
a9de9248 131 struct hci_rp_write_link_policy *rp = (void *) skb->data;
1da177e4 132 struct hci_conn *conn;
04837f64 133 void *sent;
1da177e4 134
9f1db00c 135 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 136
a9de9248
MH		 137 if (rp->status)
138 return;
1da177e4 139
a9de9248
MH		 140 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
141 if (!sent)
142 return;
1da177e4 143
a9de9248 144 hci_dev_lock(hdev);
1da177e4 145
a9de9248 146 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
e4e8e37c 147 if (conn)
83985319 148 conn->link_policy = get_unaligned_le16(sent + 2);
1da177e4 149
a9de9248
MH		 150 hci_dev_unlock(hdev);
151}
1da177e4 152
807deac2
GP		 153static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
154 struct sk_buff *skb)
e4e8e37c
MH		 155{
156 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
157
9f1db00c 158 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
e4e8e37c
MH		 159
160 if (rp->status)
161 return;
162
163 hdev->link_policy = __le16_to_cpu(rp->policy);
164}
165
807deac2
GP		 166static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
167 struct sk_buff *skb)
e4e8e37c
MH		 168{
169 __u8 status = *((__u8 *) skb->data);
170 void *sent;
171
9f1db00c 172 BT_DBG("%s status 0x%2.2x", hdev->name, status);
e4e8e37c 173
45296acd
MH		 174 if (status)
175 return;
176
e4e8e37c
MH		 177 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
178 if (!sent)
179 return;
180
45296acd 181 hdev->link_policy = get_unaligned_le16(sent);
e4e8e37c
MH		 182}
183
a9de9248
MH		 184static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
185{
186 __u8 status = *((__u8 *) skb->data);
04837f64 187
9f1db00c 188 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 189
10572132
GP		 190 clear_bit(HCI_RESET, &hdev->flags);
191
8761f9d6
MH		 192 if (status)
193 return;
194
a297e97c 195 /* Reset all non-persistent flags */
2cc6fb00 196 hdev->dev_flags &= ~HCI_PERSISTENT_MASK;
69775ff6
AG		 197
198 hdev->discovery.state = DISCOVERY_STOPPED;
bbaf444a
JH		 199 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
200 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
3f0f524b
JH		 201
202 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
203 hdev->adv_data_len = 0;
f8e808bd
MH		 204
205 memset(hdev->scan_rsp_data, 0, sizeof(hdev->scan_rsp_data));
206 hdev->scan_rsp_data_len = 0;
06f5b778 207
533553f8
MH		 208 hdev->le_scan_type = LE_SCAN_PASSIVE;
209
06f5b778 210 hdev->ssp_debug_mode = 0;
a4d5504d
MH		 211
212 hci_bdaddr_list_clear(&hdev->le_white_list);
a9de9248 213}
04837f64 214
a9de9248
MH		 215static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
216{
217 __u8 status = *((__u8 *) skb->data);
218 void *sent;
04837f64 219
9f1db00c 220 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 221
a9de9248
MH		 222 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
223 if (!sent)
224 return;
04837f64 225
56e5cb86
JH		 226 hci_dev_lock(hdev);
227
f51d5b24
JH		 228 if (test_bit(HCI_MGMT, &hdev->dev_flags))
229 mgmt_set_local_name_complete(hdev, sent, status);
28cc7bde
JH		 230 else if (!status)
231 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
f51d5b24 232
56e5cb86 233 hci_dev_unlock(hdev);
a9de9248
MH		 234}
235
236static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
237{
238 struct hci_rp_read_local_name *rp = (void *) skb->data;
239
9f1db00c 240 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH		 241
242 if (rp->status)
243 return;
244
db99b5fc
JH		 245 if (test_bit(HCI_SETUP, &hdev->dev_flags))
246 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
a9de9248
MH		 247}
248
249static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
250{
251 __u8 status = *((__u8 *) skb->data);
252 void *sent;
253
9f1db00c 254 BT_DBG("%s status 0x%2.2x", hdev->name, status);
a9de9248
MH		 255
256 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
257 if (!sent)
258 return;
259
260 if (!status) {
261 __u8 param = *((__u8 *) sent);
262
263 if (param == AUTH_ENABLED)
264 set_bit(HCI_AUTH, &hdev->flags);
265 else
266 clear_bit(HCI_AUTH, &hdev->flags);
1da177e4 267 }
a9de9248 268
33ef95ed
JH		 269 if (test_bit(HCI_MGMT, &hdev->dev_flags))
270 mgmt_auth_enable_complete(hdev, status);
1da177e4
LT		 271}
272
a9de9248 273static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 274{
a9de9248 275 __u8 status = *((__u8 *) skb->data);
45296acd 276 __u8 param;
1da177e4
LT		 277 void *sent;
278
9f1db00c 279 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 280
45296acd
MH		 281 if (status)
282 return;
283
a9de9248
MH		 284 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
285 if (!sent)
286 return;
1da177e4 287
45296acd 288 param = *((__u8 *) sent);
a9de9248 289
45296acd
MH		 290 if (param)
291 set_bit(HCI_ENCRYPT, &hdev->flags);
292 else
293 clear_bit(HCI_ENCRYPT, &hdev->flags);
a9de9248 294}
1da177e4 295
a9de9248
MH		 296static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
297{
45296acd
MH		 298 __u8 status = *((__u8 *) skb->data);
299 __u8 param;
a9de9248 300 void *sent;
1da177e4 301
9f1db00c 302 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 303
a9de9248
MH		 304 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
305 if (!sent)
306 return;
1da177e4 307
36f7fc7e
JH		 308 param = *((__u8 *) sent);
309
56e5cb86
JH		 310 hci_dev_lock(hdev);
311
fa1bd918 312 if (status) {
2d7cee58
JH		 313 hdev->discov_timeout = 0;
314 goto done;
315 }
316
bc6d2d04 317 if (param & SCAN_INQUIRY)
36f7fc7e 318 set_bit(HCI_ISCAN, &hdev->flags);
bc6d2d04
JH		 319 else
320 clear_bit(HCI_ISCAN, &hdev->flags);
36f7fc7e 321
031547d8 322 if (param & SCAN_PAGE)
36f7fc7e 323 set_bit(HCI_PSCAN, &hdev->flags);
bc6d2d04 324 else
204e3990 325 clear_bit(HCI_PSCAN, &hdev->flags);
1da177e4 326
36f7fc7e 327done:
56e5cb86 328 hci_dev_unlock(hdev);
a9de9248 329}
1da177e4 330
a9de9248
MH		 331static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
332{
333 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
1da177e4 334
9f1db00c 335 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 336
a9de9248
MH		 337 if (rp->status)
338 return;
1da177e4 339
a9de9248 340 memcpy(hdev->dev_class, rp->dev_class, 3);
1da177e4 341
a9de9248 342 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
807deac2 343 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
a9de9248 344}
1da177e4 345
a9de9248
MH		 346static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
347{
348 __u8 status = *((__u8 *) skb->data);
349 void *sent;
1da177e4 350
9f1db00c 351 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 352
a9de9248
MH		 353 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
354 if (!sent)
355 return;
1da177e4 356
7f9a903c
MH		 357 hci_dev_lock(hdev);
358
359 if (status == 0)
360 memcpy(hdev->dev_class, sent, 3);
361
362 if (test_bit(HCI_MGMT, &hdev->dev_flags))
363 mgmt_set_class_of_dev_complete(hdev, sent, status);
364
365 hci_dev_unlock(hdev);
a9de9248 366}
1da177e4 367
a9de9248
MH		 368static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
369{
370 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
371 __u16 setting;
372
9f1db00c 373 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH		 374
375 if (rp->status)
376 return;
377
378 setting = __le16_to_cpu(rp->voice_setting);
379
f383f275 380 if (hdev->voice_setting == setting)
a9de9248
MH		 381 return;
382
383 hdev->voice_setting = setting;
384
9f1db00c 385 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
a9de9248 386
3c54711c 387 if (hdev->notify)
a9de9248 388 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
a9de9248
MH		 389}
390
8fc9ced3
GP		 391static void hci_cc_write_voice_setting(struct hci_dev *hdev,
392 struct sk_buff *skb)
a9de9248
MH		 393{
394 __u8 status = *((__u8 *) skb->data);
f383f275 395 __u16 setting;
a9de9248
MH		 396 void *sent;
397
9f1db00c 398 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 399
f383f275
MH		 400 if (status)
401 return;
402
a9de9248
MH		 403 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
404 if (!sent)
405 return;
1da177e4 406
f383f275 407 setting = get_unaligned_le16(sent);
1da177e4 408
f383f275
MH		 409 if (hdev->voice_setting == setting)
410 return;
411
412 hdev->voice_setting = setting;
1da177e4 413
9f1db00c 414 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
1da177e4 415
3c54711c 416 if (hdev->notify)
f383f275 417 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
1da177e4
LT		 418}
419
b4cb9fb2
MH		 420static void hci_cc_read_num_supported_iac(struct hci_dev *hdev,
421 struct sk_buff *skb)
422{
423 struct hci_rp_read_num_supported_iac *rp = (void *) skb->data;
424
425 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
426
427 if (rp->status)
428 return;
429
430 hdev->num_iac = rp->num_iac;
431
432 BT_DBG("%s num iac %d", hdev->name, hdev->num_iac);
433}
434
333140b5
MH		 435static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
436{
437 __u8 status = *((__u8 *) skb->data);
5ed8eb2f 438 struct hci_cp_write_ssp_mode *sent;
333140b5 439
9f1db00c 440 BT_DBG("%s status 0x%2.2x", hdev->name, status);
333140b5 441
333140b5
MH		 442 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
443 if (!sent)
444 return;
445
5ed8eb2f
JH		 446 if (!status) {
447 if (sent->mode)
cad718ed 448 hdev->features[1][0] |= LMP_HOST_SSP;
5ed8eb2f 449 else
cad718ed 450 hdev->features[1][0] &= ~LMP_HOST_SSP;
5ed8eb2f
JH		 451 }
452
ed2c4ee3 453 if (test_bit(HCI_MGMT, &hdev->dev_flags))
5ed8eb2f 454 mgmt_ssp_enable_complete(hdev, sent->mode, status);
c0ecddc2 455 else if (!status) {
5ed8eb2f 456 if (sent->mode)
c0ecddc2
JH		 457 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
458 else
459 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
460 }
333140b5
MH		 461}
462
eac83dc6
MH		 463static void hci_cc_write_sc_support(struct hci_dev *hdev, struct sk_buff *skb)
464{
465 u8 status = *((u8 *) skb->data);
466 struct hci_cp_write_sc_support *sent;
467
468 BT_DBG("%s status 0x%2.2x", hdev->name, status);
469
470 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SC_SUPPORT);
471 if (!sent)
472 return;
473
474 if (!status) {
475 if (sent->support)
476 hdev->features[1][0] |= LMP_HOST_SC;
477 else
478 hdev->features[1][0] &= ~LMP_HOST_SC;
479 }
480
481 if (test_bit(HCI_MGMT, &hdev->dev_flags))
482 mgmt_sc_enable_complete(hdev, sent->support, status);
483 else if (!status) {
484 if (sent->support)
485 set_bit(HCI_SC_ENABLED, &hdev->dev_flags);
486 else
487 clear_bit(HCI_SC_ENABLED, &hdev->dev_flags);
488 }
489}
490
a9de9248
MH		 491static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
492{
493 struct hci_rp_read_local_version *rp = (void *) skb->data;
1143e5a6 494
9f1db00c 495 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1143e5a6 496
a9de9248 497 if (rp->status)
42c6b129 498 return;
1143e5a6 499
0d5551f5
MH		 500 if (test_bit(HCI_SETUP, &hdev->dev_flags)) {
501 hdev->hci_ver = rp->hci_ver;
502 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
503 hdev->lmp_ver = rp->lmp_ver;
504 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
505 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
506 }
d5859e22
JH		 507}
508
8fc9ced3
GP		 509static void hci_cc_read_local_commands(struct hci_dev *hdev,
510 struct sk_buff *skb)
a9de9248
MH		 511{
512 struct hci_rp_read_local_commands *rp = (void *) skb->data;
1da177e4 513
9f1db00c 514 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 515
6a070e6e
MH		 516 if (rp->status)
517 return;
518
519 if (test_bit(HCI_SETUP, &hdev->dev_flags))
2177bab5 520 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
a9de9248 521}
1da177e4 522
8fc9ced3
GP		 523static void hci_cc_read_local_features(struct hci_dev *hdev,
524 struct sk_buff *skb)
a9de9248
MH		 525{
526 struct hci_rp_read_local_features *rp = (void *) skb->data;
5b7f9909 527
9f1db00c 528 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 529
a9de9248
MH		 530 if (rp->status)
531 return;
5b7f9909 532
a9de9248 533 memcpy(hdev->features, rp->features, 8);
5b7f9909 534
a9de9248
MH		 535 /* Adjust default settings according to features
536 * supported by device. */
1da177e4 537
cad718ed 538 if (hdev->features[0][0] & LMP_3SLOT)
a9de9248 539 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
1da177e4 540
cad718ed 541 if (hdev->features[0][0] & LMP_5SLOT)
a9de9248 542 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
1da177e4 543
cad718ed 544 if (hdev->features[0][1] & LMP_HV2) {
a9de9248
MH		 545 hdev->pkt_type |= (HCI_HV2);
546 hdev->esco_type |= (ESCO_HV2);
547 }
1da177e4 548
cad718ed 549 if (hdev->features[0][1] & LMP_HV3) {
a9de9248
MH		 550 hdev->pkt_type |= (HCI_HV3);
551 hdev->esco_type |= (ESCO_HV3);
552 }
1da177e4 553
45db810f 554 if (lmp_esco_capable(hdev))
a9de9248 555 hdev->esco_type |= (ESCO_EV3);
da1f5198 556
cad718ed 557 if (hdev->features[0][4] & LMP_EV4)
a9de9248 558 hdev->esco_type |= (ESCO_EV4);
da1f5198 559
cad718ed 560 if (hdev->features[0][4] & LMP_EV5)
a9de9248 561 hdev->esco_type |= (ESCO_EV5);
1da177e4 562
cad718ed 563 if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
efc7688b
MH		 564 hdev->esco_type |= (ESCO_2EV3);
565
cad718ed 566 if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
efc7688b
MH		 567 hdev->esco_type |= (ESCO_3EV3);
568
cad718ed 569 if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
efc7688b 570 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
a9de9248 571}
1da177e4 572
971e3a4b 573static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
807deac2 574 struct sk_buff *skb)
971e3a4b
AG		 575{
576 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
577
9f1db00c 578 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
971e3a4b
AG		 579
580 if (rp->status)
42c6b129 581 return;
971e3a4b 582
57af75a8
MH		 583 if (hdev->max_page < rp->max_page)
584 hdev->max_page = rp->max_page;
d2c5d77f 585
cad718ed
JH		 586 if (rp->page < HCI_MAX_PAGES)
587 memcpy(hdev->features[rp->page], rp->features, 8);
971e3a4b
AG		 588}
589
1e89cffb 590static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
807deac2 591 struct sk_buff *skb)
1e89cffb
AE		 592{
593 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
594
9f1db00c 595 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1e89cffb 596
45296acd
MH		 597 if (rp->status)
598 return;
599
600 hdev->flow_ctl_mode = rp->mode;
1e89cffb
AE		 601}
602
a9de9248
MH		 603static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
604{
605 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
1da177e4 606
9f1db00c 607 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 608
a9de9248
MH		 609 if (rp->status)
610 return;
1da177e4 611
a9de9248
MH		 612 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
613 hdev->sco_mtu = rp->sco_mtu;
614 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
615 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
616
617 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
618 hdev->sco_mtu = 64;
619 hdev->sco_pkts = 8;
1da177e4 620 }
a9de9248
MH		 621
622 hdev->acl_cnt = hdev->acl_pkts;
623 hdev->sco_cnt = hdev->sco_pkts;
624
807deac2
GP		 625 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
626 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
a9de9248
MH		 627}
628
629static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
630{
631 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
632
9f1db00c 633 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248 634
e30d3f5f
MH		 635 if (rp->status)
636 return;
637
638 if (test_bit(HCI_INIT, &hdev->flags))
a9de9248 639 bacpy(&hdev->bdaddr, &rp->bdaddr);
e30d3f5f
MH		 640
641 if (test_bit(HCI_SETUP, &hdev->dev_flags))
642 bacpy(&hdev->setup_addr, &rp->bdaddr);
23bb5763
JH		 643}
644
f332ec66
JH		 645static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
646 struct sk_buff *skb)
647{
648 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
649
650 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
651
45296acd
MH		 652 if (rp->status)
653 return;
654
655 if (test_bit(HCI_INIT, &hdev->flags)) {
f332ec66
JH		 656 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
657 hdev->page_scan_window = __le16_to_cpu(rp->window);
658 }
659}
660
4a3ee763
JH		 661static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
662 struct sk_buff *skb)
663{
664 u8 status = *((u8 *) skb->data);
665 struct hci_cp_write_page_scan_activity *sent;
666
667 BT_DBG("%s status 0x%2.2x", hdev->name, status);
668
669 if (status)
670 return;
671
672 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
673 if (!sent)
674 return;
675
676 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
677 hdev->page_scan_window = __le16_to_cpu(sent->window);
678}
679
f332ec66
JH		 680static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
681 struct sk_buff *skb)
682{
683 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
684
685 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
686
45296acd
MH		 687 if (rp->status)
688 return;
689
690 if (test_bit(HCI_INIT, &hdev->flags))
f332ec66
JH		 691 hdev->page_scan_type = rp->type;
692}
693
4a3ee763
JH		 694static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
695 struct sk_buff *skb)
696{
697 u8 status = *((u8 *) skb->data);
698 u8 *type;
699
700 BT_DBG("%s status 0x%2.2x", hdev->name, status);
701
702 if (status)
703 return;
704
705 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
706 if (type)
707 hdev->page_scan_type = *type;
708}
709
350ee4cf 710static void hci_cc_read_data_block_size(struct hci_dev *hdev,
807deac2 711 struct sk_buff *skb)
350ee4cf
AE		 712{
713 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
714
9f1db00c 715 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
350ee4cf
AE		 716
717 if (rp->status)
718 return;
719
720 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
721 hdev->block_len = __le16_to_cpu(rp->block_len);
722 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
723
724 hdev->block_cnt = hdev->num_blocks;
725
726 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
807deac2 727 hdev->block_cnt, hdev->block_len);
350ee4cf
AE		 728}
729
33f35721
JH		 730static void hci_cc_read_clock(struct hci_dev *hdev, struct sk_buff *skb)
731{
732 struct hci_rp_read_clock *rp = (void *) skb->data;
733 struct hci_cp_read_clock *cp;
734 struct hci_conn *conn;
735
736 BT_DBG("%s", hdev->name);
737
738 if (skb->len < sizeof(*rp))
739 return;
740
741 if (rp->status)
742 return;
743
744 hci_dev_lock(hdev);
745
746 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_CLOCK);
747 if (!cp)
748 goto unlock;
749
750 if (cp->which == 0x00) {
751 hdev->clock = le32_to_cpu(rp->clock);
752 goto unlock;
753 }
754
755 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
756 if (conn) {
757 conn->clock = le32_to_cpu(rp->clock);
758 conn->clock_accuracy = le16_to_cpu(rp->accuracy);
759 }
760
761unlock:
762 hci_dev_unlock(hdev);
763}
764
928abaa7 765static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
807deac2 766 struct sk_buff *skb)
928abaa7
AE		 767{
768 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
769
9f1db00c 770 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
928abaa7
AE		 771
772 if (rp->status)
8e2a0d92 773 goto a2mp_rsp;
928abaa7
AE		 774
775 hdev->amp_status = rp->amp_status;
776 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
777 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
778 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
779 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
780 hdev->amp_type = rp->amp_type;
781 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
782 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
783 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
784 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
785
8e2a0d92
AE		 786a2mp_rsp:
787 a2mp_send_getinfo_rsp(hdev);
928abaa7
AE		 788}
789
903e4541
AE		 790static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
791 struct sk_buff *skb)
792{
793 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
794 struct amp_assoc *assoc = &hdev->loc_assoc;
795 size_t rem_len, frag_len;
796
797 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
798
799 if (rp->status)
800 goto a2mp_rsp;
801
802 frag_len = skb->len - sizeof(*rp);
803 rem_len = __le16_to_cpu(rp->rem_len);
804
805 if (rem_len > frag_len) {
2e430be3 806 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
903e4541
AE		 807
808 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
809 assoc->offset += frag_len;
810
811 /* Read other fragments */
812 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
813
814 return;
815 }
816
817 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
818 assoc->len = assoc->offset + rem_len;
819 assoc->offset = 0;
820
821a2mp_rsp:
822 /* Send A2MP Rsp when all fragments are received */
823 a2mp_send_getampassoc_rsp(hdev, rp->status);
9495b2ee 824 a2mp_send_create_phy_link_req(hdev, rp->status);
903e4541
AE		 825}
826
d5859e22 827static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
807deac2 828 struct sk_buff *skb)
d5859e22 829{
91c4e9b1 830 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
d5859e22 831
9f1db00c 832 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
91c4e9b1 833
45296acd
MH		 834 if (rp->status)
835 return;
836
837 hdev->inq_tx_power = rp->tx_power;
d5859e22
JH		 838}
839
980e1a53
JH		 840static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
841{
842 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
843 struct hci_cp_pin_code_reply *cp;
844 struct hci_conn *conn;
845
9f1db00c 846 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
980e1a53 847
56e5cb86
JH		 848 hci_dev_lock(hdev);
849
a8b2d5c2 850 if (test_bit(HCI_MGMT, &hdev->dev_flags))
744cf19e 851 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
980e1a53 852
fa1bd918 853 if (rp->status)
56e5cb86 854 goto unlock;
980e1a53
JH		 855
856 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
857 if (!cp)
56e5cb86 858 goto unlock;
980e1a53
JH		 859
860 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
861 if (conn)
862 conn->pin_length = cp->pin_len;
56e5cb86
JH		 863
864unlock:
865 hci_dev_unlock(hdev);
980e1a53
JH		 866}
867
868static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
869{
870 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
871
9f1db00c 872 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
980e1a53 873
56e5cb86
JH		 874 hci_dev_lock(hdev);
875
a8b2d5c2 876 if (test_bit(HCI_MGMT, &hdev->dev_flags))
744cf19e 877 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
807deac2 878 rp->status);
56e5cb86
JH		 879
880 hci_dev_unlock(hdev);
980e1a53 881}
56e5cb86 882
6ed58ec5
VT		 883static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
884 struct sk_buff *skb)
885{
886 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
887
9f1db00c 888 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
6ed58ec5
VT		 889
890 if (rp->status)
891 return;
892
893 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
894 hdev->le_pkts = rp->le_max_pkt;
895
896 hdev->le_cnt = hdev->le_pkts;
897
898 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
6ed58ec5 899}
980e1a53 900
60e77321
JH		 901static void hci_cc_le_read_local_features(struct hci_dev *hdev,
902 struct sk_buff *skb)
903{
904 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
905
906 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
907
45296acd
MH		 908 if (rp->status)
909 return;
910
911 memcpy(hdev->le_features, rp->features, 8);
60e77321
JH		 912}
913
8fa19098
JH		 914static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
915 struct sk_buff *skb)
916{
917 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
918
919 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
920
45296acd
MH		 921 if (rp->status)
922 return;
923
924 hdev->adv_tx_power = rp->tx_power;
8fa19098
JH		 925}
926
a5c29683
JH		 927static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
928{
929 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
930
9f1db00c 931 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a5c29683 932
56e5cb86
JH		 933 hci_dev_lock(hdev);
934
a8b2d5c2 935 if (test_bit(HCI_MGMT, &hdev->dev_flags))
04124681
GP		 936 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
937 rp->status);
56e5cb86
JH		 938
939 hci_dev_unlock(hdev);
a5c29683
JH		 940}
941
942static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
807deac2 943 struct sk_buff *skb)
a5c29683
JH		 944{
945 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
946
9f1db00c 947 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a5c29683 948
56e5cb86
JH		 949 hci_dev_lock(hdev);
950
a8b2d5c2 951 if (test_bit(HCI_MGMT, &hdev->dev_flags))
744cf19e 952 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
04124681 953 ACL_LINK, 0, rp->status);
56e5cb86
JH		 954
955 hci_dev_unlock(hdev);
a5c29683
JH		 956}
957
1143d458
BG		 958static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
959{
960 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
961
9f1db00c 962 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1143d458
BG		 963
964 hci_dev_lock(hdev);
965
a8b2d5c2 966 if (test_bit(HCI_MGMT, &hdev->dev_flags))
272d90df 967 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
04124681 968 0, rp->status);
1143d458
BG		 969
970 hci_dev_unlock(hdev);
971}
972
973static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
807deac2 974 struct sk_buff *skb)
1143d458
BG		 975{
976 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
977
9f1db00c 978 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1143d458
BG		 979
980 hci_dev_lock(hdev);
981
a8b2d5c2 982 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1143d458 983 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
04124681 984 ACL_LINK, 0, rp->status);
1143d458
BG		 985
986 hci_dev_unlock(hdev);
987}
988
4d2d2796
MH		 989static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
990 struct sk_buff *skb)
c35938b2
SJ		 991{
992 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
993
9f1db00c 994 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
c35938b2 995
56e5cb86 996 hci_dev_lock(hdev);
38da1703
JH		 997 mgmt_read_local_oob_data_complete(hdev, rp->hash, rp->rand, NULL, NULL,
998 rp->status);
4d2d2796
MH		 999 hci_dev_unlock(hdev);
1000}
1001
1002static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
1003 struct sk_buff *skb)
1004{
1005 struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;
1006
1007 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1008
1009 hci_dev_lock(hdev);
38da1703
JH		 1010 mgmt_read_local_oob_data_complete(hdev, rp->hash192, rp->rand192,
1011 rp->hash256, rp->rand256,
4d2d2796 1012 rp->status);
56e5cb86 1013 hci_dev_unlock(hdev);
c35938b2
SJ		 1014}
1015
7a4cd51d
MH		 1016
1017static void hci_cc_le_set_random_addr(struct hci_dev *hdev, struct sk_buff *skb)
1018{
1019 __u8 status = *((__u8 *) skb->data);
1020 bdaddr_t *sent;
1021
1022 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1023
45296acd
MH		 1024 if (status)
1025 return;
1026
7a4cd51d
MH		 1027 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
1028 if (!sent)
1029 return;
1030
1031 hci_dev_lock(hdev);
1032
45296acd 1033 bacpy(&hdev->random_addr, sent);
7a4cd51d
MH		 1034
1035 hci_dev_unlock(hdev);
1036}
1037
c1d5dc4a
JH		 1038static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
1039{
1040 __u8 *sent, status = *((__u8 *) skb->data);
1041
1042 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1043
45296acd 1044 if (status)
c1d5dc4a
JH		 1045 return;
1046
45296acd
MH		 1047 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
1048 if (!sent)
3c857757
JH		 1049 return;
1050
c1d5dc4a
JH		 1051 hci_dev_lock(hdev);
1052
49c922bb 1053 /* If we're doing connection initiation as peripheral. Set a
3c857757
JH		 1054 * timeout in case something goes wrong.
1055 */
1056 if (*sent) {
1057 struct hci_conn *conn;
1058
66c417c1
JH		 1059 set_bit(HCI_LE_ADV, &hdev->dev_flags);
1060
3c857757
JH		 1061 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
1062 if (conn)
1063 queue_delayed_work(hdev->workqueue,
1064 &conn->le_conn_timeout,
09ae260b 1065 conn->conn_timeout);
66c417c1
JH		 1066 } else {
1067 clear_bit(HCI_LE_ADV, &hdev->dev_flags);
3c857757
JH		 1068 }
1069
04b4edcb 1070 hci_dev_unlock(hdev);
c1d5dc4a
JH		 1071}
1072
533553f8
MH		 1073static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
1074{
1075 struct hci_cp_le_set_scan_param *cp;
1076 __u8 status = *((__u8 *) skb->data);
1077
1078 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1079
45296acd
MH		 1080 if (status)
1081 return;
1082
533553f8
MH		 1083 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
1084 if (!cp)
1085 return;
1086
1087 hci_dev_lock(hdev);
1088
45296acd 1089 hdev->le_scan_type = cp->type;
533553f8
MH		 1090
1091 hci_dev_unlock(hdev);
1092}
1093
b9a6328f
JH		 1094static bool has_pending_adv_report(struct hci_dev *hdev)
1095{
1096 struct discovery_state *d = &hdev->discovery;
1097
1098 return bacmp(&d->last_adv_addr, BDADDR_ANY);
1099}
1100
1101static void clear_pending_adv_report(struct hci_dev *hdev)
1102{
1103 struct discovery_state *d = &hdev->discovery;
1104
1105 bacpy(&d->last_adv_addr, BDADDR_ANY);
1106 d->last_adv_data_len = 0;
1107}
1108
1109static void store_pending_adv_report(struct hci_dev *hdev, bdaddr_t *bdaddr,
c70a7e4c
MH		 1110 u8 bdaddr_type, s8 rssi, u32 flags,
1111 u8 *data, u8 len)
b9a6328f
JH		 1112{
1113 struct discovery_state *d = &hdev->discovery;
1114
1115 bacpy(&d->last_adv_addr, bdaddr);
1116 d->last_adv_addr_type = bdaddr_type;
ff5cd29f 1117 d->last_adv_rssi = rssi;
c70a7e4c 1118 d->last_adv_flags = flags;
b9a6328f
JH		 1119 memcpy(d->last_adv_data, data, len);
1120 d->last_adv_data_len = len;
1121}
1122
eb9d91f5 1123static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
807deac2 1124 struct sk_buff *skb)
eb9d91f5
AG		 1125{
1126 struct hci_cp_le_set_scan_enable *cp;
1127 __u8 status = *((__u8 *) skb->data);
1128
9f1db00c 1129 BT_DBG("%s status 0x%2.2x", hdev->name, status);
eb9d91f5 1130
45296acd 1131 if (status)
eb9d91f5
AG		 1132 return;
1133
45296acd
MH		 1134 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
1135 if (!cp)
3fd319b8
AG		 1136 return;
1137
68a8aea4 1138 switch (cp->enable) {
76a388be 1139 case LE_SCAN_ENABLE:
d23264a8 1140 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
b9a6328f
JH		 1141 if (hdev->le_scan_type == LE_SCAN_ACTIVE)
1142 clear_pending_adv_report(hdev);
68a8aea4
AE		 1143 break;
1144
76a388be 1145 case LE_SCAN_DISABLE:
b9a6328f
JH		 1146 /* We do this here instead of when setting DISCOVERY_STOPPED
1147 * since the latter would potentially require waiting for
1148 * inquiry to stop too.
1149 */
1150 if (has_pending_adv_report(hdev)) {
1151 struct discovery_state *d = &hdev->discovery;
1152
1153 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
ab0aa433 1154 d->last_adv_addr_type, NULL,
c70a7e4c 1155 d->last_adv_rssi, d->last_adv_flags,
ab0aa433 1156 d->last_adv_data,
b9a6328f
JH		 1157 d->last_adv_data_len, NULL, 0);
1158 }
1159
317ac8cb
JH		 1160 /* Cancel this timer so that we don't try to disable scanning
1161 * when it's already disabled.
1162 */
1163 cancel_delayed_work(&hdev->le_scan_disable);
1164
d23264a8 1165 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
e8bb6b97 1166
81ad6fd9
JH		 1167 /* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
1168 * interrupted scanning due to a connect request. Mark
e8bb6b97
JH		 1169 * therefore discovery as stopped. If this was not
1170 * because of a connect request advertising might have
1171 * been disabled because of active scanning, so
1172 * re-enable it again if necessary.
81ad6fd9
JH		 1173 */
1174 if (test_and_clear_bit(HCI_LE_SCAN_INTERRUPTED,
1175 &hdev->dev_flags))
1176 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
e8bb6b97 1177 else if (!test_bit(HCI_LE_ADV, &hdev->dev_flags) &&
34722277 1178 hdev->discovery.state == DISCOVERY_FINDING)
e8bb6b97
JH		 1179 mgmt_reenable_advertising(hdev);
1180
68a8aea4
AE		 1181 break;
1182
1183 default:
1184 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1185 break;
35815085 1186 }
eb9d91f5
AG		 1187}
1188
cf1d081f
JH		 1189static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1190 struct sk_buff *skb)
1191{
1192 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1193
1194 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1195
45296acd
MH		 1196 if (rp->status)
1197 return;
1198
1199 hdev->le_white_list_size = rp->size;
cf1d081f
JH		 1200}
1201
0f36b589
MH		 1202static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
1203 struct sk_buff *skb)
1204{
1205 __u8 status = *((__u8 *) skb->data);
1206
1207 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1208
45296acd
MH		 1209 if (status)
1210 return;
1211
dcc36c16 1212 hci_bdaddr_list_clear(&hdev->le_white_list);
0f36b589
MH		 1213}
1214
1215static void hci_cc_le_add_to_white_list(struct hci_dev *hdev,
1216 struct sk_buff *skb)
1217{
1218 struct hci_cp_le_add_to_white_list *sent;
1219 __u8 status = *((__u8 *) skb->data);
1220
1221 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1222
45296acd
MH		 1223 if (status)
1224 return;
1225
0f36b589
MH		 1226 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_WHITE_LIST);
1227 if (!sent)
1228 return;
1229
dcc36c16
JH		 1230 hci_bdaddr_list_add(&hdev->le_white_list, &sent->bdaddr,
1231 sent->bdaddr_type);
0f36b589
MH		 1232}
1233
1234static void hci_cc_le_del_from_white_list(struct hci_dev *hdev,
1235 struct sk_buff *skb)
1236{
1237 struct hci_cp_le_del_from_white_list *sent;
1238 __u8 status = *((__u8 *) skb->data);
1239
1240 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1241
45296acd
MH		 1242 if (status)
1243 return;
1244
0f36b589
MH		 1245 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_WHITE_LIST);
1246 if (!sent)
1247 return;
1248
dcc36c16
JH		 1249 hci_bdaddr_list_del(&hdev->le_white_list, &sent->bdaddr,
1250 sent->bdaddr_type);
0f36b589
MH		 1251}
1252
9b008c04
JH		 1253static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1254 struct sk_buff *skb)
1255{
1256 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1257
1258 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1259
45296acd
MH		 1260 if (rp->status)
1261 return;
1262
1263 memcpy(hdev->le_states, rp->le_states, 8);
9b008c04
JH		 1264}
1265
6039aa73
GP		 1266static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1267 struct sk_buff *skb)
f9b49306 1268{
06199cf8 1269 struct hci_cp_write_le_host_supported *sent;
f9b49306
AG		 1270 __u8 status = *((__u8 *) skb->data);
1271
9f1db00c 1272 BT_DBG("%s status 0x%2.2x", hdev->name, status);
f9b49306 1273
45296acd
MH		 1274 if (status)
1275 return;
1276
06199cf8 1277 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
8f984dfa 1278 if (!sent)
f9b49306
AG		 1279 return;
1280
45296acd
MH		 1281 if (sent->le) {
1282 hdev->features[1][0] |= LMP_HOST_LE;
1283 set_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1284 } else {
1285 hdev->features[1][0] &= ~LMP_HOST_LE;
1286 clear_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1287 clear_bit(HCI_ADVERTISING, &hdev->dev_flags);
8f984dfa 1288 }
45296acd
MH		 1289
1290 if (sent->simul)
1291 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
1292 else
1293 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
f9b49306
AG		 1294}
1295
56ed2cb8
JH		 1296static void hci_cc_set_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
1297{
1298 struct hci_cp_le_set_adv_param *cp;
1299 u8 status = *((u8 *) skb->data);
1300
1301 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1302
1303 if (status)
1304 return;
1305
1306 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_PARAM);
1307 if (!cp)
1308 return;
1309
1310 hci_dev_lock(hdev);
1311 hdev->adv_addr_type = cp->own_address_type;
1312 hci_dev_unlock(hdev);
1313}
1314
93c284ee
AE		 1315static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1316 struct sk_buff *skb)
1317{
1318 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1319
1320 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1321 hdev->name, rp->status, rp->phy_handle);
1322
1323 if (rp->status)
1324 return;
1325
1326 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1327}
1328
5ae76a94
AK		 1329static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
1330{
1331 struct hci_rp_read_rssi *rp = (void *) skb->data;
1332 struct hci_conn *conn;
1333
1334 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1335
1336 if (rp->status)
1337 return;
1338
1339 hci_dev_lock(hdev);
1340
1341 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
1342 if (conn)
1343 conn->rssi = rp->rssi;
1344
1345 hci_dev_unlock(hdev);
1346}
1347
5a134fae
AK		 1348static void hci_cc_read_tx_power(struct hci_dev *hdev, struct sk_buff *skb)
1349{
1350 struct hci_cp_read_tx_power *sent;
1351 struct hci_rp_read_tx_power *rp = (void *) skb->data;
1352 struct hci_conn *conn;
1353
1354 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1355
1356 if (rp->status)
1357 return;
1358
1359 sent = hci_sent_cmd_data(hdev, HCI_OP_READ_TX_POWER);
1360 if (!sent)
1361 return;
1362
1363 hci_dev_lock(hdev);
1364
1365 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
d0455ed9
AK		 1366 if (!conn)
1367 goto unlock;
1368
1369 switch (sent->type) {
1370 case 0x00:
5a134fae 1371 conn->tx_power = rp->tx_power;
d0455ed9
AK		 1372 break;
1373 case 0x01:
1374 conn->max_tx_power = rp->tx_power;
1375 break;
1376 }
5a134fae 1377
d0455ed9 1378unlock:
5a134fae
AK		 1379 hci_dev_unlock(hdev);
1380}
1381
6039aa73 1382static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
a9de9248 1383{
9f1db00c 1384 BT_DBG("%s status 0x%2.2x", hdev->name, status);
a9de9248
MH		 1385
1386 if (status) {
a9de9248 1387 hci_conn_check_pending(hdev);
314b2381
JH		 1388 return;
1389 }
1390
89352e7d 1391 set_bit(HCI_INQUIRY, &hdev->flags);
1da177e4
LT		 1392}
1393
6039aa73 1394static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
1da177e4 1395{
a9de9248 1396 struct hci_cp_create_conn *cp;
1da177e4 1397 struct hci_conn *conn;
1da177e4 1398
9f1db00c 1399 BT_DBG("%s status 0x%2.2x", hdev->name, status);
a9de9248
MH		 1400
1401 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
1da177e4
LT		 1402 if (!cp)
1403 return;
1404
1405 hci_dev_lock(hdev);
1406
1407 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1408
6ed93dc6 1409 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
1da177e4
LT		 1410
1411 if (status) {
1412 if (conn && conn->state == BT_CONNECT) {
4c67bc74
MH		 1413 if (status != 0x0c || conn->attempt > 2) {
1414 conn->state = BT_CLOSED;
1415 hci_proto_connect_cfm(conn, status);
1416 hci_conn_del(conn);
1417 } else
1418 conn->state = BT_CONNECT2;
1da177e4
LT		 1419 }
1420 } else {
1421 if (!conn) {
a5c4e309
JH		 1422 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr,
1423 HCI_ROLE_MASTER);
1424 if (!conn)
893ef971 1425 BT_ERR("No memory for new connection");
1da177e4
LT		 1426 }
1427 }
1428
1429 hci_dev_unlock(hdev);
1430}
1431
a9de9248 1432static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
1da177e4 1433{
a9de9248
MH		 1434 struct hci_cp_add_sco *cp;
1435 struct hci_conn *acl, *sco;
1436 __u16 handle;
1da177e4 1437
9f1db00c 1438 BT_DBG("%s status 0x%2.2x", hdev->name, status);
b6a0dc82 1439
a9de9248
MH		 1440 if (!status)
1441 return;
1da177e4 1442
a9de9248
MH		 1443 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1444 if (!cp)
1445 return;
1da177e4 1446
a9de9248 1447 handle = __le16_to_cpu(cp->handle);
1da177e4 1448
9f1db00c 1449 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
1da177e4 1450
a9de9248 1451 hci_dev_lock(hdev);
1da177e4 1452
a9de9248 1453 acl = hci_conn_hash_lookup_handle(hdev, handle);
5a08ecce
AE		 1454 if (acl) {
1455 sco = acl->link;
1456 if (sco) {
1457 sco->state = BT_CLOSED;
1da177e4 1458
5a08ecce
AE		 1459 hci_proto_connect_cfm(sco, status);
1460 hci_conn_del(sco);
1461 }
a9de9248 1462 }
1da177e4 1463
a9de9248
MH		 1464 hci_dev_unlock(hdev);
1465}
1da177e4 1466
f8558555
MH		 1467static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1468{
1469 struct hci_cp_auth_requested *cp;
1470 struct hci_conn *conn;
1471
9f1db00c 1472 BT_DBG("%s status 0x%2.2x", hdev->name, status);
f8558555
MH		 1473
1474 if (!status)
1475 return;
1476
1477 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1478 if (!cp)
1479 return;
1480
1481 hci_dev_lock(hdev);
1482
1483 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1484 if (conn) {
1485 if (conn->state == BT_CONFIG) {
1486 hci_proto_connect_cfm(conn, status);
76a68ba0 1487 hci_conn_drop(conn);
f8558555
MH		 1488 }
1489 }
1490
1491 hci_dev_unlock(hdev);
1492}
1493
1494static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1495{
1496 struct hci_cp_set_conn_encrypt *cp;
1497 struct hci_conn *conn;
1498
9f1db00c 1499 BT_DBG("%s status 0x%2.2x", hdev->name, status);
f8558555
MH		 1500
1501 if (!status)
1502 return;
1503
1504 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1505 if (!cp)
1506 return;
1507
1508 hci_dev_lock(hdev);
1509
1510 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1511 if (conn) {
1512 if (conn->state == BT_CONFIG) {
1513 hci_proto_connect_cfm(conn, status);
76a68ba0 1514 hci_conn_drop(conn);
f8558555
MH		 1515 }
1516 }
1517
1518 hci_dev_unlock(hdev);
1519}
1520
127178d2 1521static int hci_outgoing_auth_needed(struct hci_dev *hdev,
807deac2 1522 struct hci_conn *conn)
392599b9 1523{
392599b9
JH		 1524 if (conn->state != BT_CONFIG || !conn->out)
1525 return 0;
1526
765c2a96 1527 if (conn->pending_sec_level == BT_SECURITY_SDP)
392599b9
JH		 1528 return 0;
1529
1530 /* Only request authentication for SSP connections or non-SSP
264b8b4e
JH		 1531 * devices with sec_level MEDIUM or HIGH or if MITM protection
1532 * is requested.
1533 */
807deac2 1534 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
7e3691e1 1535 conn->pending_sec_level != BT_SECURITY_FIPS &&
264b8b4e
JH		 1536 conn->pending_sec_level != BT_SECURITY_HIGH &&
1537 conn->pending_sec_level != BT_SECURITY_MEDIUM)
392599b9
JH		 1538 return 0;
1539
392599b9
JH		 1540 return 1;
1541}
1542
6039aa73 1543static int hci_resolve_name(struct hci_dev *hdev,
04124681 1544 struct inquiry_entry *e)
30dc78e1
JH		 1545{
1546 struct hci_cp_remote_name_req cp;
1547
1548 memset(&cp, 0, sizeof(cp));
1549
1550 bacpy(&cp.bdaddr, &e->data.bdaddr);
1551 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1552 cp.pscan_mode = e->data.pscan_mode;
1553 cp.clock_offset = e->data.clock_offset;
1554
1555 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1556}
1557
b644ba33 1558static bool hci_resolve_next_name(struct hci_dev *hdev)
30dc78e1
JH		 1559{
1560 struct discovery_state *discov = &hdev->discovery;
1561 struct inquiry_entry *e;
1562
b644ba33
JH		 1563 if (list_empty(&discov->resolve))
1564 return false;
1565
1566 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
c810089c
RM		 1567 if (!e)
1568 return false;
1569
b644ba33
JH		 1570 if (hci_resolve_name(hdev, e) == 0) {
1571 e->name_state = NAME_PENDING;
1572 return true;
1573 }
1574
1575 return false;
1576}
1577
1578static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
04124681 1579 bdaddr_t *bdaddr, u8 *name, u8 name_len)
b644ba33
JH		 1580{
1581 struct discovery_state *discov = &hdev->discovery;
1582 struct inquiry_entry *e;
1583
60cb49d2
JH		 1584 /* Update the mgmt connected state if necessary. Be careful with
1585 * conn objects that exist but are not (yet) connected however.
1586 * Only those in BT_CONFIG or BT_CONNECTED states can be
1587 * considered connected.
1588 */
1589 if (conn &&
1590 (conn->state == BT_CONFIG || conn->state == BT_CONNECTED) &&
cb77c3ec 1591 !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
48ec92fa 1592 mgmt_device_connected(hdev, conn, 0, name, name_len);
b644ba33
JH		 1593
1594 if (discov->state == DISCOVERY_STOPPED)
1595 return;
1596
30dc78e1
JH		 1597 if (discov->state == DISCOVERY_STOPPING)
1598 goto discov_complete;
1599
1600 if (discov->state != DISCOVERY_RESOLVING)
1601 return;
1602
1603 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
7cc8380e
RM		 1604 /* If the device was not found in a list of found devices names of which
1605 * are pending. there is no need to continue resolving a next name as it
1606 * will be done upon receiving another Remote Name Request Complete
1607 * Event */
1608 if (!e)
1609 return;
1610
1611 list_del(&e->list);
1612 if (name) {
30dc78e1 1613 e->name_state = NAME_KNOWN;
7cc8380e
RM		 1614 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1615 e->data.rssi, name, name_len);
c3e7c0d9
RM		 1616 } else {
1617 e->name_state = NAME_NOT_KNOWN;
30dc78e1
JH		 1618 }
1619
b644ba33 1620 if (hci_resolve_next_name(hdev))
30dc78e1 1621 return;
30dc78e1
JH		 1622
1623discov_complete:
1624 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1625}
1626
a9de9248
MH		 1627static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1628{
127178d2
JH		 1629 struct hci_cp_remote_name_req *cp;
1630 struct hci_conn *conn;
1631
9f1db00c 1632 BT_DBG("%s status 0x%2.2x", hdev->name, status);
127178d2
JH		 1633
1634 /* If successful wait for the name req complete event before
1635 * checking for the need to do authentication */
1636 if (!status)
1637 return;
1638
1639 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1640 if (!cp)
1641 return;
1642
1643 hci_dev_lock(hdev);
1644
b644ba33
JH		 1645 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1646
a8b2d5c2 1647 if (test_bit(HCI_MGMT, &hdev->dev_flags))
b644ba33 1648 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
30dc78e1 1649
79c6c70c
JH		 1650 if (!conn)
1651 goto unlock;
1652
1653 if (!hci_outgoing_auth_needed(hdev, conn))
1654 goto unlock;
1655
51a8efd7 1656 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
c1f23a2b
JB		 1657 struct hci_cp_auth_requested auth_cp;
1658
977f8fce
JH		 1659 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
1660
c1f23a2b
JB		 1661 auth_cp.handle = __cpu_to_le16(conn->handle);
1662 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1663 sizeof(auth_cp), &auth_cp);
127178d2
JH		 1664 }
1665
79c6c70c 1666unlock:
127178d2 1667 hci_dev_unlock(hdev);
a9de9248 1668}
1da177e4 1669
769be974
MH		 1670static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1671{
1672 struct hci_cp_read_remote_features *cp;
1673 struct hci_conn *conn;
1674
9f1db00c 1675 BT_DBG("%s status 0x%2.2x", hdev->name, status);
769be974
MH		 1676
1677 if (!status)
1678 return;
1679
1680 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1681 if (!cp)
1682 return;
1683
1684 hci_dev_lock(hdev);
1685
1686 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1687 if (conn) {
1688 if (conn->state == BT_CONFIG) {
769be974 1689 hci_proto_connect_cfm(conn, status);
76a68ba0 1690 hci_conn_drop(conn);
769be974
MH		 1691 }
1692 }
1693
1694 hci_dev_unlock(hdev);
1695}
1696
1697static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1698{
1699 struct hci_cp_read_remote_ext_features *cp;
1700 struct hci_conn *conn;
1701
9f1db00c 1702 BT_DBG("%s status 0x%2.2x", hdev->name, status);
769be974
MH		 1703
1704 if (!status)
1705 return;
1706
1707 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1708 if (!cp)
1709 return;
1710
1711 hci_dev_lock(hdev);
1712
1713 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1714 if (conn) {
1715 if (conn->state == BT_CONFIG) {
769be974 1716 hci_proto_connect_cfm(conn, status);
76a68ba0 1717 hci_conn_drop(conn);
769be974
MH		 1718 }
1719 }
1720
1721 hci_dev_unlock(hdev);
1722}
1723
a9de9248
MH		 1724static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1725{
b6a0dc82
MH		 1726 struct hci_cp_setup_sync_conn *cp;
1727 struct hci_conn *acl, *sco;
1728 __u16 handle;
1729
9f1db00c 1730 BT_DBG("%s status 0x%2.2x", hdev->name, status);
b6a0dc82
MH		 1731
1732 if (!status)
1733 return;
1734
1735 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1736 if (!cp)
1737 return;
1738
1739 handle = __le16_to_cpu(cp->handle);
1740
9f1db00c 1741 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
b6a0dc82
MH		 1742
1743 hci_dev_lock(hdev);
1744
1745 acl = hci_conn_hash_lookup_handle(hdev, handle);
5a08ecce
AE		 1746 if (acl) {
1747 sco = acl->link;
1748 if (sco) {
1749 sco->state = BT_CLOSED;
b6a0dc82 1750
5a08ecce
AE		 1751 hci_proto_connect_cfm(sco, status);
1752 hci_conn_del(sco);
1753 }
b6a0dc82
MH		 1754 }
1755
1756 hci_dev_unlock(hdev);
1da177e4
LT		 1757}
1758
a9de9248 1759static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1da177e4 1760{
a9de9248
MH		 1761 struct hci_cp_sniff_mode *cp;
1762 struct hci_conn *conn;
1da177e4 1763
9f1db00c 1764 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 1765
a9de9248
MH		 1766 if (!status)
1767 return;
04837f64 1768
a9de9248
MH		 1769 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1770 if (!cp)
1771 return;
04837f64 1772
a9de9248 1773 hci_dev_lock(hdev);
04837f64 1774
a9de9248 1775 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
e73439d8 1776 if (conn) {
51a8efd7 1777 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
04837f64 1778
51a8efd7 1779 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
e73439d8
MH		 1780 hci_sco_setup(conn, status);
1781 }
1782
a9de9248
MH		 1783 hci_dev_unlock(hdev);
1784}
04837f64 1785
a9de9248
MH		 1786static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1787{
1788 struct hci_cp_exit_sniff_mode *cp;
1789 struct hci_conn *conn;
04837f64 1790
9f1db00c 1791 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 1792
a9de9248
MH		 1793 if (!status)
1794 return;
04837f64 1795
a9de9248
MH		 1796 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1797 if (!cp)
1798 return;
04837f64 1799
a9de9248 1800 hci_dev_lock(hdev);
1da177e4 1801
a9de9248 1802 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
e73439d8 1803 if (conn) {
51a8efd7 1804 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
1da177e4 1805
51a8efd7 1806 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
e73439d8
MH		 1807 hci_sco_setup(conn, status);
1808 }
1809
a9de9248 1810 hci_dev_unlock(hdev);
1da177e4
LT		 1811}
1812
88c3df13
JH		 1813static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1814{
1815 struct hci_cp_disconnect *cp;
1816 struct hci_conn *conn;
1817
1818 if (!status)
1819 return;
1820
1821 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1822 if (!cp)
1823 return;
1824
1825 hci_dev_lock(hdev);
1826
1827 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1828 if (conn)
1829 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
04124681 1830 conn->dst_type, status);
88c3df13
JH		 1831
1832 hci_dev_unlock(hdev);
1833}
1834
a02226d6
AE		 1835static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1836{
93c284ee
AE		 1837 struct hci_cp_create_phy_link *cp;
1838
a02226d6 1839 BT_DBG("%s status 0x%2.2x", hdev->name, status);
93c284ee 1840
93c284ee
AE		 1841 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1842 if (!cp)
1843 return;
1844
e58917b9
AE		 1845 hci_dev_lock(hdev);
1846
1847 if (status) {
1848 struct hci_conn *hcon;
1849
1850 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1851 if (hcon)
1852 hci_conn_del(hcon);
1853 } else {
1854 amp_write_remote_assoc(hdev, cp->phy_handle);
1855 }
1856
1857 hci_dev_unlock(hdev);
a02226d6
AE		 1858}
1859
0b26ab9d
AE		 1860static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1861{
1862 struct hci_cp_accept_phy_link *cp;
1863
1864 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1865
1866 if (status)
1867 return;
1868
1869 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1870 if (!cp)
1871 return;
1872
1873 amp_write_remote_assoc(hdev, cp->phy_handle);
1874}
1875
cb1d68f7
JH		 1876static void hci_cs_le_create_conn(struct hci_dev *hdev, u8 status)
1877{
1878 struct hci_cp_le_create_conn *cp;
1879 struct hci_conn *conn;
1880
1881 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1882
1883 /* All connection failure handling is taken care of by the
1884 * hci_le_conn_failed function which is triggered by the HCI
1885 * request completion callbacks used for connecting.
1886 */
1887 if (status)
1888 return;
1889
1890 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1891 if (!cp)
1892 return;
1893
1894 hci_dev_lock(hdev);
1895
1896 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1897 if (!conn)
1898 goto unlock;
1899
1900 /* Store the initiator and responder address information which
1901 * is needed for SMP. These values will not change during the
1902 * lifetime of the connection.
1903 */
1904 conn->init_addr_type = cp->own_address_type;
1905 if (cp->own_address_type == ADDR_LE_DEV_RANDOM)
1906 bacpy(&conn->init_addr, &hdev->random_addr);
1907 else
1908 bacpy(&conn->init_addr, &hdev->bdaddr);
1909
1910 conn->resp_addr_type = cp->peer_addr_type;
1911 bacpy(&conn->resp_addr, &cp->peer_addr);
1912
9489eca4
JH		 1913 /* We don't want the connection attempt to stick around
1914 * indefinitely since LE doesn't have a page timeout concept
1915 * like BR/EDR. Set a timer for any connection that doesn't use
1916 * the white list for connecting.
1917 */
1918 if (cp->filter_policy == HCI_LE_USE_PEER_ADDR)
1919 queue_delayed_work(conn->hdev->workqueue,
1920 &conn->le_conn_timeout,
09ae260b 1921 conn->conn_timeout);
9489eca4 1922
cb1d68f7
JH		 1923unlock:
1924 hci_dev_unlock(hdev);
1925}
1926
81d0c8ad
JH		 1927static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1928{
1929 struct hci_cp_le_start_enc *cp;
1930 struct hci_conn *conn;
1931
1932 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1933
1934 if (!status)
1935 return;
1936
1937 hci_dev_lock(hdev);
1938
1939 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_START_ENC);
1940 if (!cp)
1941 goto unlock;
1942
1943 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1944 if (!conn)
1945 goto unlock;
1946
1947 if (conn->state != BT_CONNECTED)
1948 goto unlock;
1949
1950 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
1951 hci_conn_drop(conn);
1952
1953unlock:
1954 hci_dev_unlock(hdev);
1955}
1956
50fc85f1
KP		 1957static void hci_cs_switch_role(struct hci_dev *hdev, u8 status)
1958{
1959 struct hci_cp_switch_role *cp;
1960 struct hci_conn *conn;
1961
1962 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1963
1964 if (!status)
1965 return;
1966
1967 cp = hci_sent_cmd_data(hdev, HCI_OP_SWITCH_ROLE);
1968 if (!cp)
1969 return;
1970
1971 hci_dev_lock(hdev);
1972
1973 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1974 if (conn)
1975 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
1976
1977 hci_dev_unlock(hdev);
1978}
1979
6039aa73 1980static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4
LT		 1981{
1982 __u8 status = *((__u8 *) skb->data);
30dc78e1
JH		 1983 struct discovery_state *discov = &hdev->discovery;
1984 struct inquiry_entry *e;
1da177e4 1985
9f1db00c 1986 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 1987
a9de9248 1988 hci_conn_check_pending(hdev);
89352e7d
AG		 1989
1990 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1991 return;
1992
4e857c58 1993 smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
3e13fa1e
AG		 1994 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1995
a8b2d5c2 1996 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
30dc78e1
JH		 1997 return;
1998
56e5cb86 1999 hci_dev_lock(hdev);
30dc78e1 2000
343f935b 2001 if (discov->state != DISCOVERY_FINDING)
30dc78e1
JH		 2002 goto unlock;
2003
2004 if (list_empty(&discov->resolve)) {
2005 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
2006 goto unlock;
2007 }
2008
2009 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
2010 if (e && hci_resolve_name(hdev, e) == 0) {
2011 e->name_state = NAME_PENDING;
2012 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
2013 } else {
2014 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
2015 }
2016
2017unlock:
56e5cb86 2018 hci_dev_unlock(hdev);
1da177e4
LT		 2019}
2020
6039aa73 2021static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2022{
45bb4bf0 2023 struct inquiry_data data;
a9de9248 2024 struct inquiry_info *info = (void *) (skb->data + 1);
1da177e4
LT		 2025 int num_rsp = *((__u8 *) skb->data);
2026
2027 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2028
45bb4bf0
MH		 2029 if (!num_rsp)
2030 return;
2031
1519cc17
AG		 2032 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2033 return;
2034
1da177e4 2035 hci_dev_lock(hdev);
45bb4bf0 2036
e17acd40 2037 for (; num_rsp; num_rsp--, info++) {
af58925c 2038 u32 flags;
3175405b 2039
1da177e4
LT		 2040 bacpy(&data.bdaddr, &info->bdaddr);
2041 data.pscan_rep_mode = info->pscan_rep_mode;
2042 data.pscan_period_mode = info->pscan_period_mode;
2043 data.pscan_mode = info->pscan_mode;
2044 memcpy(data.dev_class, info->dev_class, 3);
2045 data.clock_offset = info->clock_offset;
2046 data.rssi = 0x00;
41a96212 2047 data.ssp_mode = 0x00;
3175405b 2048
af58925c
MH		 2049 flags = hci_inquiry_cache_update(hdev, &data, false);
2050
48264f06 2051 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
af58925c 2052 info->dev_class, 0, flags, NULL, 0, NULL, 0);
1da177e4 2053 }
45bb4bf0 2054
1da177e4
LT		 2055 hci_dev_unlock(hdev);
2056}
2057
6039aa73 2058static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2059{
a9de9248
MH		 2060 struct hci_ev_conn_complete *ev = (void *) skb->data;
2061 struct hci_conn *conn;
1da177e4
LT		 2062
2063 BT_DBG("%s", hdev->name);
2064
2065 hci_dev_lock(hdev);
2066
2067 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9499237a
MH		 2068 if (!conn) {
2069 if (ev->link_type != SCO_LINK)
2070 goto unlock;
2071
2072 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2073 if (!conn)
2074 goto unlock;
2075
2076 conn->type = SCO_LINK;
2077 }
1da177e4
LT		 2078
2079 if (!ev->status) {
2080 conn->handle = __le16_to_cpu(ev->handle);
769be974
MH		 2081
2082 if (conn->type == ACL_LINK) {
2083 conn->state = BT_CONFIG;
2084 hci_conn_hold(conn);
a9ea3ed9
SJ		 2085
2086 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
2087 !hci_find_link_key(hdev, &ev->bdaddr))
2088 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2089 else
2090 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
769be974
MH		 2091 } else
2092 conn->state = BT_CONNECTED;
1da177e4 2093
7d0db0a3
MH		 2094 hci_conn_add_sysfs(conn);
2095
1da177e4 2096 if (test_bit(HCI_AUTH, &hdev->flags))
4dae2798 2097 set_bit(HCI_CONN_AUTH, &conn->flags);
1da177e4
LT		 2098
2099 if (test_bit(HCI_ENCRYPT, &hdev->flags))
4dae2798 2100 set_bit(HCI_CONN_ENCRYPT, &conn->flags);
1da177e4 2101
04837f64
MH		 2102 /* Get remote features */
2103 if (conn->type == ACL_LINK) {
2104 struct hci_cp_read_remote_features cp;
2105 cp.handle = ev->handle;
769be974 2106 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
04124681 2107 sizeof(cp), &cp);
22f433dc
JH		 2108
2109 hci_update_page_scan(hdev, NULL);
04837f64
MH		 2110 }
2111
1da177e4 2112 /* Set packet type for incoming connection */
d095c1eb 2113 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
1da177e4
LT		 2114 struct hci_cp_change_conn_ptype cp;
2115 cp.handle = ev->handle;
a8746417 2116 cp.pkt_type = cpu_to_le16(conn->pkt_type);
04124681
GP		 2117 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
2118 &cp);
1da177e4 2119 }
17d5c04c 2120 } else {
1da177e4 2121 conn->state = BT_CLOSED;
17d5c04c 2122 if (conn->type == ACL_LINK)
64c7b77c 2123 mgmt_connect_failed(hdev, &conn->dst, conn->type,
04124681 2124 conn->dst_type, ev->status);
17d5c04c 2125 }
1da177e4 2126
e73439d8
MH		 2127 if (conn->type == ACL_LINK)
2128 hci_sco_setup(conn, ev->status);
1da177e4 2129
769be974
MH		 2130 if (ev->status) {
2131 hci_proto_connect_cfm(conn, ev->status);
1da177e4 2132 hci_conn_del(conn);
c89b6e6b
MH		 2133 } else if (ev->link_type != ACL_LINK)
2134 hci_proto_connect_cfm(conn, ev->status);
1da177e4 2135
a9de9248 2136unlock:
1da177e4 2137 hci_dev_unlock(hdev);
1da177e4 2138
a9de9248 2139 hci_conn_check_pending(hdev);
1da177e4
LT		 2140}
2141
70c46425
JH		 2142static void hci_reject_conn(struct hci_dev *hdev, bdaddr_t *bdaddr)
2143{
2144 struct hci_cp_reject_conn_req cp;
2145
2146 bacpy(&cp.bdaddr, bdaddr);
2147 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
2148 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
2149}
2150
6039aa73 2151static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2152{
a9de9248
MH		 2153 struct hci_ev_conn_request *ev = (void *) skb->data;
2154 int mask = hdev->link_mode;
70c46425
JH		 2155 struct inquiry_entry *ie;
2156 struct hci_conn *conn;
20714bfe 2157 __u8 flags = 0;
1da177e4 2158
6ed93dc6 2159 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
807deac2 2160 ev->link_type);
1da177e4 2161
20714bfe
FD		 2162 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
2163 &flags);
1da177e4 2164
70c46425
JH		 2165 if (!(mask & HCI_LM_ACCEPT)) {
2166 hci_reject_conn(hdev, &ev->bdaddr);
2167 return;
2168 }
2169
46c4c941
JH		 2170 if (hci_bdaddr_list_lookup(&hdev->blacklist, &ev->bdaddr,
2171 BDADDR_BREDR)) {
2172 hci_reject_conn(hdev, &ev->bdaddr);
2173 return;
2174 }
2175
2176 if (!test_bit(HCI_CONNECTABLE, &hdev->dev_flags) &&
2177 !hci_bdaddr_list_lookup(&hdev->whitelist, &ev->bdaddr,
2178 BDADDR_BREDR)) {
2179 hci_reject_conn(hdev, &ev->bdaddr);
2180 return;
70c46425 2181 }
1da177e4 2182
70c46425 2183 /* Connection accepted */
b6a0dc82 2184
70c46425
JH		 2185 hci_dev_lock(hdev);
2186
2187 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2188 if (ie)
2189 memcpy(ie->data.dev_class, ev->dev_class, 3);
c7bdd502 2190
70c46425
JH		 2191 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
2192 &ev->bdaddr);
2193 if (!conn) {
a5c4e309
JH		 2194 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr,
2195 HCI_ROLE_SLAVE);
a9de9248 2196 if (!conn) {
70c46425
JH		 2197 BT_ERR("No memory for new connection");
2198 hci_dev_unlock(hdev);
2199 return;
1da177e4 2200 }
70c46425 2201 }
b6a0dc82 2202
70c46425 2203 memcpy(conn->dev_class, ev->dev_class, 3);
b6a0dc82 2204
70c46425 2205 hci_dev_unlock(hdev);
1da177e4 2206
70c46425
JH		 2207 if (ev->link_type == ACL_LINK ||
2208 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
2209 struct hci_cp_accept_conn_req cp;
2210 conn->state = BT_CONNECT;
1da177e4 2211
70c46425 2212 bacpy(&cp.bdaddr, &ev->bdaddr);
b6a0dc82 2213
70c46425
JH		 2214 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
2215 cp.role = 0x00; /* Become master */
2216 else
2217 cp.role = 0x01; /* Remain slave */
b6a0dc82 2218
70c46425
JH		 2219 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp), &cp);
2220 } else if (!(flags & HCI_PROTO_DEFER)) {
2221 struct hci_cp_accept_sync_conn_req cp;
2222 conn->state = BT_CONNECT;
b6a0dc82 2223
70c46425
JH		 2224 bacpy(&cp.bdaddr, &ev->bdaddr);
2225 cp.pkt_type = cpu_to_le16(conn->pkt_type);
b6a0dc82 2226
70c46425
JH		 2227 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
2228 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
2229 cp.max_latency = cpu_to_le16(0xffff);
2230 cp.content_format = cpu_to_le16(hdev->voice_setting);
2231 cp.retrans_effort = 0xff;
1da177e4 2232
70c46425
JH		 2233 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ, sizeof(cp),
2234 &cp);
a9de9248 2235 } else {
70c46425
JH		 2236 conn->state = BT_CONNECT2;
2237 hci_proto_connect_cfm(conn, 0);
1da177e4 2238 }
1da177e4
LT		 2239}
2240
f0d6a0ea
MA		 2241static u8 hci_to_mgmt_reason(u8 err)
2242{
2243 switch (err) {
2244 case HCI_ERROR_CONNECTION_TIMEOUT:
2245 return MGMT_DEV_DISCONN_TIMEOUT;
2246 case HCI_ERROR_REMOTE_USER_TERM:
2247 case HCI_ERROR_REMOTE_LOW_RESOURCES:
2248 case HCI_ERROR_REMOTE_POWER_OFF:
2249 return MGMT_DEV_DISCONN_REMOTE;
2250 case HCI_ERROR_LOCAL_HOST_TERM:
2251 return MGMT_DEV_DISCONN_LOCAL_HOST;
2252 default:
2253 return MGMT_DEV_DISCONN_UNKNOWN;
2254 }
2255}
2256
6039aa73 2257static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
04837f64 2258{
a9de9248 2259 struct hci_ev_disconn_complete *ev = (void *) skb->data;
abf54a50 2260 u8 reason = hci_to_mgmt_reason(ev->reason);
9fcb18ef 2261 struct hci_conn_params *params;
04837f64 2262 struct hci_conn *conn;
12d4a3b2 2263 bool mgmt_connected;
3846220b 2264 u8 type;
04837f64 2265
9f1db00c 2266 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
04837f64
MH		 2267
2268 hci_dev_lock(hdev);
2269
2270 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
f7520543
JH		 2271 if (!conn)
2272 goto unlock;
7d0db0a3 2273
abf54a50
AG		 2274 if (ev->status) {
2275 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2276 conn->dst_type, ev->status);
2277 goto unlock;
37d9ef76 2278 }
f7520543 2279
3846220b
AG		 2280 conn->state = BT_CLOSED;
2281
12d4a3b2
JH		 2282 mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2283 mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
2284 reason, mgmt_connected);
abf54a50 2285
22f433dc
JH		 2286 if (conn->type == ACL_LINK) {
2287 if (test_bit(HCI_CONN_FLUSH_KEY, &conn->flags))
2288 hci_remove_link_key(hdev, &conn->dst);
2289
2290 hci_update_page_scan(hdev, NULL);
2291 }
2210246c 2292
9fcb18ef
AG		 2293 params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
2294 if (params) {
2295 switch (params->auto_connect) {
2296 case HCI_AUTO_CONN_LINK_LOSS:
2297 if (ev->reason != HCI_ERROR_CONNECTION_TIMEOUT)
2298 break;
2299 /* Fall through */
2300
4b9e7e75 2301 case HCI_AUTO_CONN_DIRECT:
9fcb18ef 2302 case HCI_AUTO_CONN_ALWAYS:
418025d1
JH		 2303 list_del_init(&params->action);
2304 list_add(&params->action, &hdev->pend_le_conns);
2305 hci_update_background_scan(hdev);
9fcb18ef
AG		 2306 break;
2307
2308 default:
2309 break;
2310 }
2311 }
2312
3846220b 2313 type = conn->type;
2210246c 2314
3846220b
AG		 2315 hci_proto_disconn_cfm(conn, ev->reason);
2316 hci_conn_del(conn);
2317
2318 /* Re-enable advertising if necessary, since it might
2319 * have been disabled by the connection. From the
2320 * HCI_LE_Set_Advertise_Enable command description in
2321 * the core specification (v4.0):
2322 * "The Controller shall continue advertising until the Host
2323 * issues an LE_Set_Advertise_Enable command with
2324 * Advertising_Enable set to 0x00 (Advertising is disabled)
2325 * or until a connection is created or until the Advertising
2326 * is timed out due to Directed Advertising."
2327 */
2328 if (type == LE_LINK)
2329 mgmt_reenable_advertising(hdev);
f7520543
JH		 2330
2331unlock:
04837f64
MH		 2332 hci_dev_unlock(hdev);
2333}
2334
6039aa73 2335static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2336{
a9de9248 2337 struct hci_ev_auth_complete *ev = (void *) skb->data;
04837f64 2338 struct hci_conn *conn;
1da177e4 2339
9f1db00c 2340 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT		 2341
2342 hci_dev_lock(hdev);
2343
04837f64 2344 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
d7556e20
WR		 2345 if (!conn)
2346 goto unlock;
2347
2348 if (!ev->status) {
aa64a8b5 2349 if (!hci_conn_ssp_enabled(conn) &&
807deac2 2350 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
d7556e20 2351 BT_INFO("re-auth of legacy device is not possible.");
2a611692 2352 } else {
4dae2798 2353 set_bit(HCI_CONN_AUTH, &conn->flags);
d7556e20 2354 conn->sec_level = conn->pending_sec_level;
2a611692 2355 }
d7556e20 2356 } else {
e1e930f5 2357 mgmt_auth_failed(conn, ev->status);
d7556e20 2358 }
1da177e4 2359
51a8efd7
JH		 2360 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
2361 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
1da177e4 2362
d7556e20 2363 if (conn->state == BT_CONFIG) {
aa64a8b5 2364 if (!ev->status && hci_conn_ssp_enabled(conn)) {
d7556e20
WR		 2365 struct hci_cp_set_conn_encrypt cp;
2366 cp.handle = ev->handle;
2367 cp.encrypt = 0x01;
2368 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
807deac2 2369 &cp);
052b30b0 2370 } else {
d7556e20
WR		 2371 conn->state = BT_CONNECTED;
2372 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 2373 hci_conn_drop(conn);
052b30b0 2374 }
d7556e20
WR		 2375 } else {
2376 hci_auth_cfm(conn, ev->status);
052b30b0 2377
d7556e20
WR		 2378 hci_conn_hold(conn);
2379 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 2380 hci_conn_drop(conn);
d7556e20
WR		 2381 }
2382
51a8efd7 2383 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
d7556e20
WR		 2384 if (!ev->status) {
2385 struct hci_cp_set_conn_encrypt cp;
2386 cp.handle = ev->handle;
2387 cp.encrypt = 0x01;
2388 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
807deac2 2389 &cp);
d7556e20 2390 } else {
51a8efd7 2391 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
d7556e20 2392 hci_encrypt_cfm(conn, ev->status, 0x00);
1da177e4
LT		 2393 }
2394 }
2395
d7556e20 2396unlock:
1da177e4
LT		 2397 hci_dev_unlock(hdev);
2398}
2399
6039aa73 2400static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2401{
127178d2
JH		 2402 struct hci_ev_remote_name *ev = (void *) skb->data;
2403 struct hci_conn *conn;
2404
a9de9248 2405 BT_DBG("%s", hdev->name);
1da177e4 2406
a9de9248 2407 hci_conn_check_pending(hdev);
127178d2
JH		 2408
2409 hci_dev_lock(hdev);
2410
b644ba33 2411 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
30dc78e1 2412
b644ba33
JH		 2413 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
2414 goto check_auth;
a88a9652 2415
b644ba33
JH		 2416 if (ev->status == 0)
2417 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
04124681 2418 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
b644ba33
JH		 2419 else
2420 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
2421
2422check_auth:
79c6c70c
JH		 2423 if (!conn)
2424 goto unlock;
2425
2426 if (!hci_outgoing_auth_needed(hdev, conn))
2427 goto unlock;
2428
51a8efd7 2429 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
127178d2 2430 struct hci_cp_auth_requested cp;
977f8fce
JH		 2431
2432 set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);
2433
127178d2
JH		 2434 cp.handle = __cpu_to_le16(conn->handle);
2435 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
2436 }
2437
79c6c70c 2438unlock:
127178d2 2439 hci_dev_unlock(hdev);
a9de9248
MH		 2440}
2441
6039aa73 2442static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH		 2443{
2444 struct hci_ev_encrypt_change *ev = (void *) skb->data;
2445 struct hci_conn *conn;
2446
9f1db00c 2447 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT		 2448
2449 hci_dev_lock(hdev);
2450
04837f64 2451 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
dc8357cc
MH		 2452 if (!conn)
2453 goto unlock;
1da177e4 2454
dc8357cc
MH		 2455 if (!ev->status) {
2456 if (ev->encrypt) {
2457 /* Encryption implies authentication */
4dae2798
JH		 2458 set_bit(HCI_CONN_AUTH, &conn->flags);
2459 set_bit(HCI_CONN_ENCRYPT, &conn->flags);
dc8357cc 2460 conn->sec_level = conn->pending_sec_level;
abf76bad 2461
914a6ffe
MH		 2462 /* P-256 authentication key implies FIPS */
2463 if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
4dae2798 2464 set_bit(HCI_CONN_FIPS, &conn->flags);
914a6ffe 2465
abf76bad
MH		 2466 if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
2467 conn->type == LE_LINK)
2468 set_bit(HCI_CONN_AES_CCM, &conn->flags);
2469 } else {
4dae2798 2470 clear_bit(HCI_CONN_ENCRYPT, &conn->flags);
abf76bad
MH		 2471 clear_bit(HCI_CONN_AES_CCM, &conn->flags);
2472 }
dc8357cc 2473 }
a7d7723a 2474
7ed3fa20
JH		 2475 /* We should disregard the current RPA and generate a new one
2476 * whenever the encryption procedure fails.
2477 */
2478 if (ev->status && conn->type == LE_LINK)
2479 set_bit(HCI_RPA_EXPIRED, &hdev->dev_flags);
2480
dc8357cc 2481 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
f8558555 2482
dc8357cc
MH		 2483 if (ev->status && conn->state == BT_CONNECTED) {
2484 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
2485 hci_conn_drop(conn);
2486 goto unlock;
1da177e4
LT		 2487 }
2488
dc8357cc
MH		 2489 if (conn->state == BT_CONFIG) {
2490 if (!ev->status)
2491 conn->state = BT_CONNECTED;
2492
40b552aa
MH		 2493 /* In Secure Connections Only mode, do not allow any
2494 * connections that are not encrypted with AES-CCM
2495 * using a P-256 authenticated combination key.
2496 */
2497 if (test_bit(HCI_SC_ONLY, &hdev->dev_flags) &&
2498 (!test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
2499 conn->key_type != HCI_LK_AUTH_COMBINATION_P256)) {
2500 hci_proto_connect_cfm(conn, HCI_ERROR_AUTH_FAILURE);
2501 hci_conn_drop(conn);
2502 goto unlock;
2503 }
2504
dc8357cc
MH		 2505 hci_proto_connect_cfm(conn, ev->status);
2506 hci_conn_drop(conn);
2507 } else
2508 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
2509
a7d7723a 2510unlock:
1da177e4
LT		 2511 hci_dev_unlock(hdev);
2512}
2513
6039aa73
GP		 2514static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2515 struct sk_buff *skb)
1da177e4 2516{
a9de9248 2517 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
04837f64 2518 struct hci_conn *conn;
1da177e4 2519
9f1db00c 2520 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT		 2521
2522 hci_dev_lock(hdev);
2523
04837f64 2524 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT		 2525 if (conn) {
2526 if (!ev->status)
4dae2798 2527 set_bit(HCI_CONN_SECURE, &conn->flags);
1da177e4 2528
51a8efd7 2529 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
1da177e4
LT		 2530
2531 hci_key_change_cfm(conn, ev->status);
2532 }
2533
2534 hci_dev_unlock(hdev);
2535}
2536
6039aa73
GP		 2537static void hci_remote_features_evt(struct hci_dev *hdev,
2538 struct sk_buff *skb)
1da177e4 2539{
a9de9248
MH		 2540 struct hci_ev_remote_features *ev = (void *) skb->data;
2541 struct hci_conn *conn;
2542
9f1db00c 2543 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a9de9248 2544
a9de9248
MH		 2545 hci_dev_lock(hdev);
2546
2547 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH		 2548 if (!conn)
2549 goto unlock;
769be974 2550
ccd556fe 2551 if (!ev->status)
cad718ed 2552 memcpy(conn->features[0], ev->features, 8);
ccd556fe
JH		 2553
2554 if (conn->state != BT_CONFIG)
2555 goto unlock;
2556
2557 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2558 struct hci_cp_read_remote_ext_features cp;
2559 cp.handle = ev->handle;
2560 cp.page = 0x01;
2561 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
807deac2 2562 sizeof(cp), &cp);
392599b9
JH		 2563 goto unlock;
2564 }
2565
671267bf 2566 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
127178d2
JH		 2567 struct hci_cp_remote_name_req cp;
2568 memset(&cp, 0, sizeof(cp));
2569 bacpy(&cp.bdaddr, &conn->dst);
2570 cp.pscan_rep_mode = 0x02;
2571 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
b644ba33 2572 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
48ec92fa 2573 mgmt_device_connected(hdev, conn, 0, NULL, 0);
392599b9 2574
127178d2 2575 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH		 2576 conn->state = BT_CONNECTED;
2577 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 2578 hci_conn_drop(conn);
769be974 2579 }
a9de9248 2580
ccd556fe 2581unlock:
a9de9248 2582 hci_dev_unlock(hdev);
1da177e4
LT		 2583}
2584
6039aa73 2585static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH		 2586{
2587 struct hci_ev_cmd_complete *ev = (void *) skb->data;
9238f36a 2588 u8 status = skb->data[sizeof(*ev)];
a9de9248
MH		 2589 __u16 opcode;
2590
2591 skb_pull(skb, sizeof(*ev));
2592
2593 opcode = __le16_to_cpu(ev->opcode);
2594
2595 switch (opcode) {
2596 case HCI_OP_INQUIRY_CANCEL:
2597 hci_cc_inquiry_cancel(hdev, skb);
2598 break;
2599
4d93483b
AG		 2600 case HCI_OP_PERIODIC_INQ:
2601 hci_cc_periodic_inq(hdev, skb);
2602 break;
2603
a9de9248
MH		 2604 case HCI_OP_EXIT_PERIODIC_INQ:
2605 hci_cc_exit_periodic_inq(hdev, skb);
2606 break;
2607
2608 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2609 hci_cc_remote_name_req_cancel(hdev, skb);
2610 break;
2611
2612 case HCI_OP_ROLE_DISCOVERY:
2613 hci_cc_role_discovery(hdev, skb);
2614 break;
2615
e4e8e37c
MH		 2616 case HCI_OP_READ_LINK_POLICY:
2617 hci_cc_read_link_policy(hdev, skb);
2618 break;
2619
a9de9248
MH		 2620 case HCI_OP_WRITE_LINK_POLICY:
2621 hci_cc_write_link_policy(hdev, skb);
2622 break;
2623
e4e8e37c
MH		 2624 case HCI_OP_READ_DEF_LINK_POLICY:
2625 hci_cc_read_def_link_policy(hdev, skb);
2626 break;
2627
2628 case HCI_OP_WRITE_DEF_LINK_POLICY:
2629 hci_cc_write_def_link_policy(hdev, skb);
2630 break;
2631
a9de9248
MH		 2632 case HCI_OP_RESET:
2633 hci_cc_reset(hdev, skb);
2634 break;
2635
2636 case HCI_OP_WRITE_LOCAL_NAME:
2637 hci_cc_write_local_name(hdev, skb);
2638 break;
2639
2640 case HCI_OP_READ_LOCAL_NAME:
2641 hci_cc_read_local_name(hdev, skb);
2642 break;
2643
2644 case HCI_OP_WRITE_AUTH_ENABLE:
2645 hci_cc_write_auth_enable(hdev, skb);
2646 break;
2647
2648 case HCI_OP_WRITE_ENCRYPT_MODE:
2649 hci_cc_write_encrypt_mode(hdev, skb);
2650 break;
2651
2652 case HCI_OP_WRITE_SCAN_ENABLE:
2653 hci_cc_write_scan_enable(hdev, skb);
2654 break;
2655
2656 case HCI_OP_READ_CLASS_OF_DEV:
2657 hci_cc_read_class_of_dev(hdev, skb);
2658 break;
2659
2660 case HCI_OP_WRITE_CLASS_OF_DEV:
2661 hci_cc_write_class_of_dev(hdev, skb);
2662 break;
2663
2664 case HCI_OP_READ_VOICE_SETTING:
2665 hci_cc_read_voice_setting(hdev, skb);
2666 break;
2667
2668 case HCI_OP_WRITE_VOICE_SETTING:
2669 hci_cc_write_voice_setting(hdev, skb);
2670 break;
2671
b4cb9fb2
MH		 2672 case HCI_OP_READ_NUM_SUPPORTED_IAC:
2673 hci_cc_read_num_supported_iac(hdev, skb);
2674 break;
2675
333140b5
MH		 2676 case HCI_OP_WRITE_SSP_MODE:
2677 hci_cc_write_ssp_mode(hdev, skb);
2678 break;
2679
eac83dc6
MH		 2680 case HCI_OP_WRITE_SC_SUPPORT:
2681 hci_cc_write_sc_support(hdev, skb);
2682 break;
2683
a9de9248
MH		 2684 case HCI_OP_READ_LOCAL_VERSION:
2685 hci_cc_read_local_version(hdev, skb);
2686 break;
2687
2688 case HCI_OP_READ_LOCAL_COMMANDS:
2689 hci_cc_read_local_commands(hdev, skb);
2690 break;
2691
2692 case HCI_OP_READ_LOCAL_FEATURES:
2693 hci_cc_read_local_features(hdev, skb);
2694 break;
2695
971e3a4b
AG		 2696 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2697 hci_cc_read_local_ext_features(hdev, skb);
2698 break;
2699
a9de9248
MH		 2700 case HCI_OP_READ_BUFFER_SIZE:
2701 hci_cc_read_buffer_size(hdev, skb);
2702 break;
2703
2704 case HCI_OP_READ_BD_ADDR:
2705 hci_cc_read_bd_addr(hdev, skb);
2706 break;
2707
f332ec66
JH		 2708 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2709 hci_cc_read_page_scan_activity(hdev, skb);
2710 break;
2711
4a3ee763
JH		 2712 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2713 hci_cc_write_page_scan_activity(hdev, skb);
2714 break;
2715
f332ec66
JH		 2716 case HCI_OP_READ_PAGE_SCAN_TYPE:
2717 hci_cc_read_page_scan_type(hdev, skb);
2718 break;
2719
4a3ee763
JH		 2720 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2721 hci_cc_write_page_scan_type(hdev, skb);
2722 break;
2723
350ee4cf
AE		 2724 case HCI_OP_READ_DATA_BLOCK_SIZE:
2725 hci_cc_read_data_block_size(hdev, skb);
2726 break;
2727
1e89cffb
AE		 2728 case HCI_OP_READ_FLOW_CONTROL_MODE:
2729 hci_cc_read_flow_control_mode(hdev, skb);
2730 break;
2731
928abaa7
AE		 2732 case HCI_OP_READ_LOCAL_AMP_INFO:
2733 hci_cc_read_local_amp_info(hdev, skb);
2734 break;
2735
33f35721
JH		 2736 case HCI_OP_READ_CLOCK:
2737 hci_cc_read_clock(hdev, skb);
2738 break;
2739
903e4541
AE		 2740 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2741 hci_cc_read_local_amp_assoc(hdev, skb);
2742 break;
2743
d5859e22
JH		 2744 case HCI_OP_READ_INQ_RSP_TX_POWER:
2745 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2746 break;
2747
980e1a53
JH		 2748 case HCI_OP_PIN_CODE_REPLY:
2749 hci_cc_pin_code_reply(hdev, skb);
2750 break;
2751
2752 case HCI_OP_PIN_CODE_NEG_REPLY:
2753 hci_cc_pin_code_neg_reply(hdev, skb);
2754 break;
2755
c35938b2 2756 case HCI_OP_READ_LOCAL_OOB_DATA:
4d2d2796
MH		 2757 hci_cc_read_local_oob_data(hdev, skb);
2758 break;
2759
2760 case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
2761 hci_cc_read_local_oob_ext_data(hdev, skb);
c35938b2
SJ		 2762 break;
2763
6ed58ec5
VT		 2764 case HCI_OP_LE_READ_BUFFER_SIZE:
2765 hci_cc_le_read_buffer_size(hdev, skb);
2766 break;
2767
60e77321
JH		 2768 case HCI_OP_LE_READ_LOCAL_FEATURES:
2769 hci_cc_le_read_local_features(hdev, skb);
2770 break;
2771
8fa19098
JH		 2772 case HCI_OP_LE_READ_ADV_TX_POWER:
2773 hci_cc_le_read_adv_tx_power(hdev, skb);
2774 break;
2775
a5c29683
JH		 2776 case HCI_OP_USER_CONFIRM_REPLY:
2777 hci_cc_user_confirm_reply(hdev, skb);
2778 break;
2779
2780 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2781 hci_cc_user_confirm_neg_reply(hdev, skb);
2782 break;
2783
1143d458
BG		 2784 case HCI_OP_USER_PASSKEY_REPLY:
2785 hci_cc_user_passkey_reply(hdev, skb);
2786 break;
2787
2788 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2789 hci_cc_user_passkey_neg_reply(hdev, skb);
16cde993 2790 break;
07f7fa5d 2791
7a4cd51d
MH		 2792 case HCI_OP_LE_SET_RANDOM_ADDR:
2793 hci_cc_le_set_random_addr(hdev, skb);
2794 break;
2795
c1d5dc4a
JH		 2796 case HCI_OP_LE_SET_ADV_ENABLE:
2797 hci_cc_le_set_adv_enable(hdev, skb);
2798 break;
2799
533553f8
MH		 2800 case HCI_OP_LE_SET_SCAN_PARAM:
2801 hci_cc_le_set_scan_param(hdev, skb);
2802 break;
2803
eb9d91f5
AG		 2804 case HCI_OP_LE_SET_SCAN_ENABLE:
2805 hci_cc_le_set_scan_enable(hdev, skb);
2806 break;
2807
cf1d081f
JH		 2808 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2809 hci_cc_le_read_white_list_size(hdev, skb);
2810 break;
2811
0f36b589
MH		 2812 case HCI_OP_LE_CLEAR_WHITE_LIST:
2813 hci_cc_le_clear_white_list(hdev, skb);
2814 break;
2815
2816 case HCI_OP_LE_ADD_TO_WHITE_LIST:
2817 hci_cc_le_add_to_white_list(hdev, skb);
2818 break;
2819
2820 case HCI_OP_LE_DEL_FROM_WHITE_LIST:
2821 hci_cc_le_del_from_white_list(hdev, skb);
2822 break;
2823
9b008c04
JH		 2824 case HCI_OP_LE_READ_SUPPORTED_STATES:
2825 hci_cc_le_read_supported_states(hdev, skb);
2826 break;
2827
f9b49306
AG		 2828 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2829 hci_cc_write_le_host_supported(hdev, skb);
2830 break;
2831
56ed2cb8
JH		 2832 case HCI_OP_LE_SET_ADV_PARAM:
2833 hci_cc_set_adv_param(hdev, skb);
2834 break;
2835
93c284ee
AE		 2836 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2837 hci_cc_write_remote_amp_assoc(hdev, skb);
2838 break;
2839
5ae76a94
AK		 2840 case HCI_OP_READ_RSSI:
2841 hci_cc_read_rssi(hdev, skb);
2842 break;
2843
5a134fae
AK		 2844 case HCI_OP_READ_TX_POWER:
2845 hci_cc_read_tx_power(hdev, skb);
2846 break;
2847
a9de9248 2848 default:
9f1db00c 2849 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
a9de9248
MH		 2850 break;
2851 }
2852
ad82cdd1 2853 if (opcode != HCI_OP_NOP)
65cc2b49 2854 cancel_delayed_work(&hdev->cmd_timer);
6bd32326 2855
ad82cdd1 2856 hci_req_cmd_complete(hdev, opcode, status);
9238f36a 2857
dbccd791 2858 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
a9de9248
MH		 2859 atomic_set(&hdev->cmd_cnt, 1);
2860 if (!skb_queue_empty(&hdev->cmd_q))
c347b765 2861 queue_work(hdev->workqueue, &hdev->cmd_work);
a9de9248
MH		 2862 }
2863}
2864
6039aa73 2865static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH		 2866{
2867 struct hci_ev_cmd_status *ev = (void *) skb->data;
2868 __u16 opcode;
2869
2870 skb_pull(skb, sizeof(*ev));
2871
2872 opcode = __le16_to_cpu(ev->opcode);
2873
2874 switch (opcode) {
2875 case HCI_OP_INQUIRY:
2876 hci_cs_inquiry(hdev, ev->status);
2877 break;
2878
2879 case HCI_OP_CREATE_CONN:
2880 hci_cs_create_conn(hdev, ev->status);
2881 break;
2882
9645c76c
KP		 2883 case HCI_OP_DISCONNECT:
2884 hci_cs_disconnect(hdev, ev->status);
2885 break;
2886
a9de9248
MH		 2887 case HCI_OP_ADD_SCO:
2888 hci_cs_add_sco(hdev, ev->status);
2889 break;
2890
f8558555
MH		 2891 case HCI_OP_AUTH_REQUESTED:
2892 hci_cs_auth_requested(hdev, ev->status);
2893 break;
2894
2895 case HCI_OP_SET_CONN_ENCRYPT:
2896 hci_cs_set_conn_encrypt(hdev, ev->status);
2897 break;
2898
a9de9248
MH		 2899 case HCI_OP_REMOTE_NAME_REQ:
2900 hci_cs_remote_name_req(hdev, ev->status);
2901 break;
2902
769be974
MH		 2903 case HCI_OP_READ_REMOTE_FEATURES:
2904 hci_cs_read_remote_features(hdev, ev->status);
2905 break;
2906
2907 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2908 hci_cs_read_remote_ext_features(hdev, ev->status);
2909 break;
2910
a9de9248
MH		 2911 case HCI_OP_SETUP_SYNC_CONN:
2912 hci_cs_setup_sync_conn(hdev, ev->status);
2913 break;
2914
9645c76c
KP		 2915 case HCI_OP_CREATE_PHY_LINK:
2916 hci_cs_create_phylink(hdev, ev->status);
2917 break;
2918
2919 case HCI_OP_ACCEPT_PHY_LINK:
2920 hci_cs_accept_phylink(hdev, ev->status);
2921 break;
2922
a9de9248
MH		 2923 case HCI_OP_SNIFF_MODE:
2924 hci_cs_sniff_mode(hdev, ev->status);
2925 break;
2926
2927 case HCI_OP_EXIT_SNIFF_MODE:
2928 hci_cs_exit_sniff_mode(hdev, ev->status);
2929 break;
2930
50fc85f1
KP		 2931 case HCI_OP_SWITCH_ROLE:
2932 hci_cs_switch_role(hdev, ev->status);
2933 break;
2934
cb1d68f7
JH		 2935 case HCI_OP_LE_CREATE_CONN:
2936 hci_cs_le_create_conn(hdev, ev->status);
2937 break;
2938
81d0c8ad
JH		 2939 case HCI_OP_LE_START_ENC:
2940 hci_cs_le_start_enc(hdev, ev->status);
2941 break;
2942
a9de9248 2943 default:
9f1db00c 2944 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
a9de9248
MH		 2945 break;
2946 }
2947
ad82cdd1 2948 if (opcode != HCI_OP_NOP)
65cc2b49 2949 cancel_delayed_work(&hdev->cmd_timer);
6bd32326 2950
02350a72
JH		 2951 if (ev->status ||
2952 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2953 hci_req_cmd_complete(hdev, opcode, ev->status);
9238f36a 2954
10572132 2955 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
a9de9248
MH		 2956 atomic_set(&hdev->cmd_cnt, 1);
2957 if (!skb_queue_empty(&hdev->cmd_q))
c347b765 2958 queue_work(hdev->workqueue, &hdev->cmd_work);
a9de9248
MH		 2959 }
2960}
2961
24dfa343
MH		 2962static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
2963{
2964 struct hci_ev_hardware_error *ev = (void *) skb->data;
2965
2966 BT_ERR("%s hardware error 0x%2.2x", hdev->name, ev->code);
2967}
2968
6039aa73 2969static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH		 2970{
2971 struct hci_ev_role_change *ev = (void *) skb->data;
2972 struct hci_conn *conn;
2973
9f1db00c 2974 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a9de9248
MH		 2975
2976 hci_dev_lock(hdev);
2977
2978 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2979 if (conn) {
40bef302
JH		 2980 if (!ev->status)
2981 conn->role = ev->role;
a9de9248 2982
51a8efd7 2983 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
a9de9248
MH		 2984
2985 hci_role_switch_cfm(conn, ev->status, ev->role);
2986 }
2987
2988 hci_dev_unlock(hdev);
2989}
2990
6039aa73 2991static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH		 2992{
2993 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
a9de9248
MH		 2994 int i;
2995
32ac5b9b
AE		 2996 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2997 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2998 return;
2999 }
3000
c5993de8 3001 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
807deac2 3002 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
a9de9248
MH		 3003 BT_DBG("%s bad parameters", hdev->name);
3004 return;
3005 }
3006
c5993de8
AE		 3007 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
3008
613a1c0c
AE		 3009 for (i = 0; i < ev->num_hndl; i++) {
3010 struct hci_comp_pkts_info *info = &ev->handles[i];
a9de9248
MH		 3011 struct hci_conn *conn;
3012 __u16 handle, count;
3013
613a1c0c
AE		 3014 handle = __le16_to_cpu(info->handle);
3015 count = __le16_to_cpu(info->count);
a9de9248
MH		 3016
3017 conn = hci_conn_hash_lookup_handle(hdev, handle);
f4280918
AE		 3018 if (!conn)
3019 continue;
3020
3021 conn->sent -= count;
3022
3023 switch (conn->type) {
3024 case ACL_LINK:
3025 hdev->acl_cnt += count;
3026 if (hdev->acl_cnt > hdev->acl_pkts)
3027 hdev->acl_cnt = hdev->acl_pkts;
3028 break;
3029
3030 case LE_LINK:
3031 if (hdev->le_pkts) {
3032 hdev->le_cnt += count;
3033 if (hdev->le_cnt > hdev->le_pkts)
3034 hdev->le_cnt = hdev->le_pkts;
3035 } else {
70f23020
AE		 3036 hdev->acl_cnt += count;
3037 if (hdev->acl_cnt > hdev->acl_pkts)
a9de9248 3038 hdev->acl_cnt = hdev->acl_pkts;
a9de9248 3039 }
f4280918
AE		 3040 break;
3041
3042 case SCO_LINK:
3043 hdev->sco_cnt += count;
3044 if (hdev->sco_cnt > hdev->sco_pkts)
3045 hdev->sco_cnt = hdev->sco_pkts;
3046 break;
3047
3048 default:
3049 BT_ERR("Unknown type %d conn %p", conn->type, conn);
3050 break;
a9de9248
MH		 3051 }
3052 }
3053
3eff45ea 3054 queue_work(hdev->workqueue, &hdev->tx_work);
a9de9248
MH		 3055}
3056
76ef7cf7
AE		 3057static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
3058 __u16 handle)
3059{
3060 struct hci_chan *chan;
3061
3062 switch (hdev->dev_type) {
3063 case HCI_BREDR:
3064 return hci_conn_hash_lookup_handle(hdev, handle);
3065 case HCI_AMP:
3066 chan = hci_chan_lookup_handle(hdev, handle);
3067 if (chan)
3068 return chan->conn;
3069 break;
3070 default:
3071 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
3072 break;
3073 }
3074
3075 return NULL;
3076}
3077
6039aa73 3078static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
25e89e99
AE		 3079{
3080 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
3081 int i;
3082
3083 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
3084 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
3085 return;
3086 }
3087
3088 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
807deac2 3089 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
25e89e99
AE		 3090 BT_DBG("%s bad parameters", hdev->name);
3091 return;
3092 }
3093
3094 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
807deac2 3095 ev->num_hndl);
25e89e99
AE		 3096
3097 for (i = 0; i < ev->num_hndl; i++) {
3098 struct hci_comp_blocks_info *info = &ev->handles[i];
76ef7cf7 3099 struct hci_conn *conn = NULL;
25e89e99
AE		 3100 __u16 handle, block_count;
3101
3102 handle = __le16_to_cpu(info->handle);
3103 block_count = __le16_to_cpu(info->blocks);
3104
76ef7cf7 3105 conn = __hci_conn_lookup_handle(hdev, handle);
25e89e99
AE		 3106 if (!conn)
3107 continue;
3108
3109 conn->sent -= block_count;
3110
3111 switch (conn->type) {
3112 case ACL_LINK:
bd1eb66b 3113 case AMP_LINK:
25e89e99
AE		 3114 hdev->block_cnt += block_count;
3115 if (hdev->block_cnt > hdev->num_blocks)
3116 hdev->block_cnt = hdev->num_blocks;
3117 break;
3118
3119 default:
3120 BT_ERR("Unknown type %d conn %p", conn->type, conn);
3121 break;
3122 }
3123 }
3124
3125 queue_work(hdev->workqueue, &hdev->tx_work);
3126}
3127
6039aa73 3128static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
04837f64 3129{
a9de9248 3130 struct hci_ev_mode_change *ev = (void *) skb->data;
04837f64
MH		 3131 struct hci_conn *conn;
3132
9f1db00c 3133 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
04837f64
MH		 3134
3135 hci_dev_lock(hdev);
3136
3137 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
a9de9248
MH		 3138 if (conn) {
3139 conn->mode = ev->mode;
a9de9248 3140
8fc9ced3
GP		 3141 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
3142 &conn->flags)) {
a9de9248 3143 if (conn->mode == HCI_CM_ACTIVE)
58a681ef 3144 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
a9de9248 3145 else
58a681ef 3146 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
a9de9248 3147 }
e73439d8 3148
51a8efd7 3149 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
e73439d8 3150 hci_sco_setup(conn, ev->status);
04837f64
MH		 3151 }
3152
3153 hci_dev_unlock(hdev);
3154}
3155
6039aa73 3156static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248 3157{
052b30b0
MH		 3158 struct hci_ev_pin_code_req *ev = (void *) skb->data;
3159 struct hci_conn *conn;
3160
a9de9248 3161 BT_DBG("%s", hdev->name);
052b30b0
MH		 3162
3163 hci_dev_lock(hdev);
3164
3165 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
b6f98044
WR		 3166 if (!conn)
3167 goto unlock;
3168
3169 if (conn->state == BT_CONNECTED) {
052b30b0
MH		 3170 hci_conn_hold(conn);
3171 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
76a68ba0 3172 hci_conn_drop(conn);
052b30b0
MH		 3173 }
3174
b6ae8457 3175 if (!test_bit(HCI_BONDABLE, &hdev->dev_flags) &&
2f407f0a 3176 !test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags)) {
03b555e1 3177 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
807deac2 3178 sizeof(ev->bdaddr), &ev->bdaddr);
2f407f0a 3179 } else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
a770bb5a
WR		 3180 u8 secure;
3181
3182 if (conn->pending_sec_level == BT_SECURITY_HIGH)
3183 secure = 1;
3184 else
3185 secure = 0;
3186
744cf19e 3187 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
a770bb5a 3188 }
980e1a53 3189
b6f98044 3190unlock:
052b30b0 3191 hci_dev_unlock(hdev);
a9de9248
MH		 3192}
3193
cb6f3f7a
JH		 3194static void conn_set_key(struct hci_conn *conn, u8 key_type, u8 pin_len)
3195{
3196 if (key_type == HCI_LK_CHANGED_COMBINATION)
3197 return;
3198
3199 conn->pin_length = pin_len;
3200 conn->key_type = key_type;
3201
3202 switch (key_type) {
3203 case HCI_LK_LOCAL_UNIT:
3204 case HCI_LK_REMOTE_UNIT:
3205 case HCI_LK_DEBUG_COMBINATION:
3206 return;
3207 case HCI_LK_COMBINATION:
3208 if (pin_len == 16)
3209 conn->pending_sec_level = BT_SECURITY_HIGH;
3210 else
3211 conn->pending_sec_level = BT_SECURITY_MEDIUM;
3212 break;
3213 case HCI_LK_UNAUTH_COMBINATION_P192:
3214 case HCI_LK_UNAUTH_COMBINATION_P256:
3215 conn->pending_sec_level = BT_SECURITY_MEDIUM;
3216 break;
3217 case HCI_LK_AUTH_COMBINATION_P192:
3218 conn->pending_sec_level = BT_SECURITY_HIGH;
3219 break;
3220 case HCI_LK_AUTH_COMBINATION_P256:
3221 conn->pending_sec_level = BT_SECURITY_FIPS;
3222 break;
3223 }
3224}
3225
6039aa73 3226static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248 3227{
55ed8ca1
JH		 3228 struct hci_ev_link_key_req *ev = (void *) skb->data;
3229 struct hci_cp_link_key_reply cp;
3230 struct hci_conn *conn;
3231 struct link_key *key;
3232
a9de9248 3233 BT_DBG("%s", hdev->name);
55ed8ca1 3234
034cbea0 3235 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
55ed8ca1
JH		 3236 return;
3237
3238 hci_dev_lock(hdev);
3239
3240 key = hci_find_link_key(hdev, &ev->bdaddr);
3241 if (!key) {
6ed93dc6
AE		 3242 BT_DBG("%s link key not found for %pMR", hdev->name,
3243 &ev->bdaddr);
55ed8ca1
JH		 3244 goto not_found;
3245 }
3246
6ed93dc6
AE		 3247 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
3248 &ev->bdaddr);
55ed8ca1 3249
55ed8ca1 3250 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
60b83f57 3251 if (conn) {
66138ce8
MH		 3252 if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
3253 key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
807deac2 3254 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
60b83f57
WR		 3255 BT_DBG("%s ignoring unauthenticated key", hdev->name);
3256 goto not_found;
3257 }
55ed8ca1 3258
60b83f57 3259 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
f3fb0b58
JH		 3260 (conn->pending_sec_level == BT_SECURITY_HIGH ||
3261 conn->pending_sec_level == BT_SECURITY_FIPS)) {
8fc9ced3
GP		 3262 BT_DBG("%s ignoring key unauthenticated for high security",
3263 hdev->name);
60b83f57
WR		 3264 goto not_found;
3265 }
3266
cb6f3f7a 3267 conn_set_key(conn, key->type, key->pin_len);
55ed8ca1
JH		 3268 }
3269
3270 bacpy(&cp.bdaddr, &ev->bdaddr);
9b3b4460 3271 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
55ed8ca1
JH		 3272
3273 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
3274
3275 hci_dev_unlock(hdev);
3276
3277 return;
3278
3279not_found:
3280 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
3281 hci_dev_unlock(hdev);
a9de9248
MH		 3282}
3283
6039aa73 3284static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248 3285{
052b30b0
MH		 3286 struct hci_ev_link_key_notify *ev = (void *) skb->data;
3287 struct hci_conn *conn;
7652ff6a
JH		 3288 struct link_key *key;
3289 bool persistent;
55ed8ca1 3290 u8 pin_len = 0;
052b30b0 3291
a9de9248 3292 BT_DBG("%s", hdev->name);
052b30b0
MH		 3293
3294 hci_dev_lock(hdev);
3295
3296 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
82c13d42
JH		 3297 if (!conn)
3298 goto unlock;
3299
3300 hci_conn_hold(conn);
3301 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3302 hci_conn_drop(conn);
3303
3304 conn_set_key(conn, ev->key_type, conn->pin_length);
052b30b0 3305
7652ff6a
JH		 3306 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
3307 goto unlock;
3308
3309 key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
3310 ev->key_type, pin_len, &persistent);
3311 if (!key)
3312 goto unlock;
3313
cb6f3f7a
JH		 3314 /* Update connection information since adding the key will have
3315 * fixed up the type in the case of changed combination keys.
3316 */
3317 if (ev->key_type == HCI_LK_CHANGED_COMBINATION)
3318 conn_set_key(conn, key->type, key->pin_len);
3319
7652ff6a 3320 mgmt_new_link_key(hdev, key, persistent);
55ed8ca1 3321
6d5650c4
JH		 3322 /* Keep debug keys around only if the HCI_KEEP_DEBUG_KEYS flag
3323 * is set. If it's not set simply remove the key from the kernel
3324 * list (we've still notified user space about it but with
3325 * store_hint being 0).
3326 */
3327 if (key->type == HCI_LK_DEBUG_COMBINATION &&
3328 !test_bit(HCI_KEEP_DEBUG_KEYS, &hdev->dev_flags)) {
0378b597
JH		 3329 list_del_rcu(&key->list);
3330 kfree_rcu(key, rcu);
82c13d42 3331 goto unlock;
6d5650c4 3332 }
7652ff6a 3333
82c13d42
JH		 3334 if (persistent)
3335 clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3336 else
3337 set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3338
7652ff6a 3339unlock:
052b30b0 3340 hci_dev_unlock(hdev);
a9de9248
MH		 3341}
3342
6039aa73 3343static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 3344{
a9de9248 3345 struct hci_ev_clock_offset *ev = (void *) skb->data;
04837f64 3346 struct hci_conn *conn;
1da177e4 3347
9f1db00c 3348 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT		 3349
3350 hci_dev_lock(hdev);
3351
04837f64 3352 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT		 3353 if (conn && !ev->status) {
3354 struct inquiry_entry *ie;
3355
cc11b9c1
AE		 3356 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3357 if (ie) {
1da177e4
LT		 3358 ie->data.clock_offset = ev->clock_offset;
3359 ie->timestamp = jiffies;
3360 }
3361 }
3362
3363 hci_dev_unlock(hdev);
3364}
3365
6039aa73 3366static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a8746417
MH		 3367{
3368 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
3369 struct hci_conn *conn;
3370
9f1db00c 3371 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a8746417
MH		 3372
3373 hci_dev_lock(hdev);
3374
3375 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3376 if (conn && !ev->status)
3377 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
3378
3379 hci_dev_unlock(hdev);
3380}
3381
6039aa73 3382static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
85a1e930 3383{
a9de9248 3384 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
85a1e930
MH		 3385 struct inquiry_entry *ie;
3386
3387 BT_DBG("%s", hdev->name);
3388
3389 hci_dev_lock(hdev);
3390
cc11b9c1
AE		 3391 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3392 if (ie) {
85a1e930
MH		 3393 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
3394 ie->timestamp = jiffies;
3395 }
3396
3397 hci_dev_unlock(hdev);
3398}
3399
6039aa73
GP		 3400static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
3401 struct sk_buff *skb)
a9de9248
MH		 3402{
3403 struct inquiry_data data;
3404 int num_rsp = *((__u8 *) skb->data);
3405
3406 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3407
3408 if (!num_rsp)
3409 return;
3410
1519cc17
AG		 3411 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3412 return;
3413
a9de9248
MH		 3414 hci_dev_lock(hdev);
3415
3416 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
138d22ef
SJ		 3417 struct inquiry_info_with_rssi_and_pscan_mode *info;
3418 info = (void *) (skb->data + 1);
a9de9248 3419
e17acd40 3420 for (; num_rsp; num_rsp--, info++) {
af58925c
MH		 3421 u32 flags;
3422
a9de9248
MH		 3423 bacpy(&data.bdaddr, &info->bdaddr);
3424 data.pscan_rep_mode = info->pscan_rep_mode;
3425 data.pscan_period_mode = info->pscan_period_mode;
3426 data.pscan_mode = info->pscan_mode;
3427 memcpy(data.dev_class, info->dev_class, 3);
3428 data.clock_offset = info->clock_offset;
3429 data.rssi = info->rssi;
41a96212 3430 data.ssp_mode = 0x00;
3175405b 3431
af58925c
MH		 3432 flags = hci_inquiry_cache_update(hdev, &data, false);
3433
48264f06 3434 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681 3435 info->dev_class, info->rssi,
af58925c 3436 flags, NULL, 0, NULL, 0);
a9de9248
MH		 3437 }
3438 } else {
3439 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
3440
e17acd40 3441 for (; num_rsp; num_rsp--, info++) {
af58925c
MH		 3442 u32 flags;
3443
a9de9248
MH		 3444 bacpy(&data.bdaddr, &info->bdaddr);
3445 data.pscan_rep_mode = info->pscan_rep_mode;
3446 data.pscan_period_mode = info->pscan_period_mode;
3447 data.pscan_mode = 0x00;
3448 memcpy(data.dev_class, info->dev_class, 3);
3449 data.clock_offset = info->clock_offset;
3450 data.rssi = info->rssi;
41a96212 3451 data.ssp_mode = 0x00;
af58925c
MH		 3452
3453 flags = hci_inquiry_cache_update(hdev, &data, false);
3454
48264f06 3455 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681 3456 info->dev_class, info->rssi,
af58925c 3457 flags, NULL, 0, NULL, 0);
a9de9248
MH		 3458 }
3459 }
3460
3461 hci_dev_unlock(hdev);
3462}
3463
6039aa73
GP		 3464static void hci_remote_ext_features_evt(struct hci_dev *hdev,
3465 struct sk_buff *skb)
a9de9248 3466{
41a96212
MH		 3467 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
3468 struct hci_conn *conn;
3469
a9de9248 3470 BT_DBG("%s", hdev->name);
41a96212 3471
41a96212
MH		 3472 hci_dev_lock(hdev);
3473
3474 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH		 3475 if (!conn)
3476 goto unlock;
41a96212 3477
cad718ed
JH		 3478 if (ev->page < HCI_MAX_PAGES)
3479 memcpy(conn->features[ev->page], ev->features, 8);
3480
ccd556fe
JH		 3481 if (!ev->status && ev->page == 0x01) {
3482 struct inquiry_entry *ie;
41a96212 3483
cc11b9c1
AE		 3484 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3485 if (ie)
02b7cc62 3486 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
769be974 3487
bbb0eada 3488 if (ev->features[0] & LMP_HOST_SSP) {
58a681ef 3489 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
bbb0eada
JK		 3490 } else {
3491 /* It is mandatory by the Bluetooth specification that
3492 * Extended Inquiry Results are only used when Secure
3493 * Simple Pairing is enabled, but some devices violate
3494 * this.
3495 *
3496 * To make these devices work, the internal SSP
3497 * enabled flag needs to be cleared if the remote host
3498 * features do not indicate SSP support */
3499 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
3500 }
eb9a8f3f
MH		 3501
3502 if (ev->features[0] & LMP_HOST_SC)
3503 set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
ccd556fe
JH		 3504 }
3505
3506 if (conn->state != BT_CONFIG)
3507 goto unlock;
3508
671267bf 3509 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
127178d2
JH		 3510 struct hci_cp_remote_name_req cp;
3511 memset(&cp, 0, sizeof(cp));
3512 bacpy(&cp.bdaddr, &conn->dst);
3513 cp.pscan_rep_mode = 0x02;
3514 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
b644ba33 3515 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
48ec92fa 3516 mgmt_device_connected(hdev, conn, 0, NULL, 0);
392599b9 3517
127178d2 3518 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH		 3519 conn->state = BT_CONNECTED;
3520 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 3521 hci_conn_drop(conn);
41a96212
MH		 3522 }
3523
ccd556fe 3524unlock:
41a96212 3525 hci_dev_unlock(hdev);
a9de9248
MH		 3526}
3527
6039aa73
GP		 3528static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3529 struct sk_buff *skb)
a9de9248 3530{
b6a0dc82
MH		 3531 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3532 struct hci_conn *conn;
3533
9f1db00c 3534 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
b6a0dc82
MH		 3535
3536 hci_dev_lock(hdev);
3537
3538 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9dc0a3af
MH		 3539 if (!conn) {
3540 if (ev->link_type == ESCO_LINK)
3541 goto unlock;
3542
3543 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3544 if (!conn)
3545 goto unlock;
3546
3547 conn->type = SCO_LINK;
3548 }
b6a0dc82 3549
732547f9
MH		 3550 switch (ev->status) {
3551 case 0x00:
b6a0dc82
MH		 3552 conn->handle = __le16_to_cpu(ev->handle);
3553 conn->state = BT_CONNECTED;
7d0db0a3
MH		 3554
3555 hci_conn_add_sysfs(conn);
732547f9
MH		 3556 break;
3557
81218d20 3558 case 0x10: /* Connection Accept Timeout */
1a4c958c 3559 case 0x0d: /* Connection Rejected due to Limited Resources */
705e5711 3560 case 0x11: /* Unsupported Feature or Parameter Value */
732547f9 3561 case 0x1c: /* SCO interval rejected */
1038a00b 3562 case 0x1a: /* Unsupported Remote Feature */
732547f9 3563 case 0x1f: /* Unspecified error */
27539bc4 3564 case 0x20: /* Unsupported LMP Parameter value */
2dea632f 3565 if (conn->out) {
732547f9
MH		 3566 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3567 (hdev->esco_type & EDR_ESCO_MASK);
2dea632f
FD		 3568 if (hci_setup_sync(conn, conn->link->handle))
3569 goto unlock;
732547f9
MH		 3570 }
3571 /* fall through */
3572
3573 default:
b6a0dc82 3574 conn->state = BT_CLOSED;
732547f9
MH		 3575 break;
3576 }
b6a0dc82
MH		 3577
3578 hci_proto_connect_cfm(conn, ev->status);
3579 if (ev->status)
3580 hci_conn_del(conn);
3581
3582unlock:
3583 hci_dev_unlock(hdev);
a9de9248
MH		 3584}
3585
efdcf8e3
MH		 3586static inline size_t eir_get_length(u8 *eir, size_t eir_len)
3587{
3588 size_t parsed = 0;
3589
3590 while (parsed < eir_len) {
3591 u8 field_len = eir[0];
3592
3593 if (field_len == 0)
3594 return parsed;
3595
3596 parsed += field_len + 1;
3597 eir += field_len + 1;
3598 }
3599
3600 return eir_len;
3601}
3602
6039aa73
GP		 3603static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3604 struct sk_buff *skb)
1da177e4 3605{
a9de9248
MH		 3606 struct inquiry_data data;
3607 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3608 int num_rsp = *((__u8 *) skb->data);
9d939d94 3609 size_t eir_len;
1da177e4 3610
a9de9248 3611 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1da177e4 3612
a9de9248
MH		 3613 if (!num_rsp)
3614 return;
1da177e4 3615
1519cc17
AG		 3616 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3617 return;
3618
a9de9248
MH		 3619 hci_dev_lock(hdev);
3620
e17acd40 3621 for (; num_rsp; num_rsp--, info++) {
af58925c
MH		 3622 u32 flags;
3623 bool name_known;
561aafbc 3624
a9de9248 3625 bacpy(&data.bdaddr, &info->bdaddr);
138d22ef
SJ		 3626 data.pscan_rep_mode = info->pscan_rep_mode;
3627 data.pscan_period_mode = info->pscan_period_mode;
3628 data.pscan_mode = 0x00;
a9de9248 3629 memcpy(data.dev_class, info->dev_class, 3);
138d22ef
SJ		 3630 data.clock_offset = info->clock_offset;
3631 data.rssi = info->rssi;
41a96212 3632 data.ssp_mode = 0x01;
561aafbc 3633
a8b2d5c2 3634 if (test_bit(HCI_MGMT, &hdev->dev_flags))
4ddb1930 3635 name_known = eir_has_data_type(info->data,
04124681
GP		 3636 sizeof(info->data),
3637 EIR_NAME_COMPLETE);
561aafbc
JH		 3638 else
3639 name_known = true;
3640
af58925c
MH		 3641 flags = hci_inquiry_cache_update(hdev, &data, name_known);
3642
9d939d94 3643 eir_len = eir_get_length(info->data, sizeof(info->data));
af58925c 3644
48264f06 3645 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
af58925c
MH		 3646 info->dev_class, info->rssi,
3647 flags, info->data, eir_len, NULL, 0);
a9de9248
MH		 3648 }
3649
3650 hci_dev_unlock(hdev);
3651}
1da177e4 3652
1c2e0041
JH		 3653static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3654 struct sk_buff *skb)
3655{
3656 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3657 struct hci_conn *conn;
3658
9f1db00c 3659 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
1c2e0041
JH		 3660 __le16_to_cpu(ev->handle));
3661
3662 hci_dev_lock(hdev);
3663
3664 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3665 if (!conn)
3666 goto unlock;
3667
9eb1fbfa
JH		 3668 /* For BR/EDR the necessary steps are taken through the
3669 * auth_complete event.
3670 */
3671 if (conn->type != LE_LINK)
3672 goto unlock;
3673
1c2e0041
JH		 3674 if (!ev->status)
3675 conn->sec_level = conn->pending_sec_level;
3676
3677 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3678
3679 if (ev->status && conn->state == BT_CONNECTED) {
bed71748 3680 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
76a68ba0 3681 hci_conn_drop(conn);
1c2e0041
JH		 3682 goto unlock;
3683 }
3684
3685 if (conn->state == BT_CONFIG) {
3686 if (!ev->status)
3687 conn->state = BT_CONNECTED;
3688
3689 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 3690 hci_conn_drop(conn);
1c2e0041
JH		 3691 } else {
3692 hci_auth_cfm(conn, ev->status);
3693
3694 hci_conn_hold(conn);
3695 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 3696 hci_conn_drop(conn);
1c2e0041
JH		 3697 }
3698
3699unlock:
3700 hci_dev_unlock(hdev);
3701}
3702
6039aa73 3703static u8 hci_get_auth_req(struct hci_conn *conn)
17fa4b9d 3704{
17fa4b9d 3705 /* If remote requests no-bonding follow that lead */
acabae96
MA		 3706 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3707 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
58797bf7 3708 return conn->remote_auth | (conn->auth_type & 0x01);
17fa4b9d 3709
b7f94c88
MA		 3710 /* If both remote and local have enough IO capabilities, require
3711 * MITM protection
3712 */
3713 if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
3714 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
3715 return conn->remote_auth | 0x01;
3716
7e74170a
TM		 3717 /* No MITM protection possible so ignore remote requirement */
3718 return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
17fa4b9d
JH		 3719}
3720
6039aa73 3721static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
0493684e
MH		 3722{
3723 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3724 struct hci_conn *conn;
3725
3726 BT_DBG("%s", hdev->name);
3727
3728 hci_dev_lock(hdev);
3729
3730 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
03b555e1
JH		 3731 if (!conn)
3732 goto unlock;
3733
3734 hci_conn_hold(conn);
3735
a8b2d5c2 3736 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
03b555e1
JH		 3737 goto unlock;
3738
2f407f0a
JH		 3739 /* Allow pairing if we're pairable, the initiators of the
3740 * pairing or if the remote is not requesting bonding.
3741 */
b6ae8457 3742 if (test_bit(HCI_BONDABLE, &hdev->dev_flags) ||
2f407f0a 3743 test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags) ||
807deac2 3744 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
17fa4b9d
JH		 3745 struct hci_cp_io_capability_reply cp;
3746
3747 bacpy(&cp.bdaddr, &ev->bdaddr);
7a7f1e7c
HG		 3748 /* Change the IO capability from KeyboardDisplay
3749 * to DisplayYesNo as it is not supported by BT spec. */
3750 cp.capability = (conn->io_capability == 0x04) ?
a767631a 3751 HCI_IO_DISPLAY_YESNO : conn->io_capability;
b7f94c88
MA		 3752
3753 /* If we are initiators, there is no remote information yet */
3754 if (conn->remote_auth == 0xff) {
b16c6604 3755 /* Request MITM protection if our IO caps allow it
4ad51a75 3756 * except for the no-bonding case.
b16c6604 3757 */
6fd6b915 3758 if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
9f743d74 3759 conn->auth_type != HCI_AT_NO_BONDING)
6c53823a 3760 conn->auth_type |= 0x01;
b7f94c88
MA		 3761 } else {
3762 conn->auth_type = hci_get_auth_req(conn);
b7f94c88 3763 }
17fa4b9d 3764
82c295b1
JH		 3765 /* If we're not bondable, force one of the non-bondable
3766 * authentication requirement values.
3767 */
3768 if (!test_bit(HCI_BONDABLE, &hdev->dev_flags))
3769 conn->auth_type &= HCI_AT_NO_BONDING_MITM;
3770
3771 cp.authentication = conn->auth_type;
3772
8fc9ced3
GP		 3773 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3774 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
ce85ee13
SJ		 3775 cp.oob_data = 0x01;
3776 else
3777 cp.oob_data = 0x00;
3778
17fa4b9d 3779 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
807deac2 3780 sizeof(cp), &cp);
03b555e1
JH		 3781 } else {
3782 struct hci_cp_io_capability_neg_reply cp;
3783
3784 bacpy(&cp.bdaddr, &ev->bdaddr);
9f5a0d7b 3785 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
0493684e 3786
03b555e1 3787 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
807deac2 3788 sizeof(cp), &cp);
03b555e1
JH		 3789 }
3790
3791unlock:
3792 hci_dev_unlock(hdev);
3793}
3794
6039aa73 3795static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
03b555e1
JH		 3796{
3797 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3798 struct hci_conn *conn;
3799
3800 BT_DBG("%s", hdev->name);
3801
3802 hci_dev_lock(hdev);
3803
3804 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3805 if (!conn)
3806 goto unlock;
3807
03b555e1 3808 conn->remote_cap = ev->capability;
03b555e1 3809 conn->remote_auth = ev->authentication;
58a681ef
JH		 3810 if (ev->oob_data)
3811 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
03b555e1
JH		 3812
3813unlock:
0493684e
MH		 3814 hci_dev_unlock(hdev);
3815}
3816
6039aa73
GP		 3817static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3818 struct sk_buff *skb)
a5c29683
JH		 3819{
3820 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
55bc1a37 3821 int loc_mitm, rem_mitm, confirm_hint = 0;
7a828908 3822 struct hci_conn *conn;
a5c29683
JH		 3823
3824 BT_DBG("%s", hdev->name);
3825
3826 hci_dev_lock(hdev);
3827
a8b2d5c2 3828 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
7a828908 3829 goto unlock;
a5c29683 3830
7a828908
JH		 3831 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3832 if (!conn)
3833 goto unlock;
3834
3835 loc_mitm = (conn->auth_type & 0x01);
3836 rem_mitm = (conn->remote_auth & 0x01);
3837
3838 /* If we require MITM but the remote device can't provide that
6c53823a
JH		 3839 * (it has NoInputNoOutput) then reject the confirmation
3840 * request. We check the security level here since it doesn't
3841 * necessarily match conn->auth_type.
6fd6b915 3842 */
6c53823a
JH		 3843 if (conn->pending_sec_level > BT_SECURITY_MEDIUM &&
3844 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
7a828908
JH		 3845 BT_DBG("Rejecting request: remote device can't provide MITM");
3846 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
807deac2 3847 sizeof(ev->bdaddr), &ev->bdaddr);
7a828908
JH		 3848 goto unlock;
3849 }
3850
3851 /* If no side requires MITM protection; auto-accept */
a767631a
MA		 3852 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3853 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
55bc1a37
JH		 3854
3855 /* If we're not the initiators request authorization to
3856 * proceed from user space (mgmt_user_confirm with
ba15a58b 3857 * confirm_hint set to 1). The exception is if neither
02f3e254
JH		 3858 * side had MITM or if the local IO capability is
3859 * NoInputNoOutput, in which case we do auto-accept
ba15a58b
JH		 3860 */
3861 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
02f3e254 3862 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
ba15a58b 3863 (loc_mitm || rem_mitm)) {
55bc1a37
JH		 3864 BT_DBG("Confirming auto-accept as acceptor");
3865 confirm_hint = 1;
3866 goto confirm;
3867 }
3868
9f61656a 3869 BT_DBG("Auto-accept of user confirmation with %ums delay",
807deac2 3870 hdev->auto_accept_delay);
9f61656a
JH		 3871
3872 if (hdev->auto_accept_delay > 0) {
3873 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
7bc18d9d
JH		 3874 queue_delayed_work(conn->hdev->workqueue,
3875 &conn->auto_accept_work, delay);
9f61656a
JH		 3876 goto unlock;
3877 }
3878
7a828908 3879 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
807deac2 3880 sizeof(ev->bdaddr), &ev->bdaddr);
7a828908
JH		 3881 goto unlock;
3882 }
3883
55bc1a37 3884confirm:
39adbffe
JH		 3885 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
3886 le32_to_cpu(ev->passkey), confirm_hint);
7a828908
JH		 3887
3888unlock:
a5c29683
JH		 3889 hci_dev_unlock(hdev);
3890}
3891
6039aa73
GP		 3892static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3893 struct sk_buff *skb)
1143d458
BG		 3894{
3895 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3896
3897 BT_DBG("%s", hdev->name);
3898
a8b2d5c2 3899 if (test_bit(HCI_MGMT, &hdev->dev_flags))
272d90df 3900 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
1143d458
BG		 3901}
3902
92a25256
JH		 3903static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3904 struct sk_buff *skb)
3905{
3906 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3907 struct hci_conn *conn;
3908
3909 BT_DBG("%s", hdev->name);
3910
3911 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3912 if (!conn)
3913 return;
3914
3915 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3916 conn->passkey_entered = 0;
3917
3918 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3919 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3920 conn->dst_type, conn->passkey_notify,
3921 conn->passkey_entered);
3922}
3923
3924static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3925{
3926 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3927 struct hci_conn *conn;
3928
3929 BT_DBG("%s", hdev->name);
3930
3931 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3932 if (!conn)
3933 return;
3934
3935 switch (ev->type) {
3936 case HCI_KEYPRESS_STARTED:
3937 conn->passkey_entered = 0;
3938 return;
3939
3940 case HCI_KEYPRESS_ENTERED:
3941 conn->passkey_entered++;
3942 break;
3943
3944 case HCI_KEYPRESS_ERASED:
3945 conn->passkey_entered--;
3946 break;
3947
3948 case HCI_KEYPRESS_CLEARED:
3949 conn->passkey_entered = 0;
3950 break;
3951
3952 case HCI_KEYPRESS_COMPLETED:
3953 return;
3954 }
3955
3956 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3957 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3958 conn->dst_type, conn->passkey_notify,
3959 conn->passkey_entered);
3960}
3961
6039aa73
GP		 3962static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3963 struct sk_buff *skb)
0493684e
MH		 3964{
3965 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3966 struct hci_conn *conn;
3967
3968 BT_DBG("%s", hdev->name);
3969
3970 hci_dev_lock(hdev);
3971
3972 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2a611692
JH		 3973 if (!conn)
3974 goto unlock;
3975
c1d4fa7a
JH		 3976 /* Reset the authentication requirement to unknown */
3977 conn->remote_auth = 0xff;
3978
2a611692
JH		 3979 /* To avoid duplicate auth_failed events to user space we check
3980 * the HCI_CONN_AUTH_PEND flag which will be set if we
3981 * initiated the authentication. A traditional auth_complete
3982 * event gets always produced as initiator and is also mapped to
3983 * the mgmt_auth_failed event */
fa1bd918 3984 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
e1e930f5 3985 mgmt_auth_failed(conn, ev->status);
0493684e 3986
76a68ba0 3987 hci_conn_drop(conn);
2a611692
JH		 3988
3989unlock:
0493684e
MH		 3990 hci_dev_unlock(hdev);
3991}
3992
6039aa73
GP		 3993static void hci_remote_host_features_evt(struct hci_dev *hdev,
3994 struct sk_buff *skb)
41a96212
MH		 3995{
3996 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3997 struct inquiry_entry *ie;
cad718ed 3998 struct hci_conn *conn;
41a96212
MH		 3999
4000 BT_DBG("%s", hdev->name);
4001
4002 hci_dev_lock(hdev);
4003
cad718ed
JH		 4004 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4005 if (conn)
4006 memcpy(conn->features[1], ev->features, 8);
4007
cc11b9c1
AE		 4008 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
4009 if (ie)
02b7cc62 4010 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
41a96212
MH		 4011
4012 hci_dev_unlock(hdev);
4013}
4014
6039aa73
GP		 4015static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
4016 struct sk_buff *skb)
2763eda6
SJ		 4017{
4018 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
4019 struct oob_data *data;
4020
4021 BT_DBG("%s", hdev->name);
4022
4023 hci_dev_lock(hdev);
4024
a8b2d5c2 4025 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
e1ba1f15
SJ		 4026 goto unlock;
4027
2763eda6
SJ		 4028 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
4029 if (data) {
710f11c0 4030 if (bredr_sc_enabled(hdev)) {
519ca9d0 4031 struct hci_cp_remote_oob_ext_data_reply cp;
2763eda6 4032
519ca9d0
MH		 4033 bacpy(&cp.bdaddr, &ev->bdaddr);
4034 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
38da1703 4035 memcpy(cp.rand192, data->rand192, sizeof(cp.rand192));
519ca9d0 4036 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
38da1703 4037 memcpy(cp.rand256, data->rand256, sizeof(cp.rand256));
519ca9d0
MH		 4038
4039 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
4040 sizeof(cp), &cp);
4041 } else {
4042 struct hci_cp_remote_oob_data_reply cp;
2763eda6 4043
519ca9d0
MH		 4044 bacpy(&cp.bdaddr, &ev->bdaddr);
4045 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
38da1703 4046 memcpy(cp.rand, data->rand192, sizeof(cp.rand));
519ca9d0
MH		 4047
4048 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
4049 sizeof(cp), &cp);
4050 }
2763eda6
SJ		 4051 } else {
4052 struct hci_cp_remote_oob_data_neg_reply cp;
4053
4054 bacpy(&cp.bdaddr, &ev->bdaddr);
519ca9d0
MH		 4055 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
4056 sizeof(cp), &cp);
2763eda6
SJ		 4057 }
4058
e1ba1f15 4059unlock:
2763eda6
SJ		 4060 hci_dev_unlock(hdev);
4061}
4062
d5e91192
AE		 4063static void hci_phy_link_complete_evt(struct hci_dev *hdev,
4064 struct sk_buff *skb)
4065{
4066 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
4067 struct hci_conn *hcon, *bredr_hcon;
4068
4069 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
4070 ev->status);
4071
4072 hci_dev_lock(hdev);
4073
4074 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4075 if (!hcon) {
4076 hci_dev_unlock(hdev);
4077 return;
4078 }
4079
4080 if (ev->status) {
4081 hci_conn_del(hcon);
4082 hci_dev_unlock(hdev);
4083 return;
4084 }
4085
4086 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
4087
4088 hcon->state = BT_CONNECTED;
4089 bacpy(&hcon->dst, &bredr_hcon->dst);
4090
4091 hci_conn_hold(hcon);
4092 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 4093 hci_conn_drop(hcon);
d5e91192 4094
d5e91192
AE		 4095 hci_conn_add_sysfs(hcon);
4096
cf70ff22 4097 amp_physical_cfm(bredr_hcon, hcon);
d5e91192 4098
cf70ff22 4099 hci_dev_unlock(hdev);
d5e91192
AE		 4100}
4101
27695fb4
AE		 4102static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
4103{
4104 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
4105 struct hci_conn *hcon;
4106 struct hci_chan *hchan;
4107 struct amp_mgr *mgr;
4108
4109 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
4110 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
4111 ev->status);
4112
4113 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4114 if (!hcon)
4115 return;
4116
4117 /* Create AMP hchan */
4118 hchan = hci_chan_create(hcon);
4119 if (!hchan)
4120 return;
4121
4122 hchan->handle = le16_to_cpu(ev->handle);
4123
4124 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
4125
4126 mgr = hcon->amp_mgr;
4127 if (mgr && mgr->bredr_chan) {
4128 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
4129
4130 l2cap_chan_lock(bredr_chan);
4131
4132 bredr_chan->conn->mtu = hdev->block_mtu;
4133 l2cap_logical_cfm(bredr_chan, hchan, 0);
4134 hci_conn_hold(hcon);
4135
4136 l2cap_chan_unlock(bredr_chan);
4137 }
4138}
4139
606e2a10
AE		 4140static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
4141 struct sk_buff *skb)
4142{
4143 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
4144 struct hci_chan *hchan;
4145
4146 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
4147 le16_to_cpu(ev->handle), ev->status);
4148
4149 if (ev->status)
4150 return;
4151
4152 hci_dev_lock(hdev);
4153
4154 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
4155 if (!hchan)
4156 goto unlock;
4157
4158 amp_destroy_logical_link(hchan, ev->reason);
4159
4160unlock:
4161 hci_dev_unlock(hdev);
4162}
4163
9eef6b3a
AE		 4164static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
4165 struct sk_buff *skb)
4166{
4167 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
4168 struct hci_conn *hcon;
4169
4170 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4171
4172 if (ev->status)
4173 return;
4174
4175 hci_dev_lock(hdev);
4176
4177 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4178 if (hcon) {
4179 hcon->state = BT_CLOSED;
4180 hci_conn_del(hcon);
4181 }
4182
4183 hci_dev_unlock(hdev);
4184}
4185
6039aa73 4186static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
fcd89c09
VT		 4187{
4188 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
912b42ef 4189 struct hci_conn_params *params;
fcd89c09 4190 struct hci_conn *conn;
68d6f6de 4191 struct smp_irk *irk;
837d502e 4192 u8 addr_type;
fcd89c09 4193
9f1db00c 4194 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
fcd89c09
VT		 4195
4196 hci_dev_lock(hdev);
4197
fbd96c15
JH		 4198 /* All controllers implicitly stop advertising in the event of a
4199 * connection, so ensure that the state bit is cleared.
4200 */
4201 clear_bit(HCI_LE_ADV, &hdev->dev_flags);
4202
b47a09b3 4203 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
b62f328b 4204 if (!conn) {
a5c4e309 4205 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr, ev->role);
b62f328b
VT		 4206 if (!conn) {
4207 BT_ERR("No memory for new connection");
230fd16a 4208 goto unlock;
b62f328b 4209 }
29b7988a
AG		 4210
4211 conn->dst_type = ev->bdaddr_type;
b9b343d2 4212
cb1d68f7
JH		 4213 /* If we didn't have a hci_conn object previously
4214 * but we're in master role this must be something
4215 * initiated using a white list. Since white list based
4216 * connections are not "first class citizens" we don't
4217 * have full tracking of them. Therefore, we go ahead
4218 * with a "best effort" approach of determining the
4219 * initiator address based on the HCI_PRIVACY flag.
4220 */
4221 if (conn->out) {
4222 conn->resp_addr_type = ev->bdaddr_type;
4223 bacpy(&conn->resp_addr, &ev->bdaddr);
4224 if (test_bit(HCI_PRIVACY, &hdev->dev_flags)) {
4225 conn->init_addr_type = ADDR_LE_DEV_RANDOM;
4226 bacpy(&conn->init_addr, &hdev->rpa);
4227 } else {
4228 hci_copy_identity_address(hdev,
4229 &conn->init_addr,
4230 &conn->init_addr_type);
4231 }
cb1d68f7 4232 }
9489eca4
JH		 4233 } else {
4234 cancel_delayed_work(&conn->le_conn_timeout);
b62f328b 4235 }
fcd89c09 4236
80c24ab8
JH		 4237 if (!conn->out) {
4238 /* Set the responder (our side) address type based on
4239 * the advertising address type.
4240 */
4241 conn->resp_addr_type = hdev->adv_addr_type;
4242 if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM)
4243 bacpy(&conn->resp_addr, &hdev->random_addr);
4244 else
4245 bacpy(&conn->resp_addr, &hdev->bdaddr);
4246
4247 conn->init_addr_type = ev->bdaddr_type;
4248 bacpy(&conn->init_addr, &ev->bdaddr);
a720d735
MH		 4249
4250 /* For incoming connections, set the default minimum
4251 * and maximum connection interval. They will be used
4252 * to check if the parameters are in range and if not
4253 * trigger the connection update procedure.
4254 */
4255 conn->le_conn_min_interval = hdev->le_conn_min_interval;
4256 conn->le_conn_max_interval = hdev->le_conn_max_interval;
80c24ab8 4257 }
7be2edbb 4258
edb4b466
MH		 4259 /* Lookup the identity address from the stored connection
4260 * address and address type.
4261 *
4262 * When establishing connections to an identity address, the
4263 * connection procedure will store the resolvable random
4264 * address first. Now if it can be converted back into the
4265 * identity address, start using the identity address from
4266 * now on.
4267 */
4268 irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
68d6f6de
JH		 4269 if (irk) {
4270 bacpy(&conn->dst, &irk->bdaddr);
4271 conn->dst_type = irk->addr_type;
4272 }
4273
2d3c2260
JH		 4274 if (ev->status) {
4275 hci_le_conn_failed(conn, ev->status);
837d502e
JH		 4276 goto unlock;
4277 }
4278
08853f18
JH		 4279 if (conn->dst_type == ADDR_LE_DEV_PUBLIC)
4280 addr_type = BDADDR_LE_PUBLIC;
4281 else
4282 addr_type = BDADDR_LE_RANDOM;
4283
2d3c2260
JH		 4284 /* Drop the connection if the device is blocked */
4285 if (hci_bdaddr_list_lookup(&hdev->blacklist, &conn->dst, addr_type)) {
4286 hci_conn_drop(conn);
cd17decb
AG		 4287 goto unlock;
4288 }
4289
b644ba33 4290 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
48ec92fa 4291 mgmt_device_connected(hdev, conn, 0, NULL, 0);
83bc71b4 4292
7b5c0d52 4293 conn->sec_level = BT_SECURITY_LOW;
fcd89c09
VT		 4294 conn->handle = __le16_to_cpu(ev->handle);
4295 conn->state = BT_CONNECTED;
4296
e04fde60
MH		 4297 conn->le_conn_interval = le16_to_cpu(ev->interval);
4298 conn->le_conn_latency = le16_to_cpu(ev->latency);
4299 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4300
fcd89c09
VT		 4301 hci_conn_add_sysfs(conn);
4302
4303 hci_proto_connect_cfm(conn, ev->status);
4304
5477610f
JH		 4305 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
4306 conn->dst_type);
f161dd41 4307 if (params) {
95305baa 4308 list_del_init(&params->action);
f161dd41
JH		 4309 if (params->conn) {
4310 hci_conn_drop(params->conn);
f8aaf9b6 4311 hci_conn_put(params->conn);
f161dd41
JH		 4312 params->conn = NULL;
4313 }
4314 }
a4790dbd 4315
fcd89c09 4316unlock:
223683a5 4317 hci_update_background_scan(hdev);
fcd89c09
VT		 4318 hci_dev_unlock(hdev);
4319}
4320
1855d92d
MH		 4321static void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
4322 struct sk_buff *skb)
4323{
4324 struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
4325 struct hci_conn *conn;
4326
4327 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4328
4329 if (ev->status)
4330 return;
4331
4332 hci_dev_lock(hdev);
4333
4334 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4335 if (conn) {
4336 conn->le_conn_interval = le16_to_cpu(ev->interval);
4337 conn->le_conn_latency = le16_to_cpu(ev->latency);
4338 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4339 }
4340
4341 hci_dev_unlock(hdev);
4342}
4343
a4790dbd 4344/* This function requires the caller holds hdev->lock */
fd45ada9
AA		 4345static struct hci_conn *check_pending_le_conn(struct hci_dev *hdev,
4346 bdaddr_t *addr,
4347 u8 addr_type, u8 adv_type)
a4790dbd
AG		 4348{
4349 struct hci_conn *conn;
4b9e7e75 4350 struct hci_conn_params *params;
a4790dbd 4351
1c1abcab
JH		 4352 /* If the event is not connectable don't proceed further */
4353 if (adv_type != LE_ADV_IND && adv_type != LE_ADV_DIRECT_IND)
fd45ada9 4354 return NULL;
1c1abcab
JH		 4355
4356 /* Ignore if the device is blocked */
dcc36c16 4357 if (hci_bdaddr_list_lookup(&hdev->blacklist, addr, addr_type))
fd45ada9 4358 return NULL;
1c1abcab 4359
f99353cf
JH		 4360 /* Most controller will fail if we try to create new connections
4361 * while we have an existing one in slave role.
4362 */
4363 if (hdev->conn_hash.le_num_slave > 0)
fd45ada9 4364 return NULL;
f99353cf 4365
1c1abcab
JH		 4366 /* If we're not connectable only connect devices that we have in
4367 * our pend_le_conns list.
4368 */
4b9e7e75
MH		 4369 params = hci_pend_le_action_lookup(&hdev->pend_le_conns,
4370 addr, addr_type);
4371 if (!params)
fd45ada9 4372 return NULL;
4b9e7e75
MH		 4373
4374 switch (params->auto_connect) {
4375 case HCI_AUTO_CONN_DIRECT:
4376 /* Only devices advertising with ADV_DIRECT_IND are
4377 * triggering a connection attempt. This is allowing
4378 * incoming connections from slave devices.
4379 */
4380 if (adv_type != LE_ADV_DIRECT_IND)
fd45ada9 4381 return NULL;
4b9e7e75
MH		 4382 break;
4383 case HCI_AUTO_CONN_ALWAYS:
4384 /* Devices advertising with ADV_IND or ADV_DIRECT_IND
4385 * are triggering a connection attempt. This means
4386 * that incoming connectioms from slave device are
4387 * accepted and also outgoing connections to slave
4388 * devices are established when found.
4389 */
4390 break;
4391 default:
fd45ada9 4392 return NULL;
4b9e7e75 4393 }
a4790dbd
AG		 4394
4395 conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
e804d25d 4396 HCI_LE_AUTOCONN_TIMEOUT, HCI_ROLE_MASTER);
f161dd41
JH		 4397 if (!IS_ERR(conn)) {
4398 /* Store the pointer since we don't really have any
4399 * other owner of the object besides the params that
4400 * triggered it. This way we can abort the connection if
4401 * the parameters get removed and keep the reference
4402 * count consistent once the connection is established.
4403 */
f8aaf9b6 4404 params->conn = hci_conn_get(conn);
fd45ada9 4405 return conn;
f161dd41 4406 }
a4790dbd
AG		 4407
4408 switch (PTR_ERR(conn)) {
4409 case -EBUSY:
4410 /* If hci_connect() returns -EBUSY it means there is already
4411 * an LE connection attempt going on. Since controllers don't
4412 * support more than one connection attempt at the time, we
4413 * don't consider this an error case.
4414 */
4415 break;
4416 default:
4417 BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
fd45ada9 4418 return NULL;
a4790dbd 4419 }
fd45ada9
AA		 4420
4421 return NULL;
a4790dbd
AG		 4422}
4423
4af605d8
JH		 4424static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
4425 u8 bdaddr_type, s8 rssi, u8 *data, u8 len)
4426{
b9a6328f 4427 struct discovery_state *d = &hdev->discovery;
1c1abcab 4428 struct smp_irk *irk;
fd45ada9 4429 struct hci_conn *conn;
474ee066 4430 bool match;
c70a7e4c 4431 u32 flags;
b9a6328f 4432
1c1abcab
JH		 4433 /* Check if we need to convert to identity address */
4434 irk = hci_get_irk(hdev, bdaddr, bdaddr_type);
4435 if (irk) {
4436 bdaddr = &irk->bdaddr;
4437 bdaddr_type = irk->addr_type;
4438 }
4439
4440 /* Check if we have been requested to connect to this device */
fd45ada9
AA		 4441 conn = check_pending_le_conn(hdev, bdaddr, bdaddr_type, type);
4442 if (conn && type == LE_ADV_IND) {
4443 /* Store report for later inclusion by
4444 * mgmt_device_connected
4445 */
4446 memcpy(conn->le_adv_data, data, len);
4447 conn->le_adv_data_len = len;
4448 }
1c1abcab 4449
0d2bf134
JH		 4450 /* Passive scanning shouldn't trigger any device found events,
4451 * except for devices marked as CONN_REPORT for which we do send
4452 * device found events.
4453 */
ca5c4be7 4454 if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
0d2bf134
JH		 4455 if (type == LE_ADV_DIRECT_IND)
4456 return;
4457
3a19b6fe
JH		 4458 if (!hci_pend_le_action_lookup(&hdev->pend_le_reports,
4459 bdaddr, bdaddr_type))
0d2bf134
JH		 4460 return;
4461
4462 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND)
4463 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4464 else
4465 flags = 0;
4466 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4467 rssi, flags, data, len, NULL, 0);
97bf2e99 4468 return;
ca5c4be7 4469 }
4af605d8 4470
c70a7e4c
MH		 4471 /* When receiving non-connectable or scannable undirected
4472 * advertising reports, this means that the remote device is
4473 * not connectable and then clearly indicate this in the
4474 * device found event.
4475 *
4476 * When receiving a scan response, then there is no way to
4477 * know if the remote device is connectable or not. However
4478 * since scan responses are merged with a previously seen
4479 * advertising report, the flags field from that report
4480 * will be used.
4481 *
4482 * In the really unlikely case that a controller get confused
4483 * and just sends a scan response event, then it is marked as
4484 * not connectable as well.
4485 */
4486 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND ||
4487 type == LE_ADV_SCAN_RSP)
4488 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4489 else
4490 flags = 0;
4491
b9a6328f
JH		 4492 /* If there's nothing pending either store the data from this
4493 * event or send an immediate device found event if the data
4494 * should not be stored for later.
4495 */
4496 if (!has_pending_adv_report(hdev)) {
4497 /* If the report will trigger a SCAN_REQ store it for
4498 * later merging.
4499 */
4500 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4501 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
c70a7e4c 4502 rssi, flags, data, len);
b9a6328f
JH		 4503 return;
4504 }
4505
4506 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
c70a7e4c 4507 rssi, flags, data, len, NULL, 0);
b9a6328f
JH		 4508 return;
4509 }
4510
474ee066
JH		 4511 /* Check if the pending report is for the same device as the new one */
4512 match = (!bacmp(bdaddr, &d->last_adv_addr) &&
4513 bdaddr_type == d->last_adv_addr_type);
4514
b9a6328f
JH		 4515 /* If the pending data doesn't match this report or this isn't a
4516 * scan response (e.g. we got a duplicate ADV_IND) then force
4517 * sending of the pending data.
4518 */
474ee066
JH		 4519 if (type != LE_ADV_SCAN_RSP || !match) {
4520 /* Send out whatever is in the cache, but skip duplicates */
4521 if (!match)
4522 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
ff5cd29f 4523 d->last_adv_addr_type, NULL,
c70a7e4c 4524 d->last_adv_rssi, d->last_adv_flags,
ff5cd29f 4525 d->last_adv_data,
474ee066 4526 d->last_adv_data_len, NULL, 0);
b9a6328f
JH		 4527
4528 /* If the new report will trigger a SCAN_REQ store it for
4529 * later merging.
4530 */
4531 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4532 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
c70a7e4c 4533 rssi, flags, data, len);
b9a6328f
JH		 4534 return;
4535 }
4536
4537 /* The advertising reports cannot be merged, so clear
4538 * the pending report and send out a device found event.
4539 */
4540 clear_pending_adv_report(hdev);
5c5b93e4 4541 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
c70a7e4c 4542 rssi, flags, data, len, NULL, 0);
b9a6328f
JH		 4543 return;
4544 }
4545
4546 /* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
4547 * the new event is a SCAN_RSP. We can therefore proceed with
4548 * sending a merged device found event.
4549 */
4550 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
c70a7e4c 4551 d->last_adv_addr_type, NULL, rssi, d->last_adv_flags,
42bd6a56 4552 d->last_adv_data, d->last_adv_data_len, data, len);
b9a6328f 4553 clear_pending_adv_report(hdev);
4af605d8
JH		 4554}
4555
6039aa73 4556static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
9aa04c91 4557{
e95beb41
AG		 4558 u8 num_reports = skb->data[0];
4559 void *ptr = &skb->data[1];
9aa04c91 4560
a4790dbd
AG		 4561 hci_dev_lock(hdev);
4562
e95beb41
AG		 4563 while (num_reports--) {
4564 struct hci_ev_le_advertising_info *ev = ptr;
4af605d8 4565 s8 rssi;
a4790dbd 4566
3c9e9195 4567 rssi = ev->data[ev->length];
4af605d8
JH		 4568 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
4569 ev->bdaddr_type, rssi, ev->data, ev->length);
3c9e9195 4570
e95beb41 4571 ptr += sizeof(*ev) + ev->length + 1;
9aa04c91 4572 }
a4790dbd
AG		 4573
4574 hci_dev_unlock(hdev);
9aa04c91
AG		 4575}
4576
6039aa73 4577static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a7a595f6
VCG		 4578{
4579 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
4580 struct hci_cp_le_ltk_reply cp;
bea710fe 4581 struct hci_cp_le_ltk_neg_reply neg;
a7a595f6 4582 struct hci_conn *conn;
c9839a11 4583 struct smp_ltk *ltk;
a7a595f6 4584
9f1db00c 4585 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
a7a595f6
VCG		 4586
4587 hci_dev_lock(hdev);
4588
4589 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
bea710fe
VCG		 4590 if (conn == NULL)
4591 goto not_found;
a7a595f6 4592
e804d25d 4593 ltk = hci_find_ltk(hdev, ev->ediv, ev->rand, conn->role);
bea710fe
VCG		 4594 if (ltk == NULL)
4595 goto not_found;
4596
4597 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
a7a595f6 4598 cp.handle = cpu_to_le16(conn->handle);
c9839a11 4599
a6f7833c 4600 conn->pending_sec_level = smp_ltk_sec_level(ltk);
a7a595f6 4601
89cbb4da 4602 conn->enc_key_size = ltk->enc_size;
a7a595f6
VCG		 4603
4604 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
4605
5981a882
CT		 4606 /* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
4607 * temporary key used to encrypt a connection following
4608 * pairing. It is used during the Encrypted Session Setup to
4609 * distribute the keys. Later, security can be re-established
4610 * using a distributed LTK.
4611 */
2ceba539 4612 if (ltk->type == SMP_STK) {
fe59a05f 4613 set_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
970d0f1b
JH		 4614 list_del_rcu(&ltk->list);
4615 kfree_rcu(ltk, rcu);
fe59a05f
JH		 4616 } else {
4617 clear_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
c9839a11
VCG		 4618 }
4619
a7a595f6 4620 hci_dev_unlock(hdev);
bea710fe
VCG		 4621
4622 return;
4623
4624not_found:
4625 neg.handle = ev->handle;
4626 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
4627 hci_dev_unlock(hdev);
a7a595f6
VCG		 4628}
4629
8e75b46a
AG		 4630static void send_conn_param_neg_reply(struct hci_dev *hdev, u16 handle,
4631 u8 reason)
4632{
4633 struct hci_cp_le_conn_param_req_neg_reply cp;
4634
4635 cp.handle = cpu_to_le16(handle);
4636 cp.reason = reason;
4637
4638 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_NEG_REPLY, sizeof(cp),
4639 &cp);
4640}
4641
4642static void hci_le_remote_conn_param_req_evt(struct hci_dev *hdev,
4643 struct sk_buff *skb)
4644{
4645 struct hci_ev_le_remote_conn_param_req *ev = (void *) skb->data;
4646 struct hci_cp_le_conn_param_req_reply cp;
4647 struct hci_conn *hcon;
4648 u16 handle, min, max, latency, timeout;
4649
4650 handle = le16_to_cpu(ev->handle);
4651 min = le16_to_cpu(ev->interval_min);
4652 max = le16_to_cpu(ev->interval_max);
4653 latency = le16_to_cpu(ev->latency);
4654 timeout = le16_to_cpu(ev->timeout);
4655
4656 hcon = hci_conn_hash_lookup_handle(hdev, handle);
4657 if (!hcon || hcon->state != BT_CONNECTED)
4658 return send_conn_param_neg_reply(hdev, handle,
4659 HCI_ERROR_UNKNOWN_CONN_ID);
4660
4661 if (hci_check_conn_params(min, max, latency, timeout))
4662 return send_conn_param_neg_reply(hdev, handle,
4663 HCI_ERROR_INVALID_LL_PARAMS);
4664
40bef302 4665 if (hcon->role == HCI_ROLE_MASTER) {
348d50b8 4666 struct hci_conn_params *params;
f4869e2a 4667 u8 store_hint;
348d50b8
JH		 4668
4669 hci_dev_lock(hdev);
4670
4671 params = hci_conn_params_lookup(hdev, &hcon->dst,
4672 hcon->dst_type);
4673 if (params) {
4674 params->conn_min_interval = min;
4675 params->conn_max_interval = max;
4676 params->conn_latency = latency;
4677 params->supervision_timeout = timeout;
f4869e2a
JH		 4678 store_hint = 0x01;
4679 } else{
4680 store_hint = 0x00;
348d50b8
JH		 4681 }
4682
4683 hci_dev_unlock(hdev);
4684
f4869e2a
JH		 4685 mgmt_new_conn_param(hdev, &hcon->dst, hcon->dst_type,
4686 store_hint, min, max, latency, timeout);
348d50b8 4687 }
ffb5a827 4688
8e75b46a
AG		 4689 cp.handle = ev->handle;
4690 cp.interval_min = ev->interval_min;
4691 cp.interval_max = ev->interval_max;
4692 cp.latency = ev->latency;
4693 cp.timeout = ev->timeout;
4694 cp.min_ce_len = 0;
4695 cp.max_ce_len = 0;
4696
4697 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_REPLY, sizeof(cp), &cp);
4698}
4699
6039aa73 4700static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
fcd89c09
VT		 4701{
4702 struct hci_ev_le_meta *le_ev = (void *) skb->data;
4703
4704 skb_pull(skb, sizeof(*le_ev));
4705
4706 switch (le_ev->subevent) {
4707 case HCI_EV_LE_CONN_COMPLETE:
4708 hci_le_conn_complete_evt(hdev, skb);
4709 break;
4710
1855d92d
MH		 4711 case HCI_EV_LE_CONN_UPDATE_COMPLETE:
4712 hci_le_conn_update_complete_evt(hdev, skb);
4713 break;
4714
9aa04c91
AG		 4715 case HCI_EV_LE_ADVERTISING_REPORT:
4716 hci_le_adv_report_evt(hdev, skb);
4717 break;
4718
a7a595f6
VCG		 4719 case HCI_EV_LE_LTK_REQ:
4720 hci_le_ltk_request_evt(hdev, skb);
4721 break;
4722
8e75b46a
AG		 4723 case HCI_EV_LE_REMOTE_CONN_PARAM_REQ:
4724 hci_le_remote_conn_param_req_evt(hdev, skb);
4725 break;
4726
fcd89c09
VT		 4727 default:
4728 break;
4729 }
4730}
4731
9495b2ee
AE		 4732static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
4733{
4734 struct hci_ev_channel_selected *ev = (void *) skb->data;
4735 struct hci_conn *hcon;
4736
4737 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
4738
4739 skb_pull(skb, sizeof(*ev));
4740
4741 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4742 if (!hcon)
4743 return;
4744
4745 amp_read_loc_assoc_final_data(hdev, hcon);
4746}
4747
a9de9248
MH		 4748void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
4749{
4750 struct hci_event_hdr *hdr = (void *) skb->data;
4751 __u8 event = hdr->evt;
4752
b6ddb638
JH		 4753 hci_dev_lock(hdev);
4754
4755 /* Received events are (currently) only needed when a request is
4756 * ongoing so avoid unnecessary memory allocation.
4757 */
899de765 4758 if (hci_req_pending(hdev)) {
b6ddb638
JH		 4759 kfree_skb(hdev->recv_evt);
4760 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
4761 }
4762
4763 hci_dev_unlock(hdev);
4764
a9de9248
MH		 4765 skb_pull(skb, HCI_EVENT_HDR_SIZE);
4766
02350a72 4767 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
c1f23a2b
JB		 4768 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
4769 u16 opcode = __le16_to_cpu(cmd_hdr->opcode);
02350a72
JH		 4770
4771 hci_req_cmd_complete(hdev, opcode, 0);
4772 }
4773
a9de9248 4774 switch (event) {
1da177e4
LT		 4775 case HCI_EV_INQUIRY_COMPLETE:
4776 hci_inquiry_complete_evt(hdev, skb);
4777 break;
4778
4779 case HCI_EV_INQUIRY_RESULT:
4780 hci_inquiry_result_evt(hdev, skb);
4781 break;
4782
a9de9248
MH		 4783 case HCI_EV_CONN_COMPLETE:
4784 hci_conn_complete_evt(hdev, skb);
21d9e30e
MH		 4785 break;
4786
1da177e4
LT		 4787 case HCI_EV_CONN_REQUEST:
4788 hci_conn_request_evt(hdev, skb);
4789 break;
4790
1da177e4
LT		 4791 case HCI_EV_DISCONN_COMPLETE:
4792 hci_disconn_complete_evt(hdev, skb);
4793 break;
4794
1da177e4
LT		 4795 case HCI_EV_AUTH_COMPLETE:
4796 hci_auth_complete_evt(hdev, skb);
4797 break;
4798
a9de9248
MH		 4799 case HCI_EV_REMOTE_NAME:
4800 hci_remote_name_evt(hdev, skb);
4801 break;
4802
1da177e4
LT		 4803 case HCI_EV_ENCRYPT_CHANGE:
4804 hci_encrypt_change_evt(hdev, skb);
4805 break;
4806
a9de9248
MH		 4807 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
4808 hci_change_link_key_complete_evt(hdev, skb);
4809 break;
4810
4811 case HCI_EV_REMOTE_FEATURES:
4812 hci_remote_features_evt(hdev, skb);
4813 break;
4814
a9de9248
MH		 4815 case HCI_EV_CMD_COMPLETE:
4816 hci_cmd_complete_evt(hdev, skb);
4817 break;
4818
4819 case HCI_EV_CMD_STATUS:
4820 hci_cmd_status_evt(hdev, skb);
4821 break;
4822
24dfa343
MH		 4823 case HCI_EV_HARDWARE_ERROR:
4824 hci_hardware_error_evt(hdev, skb);
4825 break;
4826
a9de9248
MH		 4827 case HCI_EV_ROLE_CHANGE:
4828 hci_role_change_evt(hdev, skb);
4829 break;
4830
4831 case HCI_EV_NUM_COMP_PKTS:
4832 hci_num_comp_pkts_evt(hdev, skb);
4833 break;
4834
4835 case HCI_EV_MODE_CHANGE:
4836 hci_mode_change_evt(hdev, skb);
1da177e4
LT		 4837 break;
4838
4839 case HCI_EV_PIN_CODE_REQ:
4840 hci_pin_code_request_evt(hdev, skb);
4841 break;
4842
4843 case HCI_EV_LINK_KEY_REQ:
4844 hci_link_key_request_evt(hdev, skb);
4845 break;
4846
4847 case HCI_EV_LINK_KEY_NOTIFY:
4848 hci_link_key_notify_evt(hdev, skb);
4849 break;
4850
4851 case HCI_EV_CLOCK_OFFSET:
4852 hci_clock_offset_evt(hdev, skb);
4853 break;
4854
a8746417
MH		 4855 case HCI_EV_PKT_TYPE_CHANGE:
4856 hci_pkt_type_change_evt(hdev, skb);
4857 break;
4858
85a1e930
MH		 4859 case HCI_EV_PSCAN_REP_MODE:
4860 hci_pscan_rep_mode_evt(hdev, skb);
4861 break;
4862
a9de9248
MH		 4863 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
4864 hci_inquiry_result_with_rssi_evt(hdev, skb);
04837f64
MH		 4865 break;
4866
a9de9248
MH		 4867 case HCI_EV_REMOTE_EXT_FEATURES:
4868 hci_remote_ext_features_evt(hdev, skb);
1da177e4
LT		 4869 break;
4870
a9de9248
MH		 4871 case HCI_EV_SYNC_CONN_COMPLETE:
4872 hci_sync_conn_complete_evt(hdev, skb);
4873 break;
1da177e4 4874
a9de9248
MH		 4875 case HCI_EV_EXTENDED_INQUIRY_RESULT:
4876 hci_extended_inquiry_result_evt(hdev, skb);
4877 break;
1da177e4 4878
1c2e0041
JH		 4879 case HCI_EV_KEY_REFRESH_COMPLETE:
4880 hci_key_refresh_complete_evt(hdev, skb);
4881 break;
4882
0493684e
MH		 4883 case HCI_EV_IO_CAPA_REQUEST:
4884 hci_io_capa_request_evt(hdev, skb);
4885 break;
4886
03b555e1
JH		 4887 case HCI_EV_IO_CAPA_REPLY:
4888 hci_io_capa_reply_evt(hdev, skb);
4889 break;
4890
a5c29683
JH		 4891 case HCI_EV_USER_CONFIRM_REQUEST:
4892 hci_user_confirm_request_evt(hdev, skb);
4893 break;
4894
1143d458
BG		 4895 case HCI_EV_USER_PASSKEY_REQUEST:
4896 hci_user_passkey_request_evt(hdev, skb);
4897 break;
4898
92a25256
JH		 4899 case HCI_EV_USER_PASSKEY_NOTIFY:
4900 hci_user_passkey_notify_evt(hdev, skb);
4901 break;
4902
4903 case HCI_EV_KEYPRESS_NOTIFY:
4904 hci_keypress_notify_evt(hdev, skb);
4905 break;
4906
0493684e
MH		 4907 case HCI_EV_SIMPLE_PAIR_COMPLETE:
4908 hci_simple_pair_complete_evt(hdev, skb);
4909 break;
4910
41a96212
MH		 4911 case HCI_EV_REMOTE_HOST_FEATURES:
4912 hci_remote_host_features_evt(hdev, skb);
4913 break;
4914
fcd89c09
VT		 4915 case HCI_EV_LE_META:
4916 hci_le_meta_evt(hdev, skb);
4917 break;
4918
9495b2ee
AE		 4919 case HCI_EV_CHANNEL_SELECTED:
4920 hci_chan_selected_evt(hdev, skb);
4921 break;
4922
2763eda6
SJ		 4923 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
4924 hci_remote_oob_data_request_evt(hdev, skb);
4925 break;
4926
d5e91192
AE		 4927 case HCI_EV_PHY_LINK_COMPLETE:
4928 hci_phy_link_complete_evt(hdev, skb);
4929 break;
4930
27695fb4
AE		 4931 case HCI_EV_LOGICAL_LINK_COMPLETE:
4932 hci_loglink_complete_evt(hdev, skb);
4933 break;
4934
606e2a10
AE		 4935 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
4936 hci_disconn_loglink_complete_evt(hdev, skb);
4937 break;
4938
9eef6b3a
AE		 4939 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
4940 hci_disconn_phylink_complete_evt(hdev, skb);
4941 break;
4942
25e89e99
AE		 4943 case HCI_EV_NUM_COMP_BLOCKS:
4944 hci_num_comp_blocks_evt(hdev, skb);
4945 break;
4946
a9de9248 4947 default:
9f1db00c 4948 BT_DBG("%s event 0x%2.2x", hdev->name, event);
1da177e4
LT		 4949 break;
4950 }
4951
4952 kfree_skb(skb);
4953 hdev->stat.evt_rx++;
4954}
ubuntu-bionic-kernel mirror