]> 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: Fix setting conn->pending_sec_level value from link key
[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);
3297 if (conn) {
3298 hci_conn_hold(conn);
3299 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 3300 hci_conn_drop(conn);
cb6f3f7a 3301 conn_set_key(conn, ev->key_type, conn->pin_length);
052b30b0
MH		 3302 }
3303
7652ff6a
JH		 3304 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
3305 goto unlock;
3306
3307 key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
3308 ev->key_type, pin_len, &persistent);
3309 if (!key)
3310 goto unlock;
3311
cb6f3f7a
JH		 3312 /* Update connection information since adding the key will have
3313 * fixed up the type in the case of changed combination keys.
3314 */
3315 if (ev->key_type == HCI_LK_CHANGED_COMBINATION)
3316 conn_set_key(conn, key->type, key->pin_len);
3317
7652ff6a 3318 mgmt_new_link_key(hdev, key, persistent);
55ed8ca1 3319
6d5650c4
JH		 3320 /* Keep debug keys around only if the HCI_KEEP_DEBUG_KEYS flag
3321 * is set. If it's not set simply remove the key from the kernel
3322 * list (we've still notified user space about it but with
3323 * store_hint being 0).
3324 */
3325 if (key->type == HCI_LK_DEBUG_COMBINATION &&
3326 !test_bit(HCI_KEEP_DEBUG_KEYS, &hdev->dev_flags)) {
3327 list_del(&key->list);
3328 kfree(key);
3329 } else if (conn) {
af6a9c32
JH		 3330 if (persistent)
3331 clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
3332 else
3333 set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
6d5650c4 3334 }
7652ff6a
JH		 3335
3336unlock:
052b30b0 3337 hci_dev_unlock(hdev);
a9de9248
MH		 3338}
3339
6039aa73 3340static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 3341{
a9de9248 3342 struct hci_ev_clock_offset *ev = (void *) skb->data;
04837f64 3343 struct hci_conn *conn;
1da177e4 3344
9f1db00c 3345 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT		 3346
3347 hci_dev_lock(hdev);
3348
04837f64 3349 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT		 3350 if (conn && !ev->status) {
3351 struct inquiry_entry *ie;
3352
cc11b9c1
AE		 3353 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3354 if (ie) {
1da177e4
LT		 3355 ie->data.clock_offset = ev->clock_offset;
3356 ie->timestamp = jiffies;
3357 }
3358 }
3359
3360 hci_dev_unlock(hdev);
3361}
3362
6039aa73 3363static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a8746417
MH		 3364{
3365 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
3366 struct hci_conn *conn;
3367
9f1db00c 3368 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a8746417
MH		 3369
3370 hci_dev_lock(hdev);
3371
3372 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3373 if (conn && !ev->status)
3374 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
3375
3376 hci_dev_unlock(hdev);
3377}
3378
6039aa73 3379static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
85a1e930 3380{
a9de9248 3381 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
85a1e930
MH		 3382 struct inquiry_entry *ie;
3383
3384 BT_DBG("%s", hdev->name);
3385
3386 hci_dev_lock(hdev);
3387
cc11b9c1
AE		 3388 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3389 if (ie) {
85a1e930
MH		 3390 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
3391 ie->timestamp = jiffies;
3392 }
3393
3394 hci_dev_unlock(hdev);
3395}
3396
6039aa73
GP		 3397static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
3398 struct sk_buff *skb)
a9de9248
MH		 3399{
3400 struct inquiry_data data;
3401 int num_rsp = *((__u8 *) skb->data);
3402
3403 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
3404
3405 if (!num_rsp)
3406 return;
3407
1519cc17
AG		 3408 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3409 return;
3410
a9de9248
MH		 3411 hci_dev_lock(hdev);
3412
3413 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
138d22ef
SJ		 3414 struct inquiry_info_with_rssi_and_pscan_mode *info;
3415 info = (void *) (skb->data + 1);
a9de9248 3416
e17acd40 3417 for (; num_rsp; num_rsp--, info++) {
af58925c
MH		 3418 u32 flags;
3419
a9de9248
MH		 3420 bacpy(&data.bdaddr, &info->bdaddr);
3421 data.pscan_rep_mode = info->pscan_rep_mode;
3422 data.pscan_period_mode = info->pscan_period_mode;
3423 data.pscan_mode = info->pscan_mode;
3424 memcpy(data.dev_class, info->dev_class, 3);
3425 data.clock_offset = info->clock_offset;
3426 data.rssi = info->rssi;
41a96212 3427 data.ssp_mode = 0x00;
3175405b 3428
af58925c
MH		 3429 flags = hci_inquiry_cache_update(hdev, &data, false);
3430
48264f06 3431 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681 3432 info->dev_class, info->rssi,
af58925c 3433 flags, NULL, 0, NULL, 0);
a9de9248
MH		 3434 }
3435 } else {
3436 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
3437
e17acd40 3438 for (; num_rsp; num_rsp--, info++) {
af58925c
MH		 3439 u32 flags;
3440
a9de9248
MH		 3441 bacpy(&data.bdaddr, &info->bdaddr);
3442 data.pscan_rep_mode = info->pscan_rep_mode;
3443 data.pscan_period_mode = info->pscan_period_mode;
3444 data.pscan_mode = 0x00;
3445 memcpy(data.dev_class, info->dev_class, 3);
3446 data.clock_offset = info->clock_offset;
3447 data.rssi = info->rssi;
41a96212 3448 data.ssp_mode = 0x00;
af58925c
MH		 3449
3450 flags = hci_inquiry_cache_update(hdev, &data, false);
3451
48264f06 3452 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681 3453 info->dev_class, info->rssi,
af58925c 3454 flags, NULL, 0, NULL, 0);
a9de9248
MH		 3455 }
3456 }
3457
3458 hci_dev_unlock(hdev);
3459}
3460
6039aa73
GP		 3461static void hci_remote_ext_features_evt(struct hci_dev *hdev,
3462 struct sk_buff *skb)
a9de9248 3463{
41a96212
MH		 3464 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
3465 struct hci_conn *conn;
3466
a9de9248 3467 BT_DBG("%s", hdev->name);
41a96212 3468
41a96212
MH		 3469 hci_dev_lock(hdev);
3470
3471 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH		 3472 if (!conn)
3473 goto unlock;
41a96212 3474
cad718ed
JH		 3475 if (ev->page < HCI_MAX_PAGES)
3476 memcpy(conn->features[ev->page], ev->features, 8);
3477
ccd556fe
JH		 3478 if (!ev->status && ev->page == 0x01) {
3479 struct inquiry_entry *ie;
41a96212 3480
cc11b9c1
AE		 3481 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
3482 if (ie)
02b7cc62 3483 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
769be974 3484
bbb0eada 3485 if (ev->features[0] & LMP_HOST_SSP) {
58a681ef 3486 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
bbb0eada
JK		 3487 } else {
3488 /* It is mandatory by the Bluetooth specification that
3489 * Extended Inquiry Results are only used when Secure
3490 * Simple Pairing is enabled, but some devices violate
3491 * this.
3492 *
3493 * To make these devices work, the internal SSP
3494 * enabled flag needs to be cleared if the remote host
3495 * features do not indicate SSP support */
3496 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
3497 }
eb9a8f3f
MH		 3498
3499 if (ev->features[0] & LMP_HOST_SC)
3500 set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
ccd556fe
JH		 3501 }
3502
3503 if (conn->state != BT_CONFIG)
3504 goto unlock;
3505
671267bf 3506 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
127178d2
JH		 3507 struct hci_cp_remote_name_req cp;
3508 memset(&cp, 0, sizeof(cp));
3509 bacpy(&cp.bdaddr, &conn->dst);
3510 cp.pscan_rep_mode = 0x02;
3511 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
b644ba33 3512 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
48ec92fa 3513 mgmt_device_connected(hdev, conn, 0, NULL, 0);
392599b9 3514
127178d2 3515 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH		 3516 conn->state = BT_CONNECTED;
3517 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 3518 hci_conn_drop(conn);
41a96212
MH		 3519 }
3520
ccd556fe 3521unlock:
41a96212 3522 hci_dev_unlock(hdev);
a9de9248
MH		 3523}
3524
6039aa73
GP		 3525static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
3526 struct sk_buff *skb)
a9de9248 3527{
b6a0dc82
MH		 3528 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
3529 struct hci_conn *conn;
3530
9f1db00c 3531 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
b6a0dc82
MH		 3532
3533 hci_dev_lock(hdev);
3534
3535 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9dc0a3af
MH		 3536 if (!conn) {
3537 if (ev->link_type == ESCO_LINK)
3538 goto unlock;
3539
3540 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
3541 if (!conn)
3542 goto unlock;
3543
3544 conn->type = SCO_LINK;
3545 }
b6a0dc82 3546
732547f9
MH		 3547 switch (ev->status) {
3548 case 0x00:
b6a0dc82
MH		 3549 conn->handle = __le16_to_cpu(ev->handle);
3550 conn->state = BT_CONNECTED;
7d0db0a3
MH		 3551
3552 hci_conn_add_sysfs(conn);
732547f9
MH		 3553 break;
3554
81218d20 3555 case 0x10: /* Connection Accept Timeout */
1a4c958c 3556 case 0x0d: /* Connection Rejected due to Limited Resources */
705e5711 3557 case 0x11: /* Unsupported Feature or Parameter Value */
732547f9 3558 case 0x1c: /* SCO interval rejected */
1038a00b 3559 case 0x1a: /* Unsupported Remote Feature */
732547f9 3560 case 0x1f: /* Unspecified error */
27539bc4 3561 case 0x20: /* Unsupported LMP Parameter value */
2dea632f 3562 if (conn->out) {
732547f9
MH		 3563 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
3564 (hdev->esco_type & EDR_ESCO_MASK);
2dea632f
FD		 3565 if (hci_setup_sync(conn, conn->link->handle))
3566 goto unlock;
732547f9
MH		 3567 }
3568 /* fall through */
3569
3570 default:
b6a0dc82 3571 conn->state = BT_CLOSED;
732547f9
MH		 3572 break;
3573 }
b6a0dc82
MH		 3574
3575 hci_proto_connect_cfm(conn, ev->status);
3576 if (ev->status)
3577 hci_conn_del(conn);
3578
3579unlock:
3580 hci_dev_unlock(hdev);
a9de9248
MH		 3581}
3582
efdcf8e3
MH		 3583static inline size_t eir_get_length(u8 *eir, size_t eir_len)
3584{
3585 size_t parsed = 0;
3586
3587 while (parsed < eir_len) {
3588 u8 field_len = eir[0];
3589
3590 if (field_len == 0)
3591 return parsed;
3592
3593 parsed += field_len + 1;
3594 eir += field_len + 1;
3595 }
3596
3597 return eir_len;
3598}
3599
6039aa73
GP		 3600static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3601 struct sk_buff *skb)
1da177e4 3602{
a9de9248
MH		 3603 struct inquiry_data data;
3604 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3605 int num_rsp = *((__u8 *) skb->data);
9d939d94 3606 size_t eir_len;
1da177e4 3607
a9de9248 3608 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1da177e4 3609
a9de9248
MH		 3610 if (!num_rsp)
3611 return;
1da177e4 3612
1519cc17
AG		 3613 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3614 return;
3615
a9de9248
MH		 3616 hci_dev_lock(hdev);
3617
e17acd40 3618 for (; num_rsp; num_rsp--, info++) {
af58925c
MH		 3619 u32 flags;
3620 bool name_known;
561aafbc 3621
a9de9248 3622 bacpy(&data.bdaddr, &info->bdaddr);
138d22ef
SJ		 3623 data.pscan_rep_mode = info->pscan_rep_mode;
3624 data.pscan_period_mode = info->pscan_period_mode;
3625 data.pscan_mode = 0x00;
a9de9248 3626 memcpy(data.dev_class, info->dev_class, 3);
138d22ef
SJ		 3627 data.clock_offset = info->clock_offset;
3628 data.rssi = info->rssi;
41a96212 3629 data.ssp_mode = 0x01;
561aafbc 3630
a8b2d5c2 3631 if (test_bit(HCI_MGMT, &hdev->dev_flags))
4ddb1930 3632 name_known = eir_has_data_type(info->data,
04124681
GP		 3633 sizeof(info->data),
3634 EIR_NAME_COMPLETE);
561aafbc
JH		 3635 else
3636 name_known = true;
3637
af58925c
MH		 3638 flags = hci_inquiry_cache_update(hdev, &data, name_known);
3639
9d939d94 3640 eir_len = eir_get_length(info->data, sizeof(info->data));
af58925c 3641
48264f06 3642 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
af58925c
MH		 3643 info->dev_class, info->rssi,
3644 flags, info->data, eir_len, NULL, 0);
a9de9248
MH		 3645 }
3646
3647 hci_dev_unlock(hdev);
3648}
1da177e4 3649
1c2e0041
JH		 3650static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3651 struct sk_buff *skb)
3652{
3653 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3654 struct hci_conn *conn;
3655
9f1db00c 3656 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
1c2e0041
JH		 3657 __le16_to_cpu(ev->handle));
3658
3659 hci_dev_lock(hdev);
3660
3661 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3662 if (!conn)
3663 goto unlock;
3664
9eb1fbfa
JH		 3665 /* For BR/EDR the necessary steps are taken through the
3666 * auth_complete event.
3667 */
3668 if (conn->type != LE_LINK)
3669 goto unlock;
3670
1c2e0041
JH		 3671 if (!ev->status)
3672 conn->sec_level = conn->pending_sec_level;
3673
3674 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3675
3676 if (ev->status && conn->state == BT_CONNECTED) {
bed71748 3677 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
76a68ba0 3678 hci_conn_drop(conn);
1c2e0041
JH		 3679 goto unlock;
3680 }
3681
3682 if (conn->state == BT_CONFIG) {
3683 if (!ev->status)
3684 conn->state = BT_CONNECTED;
3685
3686 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 3687 hci_conn_drop(conn);
1c2e0041
JH		 3688 } else {
3689 hci_auth_cfm(conn, ev->status);
3690
3691 hci_conn_hold(conn);
3692 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 3693 hci_conn_drop(conn);
1c2e0041
JH		 3694 }
3695
3696unlock:
3697 hci_dev_unlock(hdev);
3698}
3699
6039aa73 3700static u8 hci_get_auth_req(struct hci_conn *conn)
17fa4b9d 3701{
17fa4b9d 3702 /* If remote requests no-bonding follow that lead */
acabae96
MA		 3703 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3704 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
58797bf7 3705 return conn->remote_auth | (conn->auth_type & 0x01);
17fa4b9d 3706
b7f94c88
MA		 3707 /* If both remote and local have enough IO capabilities, require
3708 * MITM protection
3709 */
3710 if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
3711 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
3712 return conn->remote_auth | 0x01;
3713
7e74170a
TM		 3714 /* No MITM protection possible so ignore remote requirement */
3715 return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
17fa4b9d
JH		 3716}
3717
6039aa73 3718static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
0493684e
MH		 3719{
3720 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3721 struct hci_conn *conn;
3722
3723 BT_DBG("%s", hdev->name);
3724
3725 hci_dev_lock(hdev);
3726
3727 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
03b555e1
JH		 3728 if (!conn)
3729 goto unlock;
3730
3731 hci_conn_hold(conn);
3732
a8b2d5c2 3733 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
03b555e1
JH		 3734 goto unlock;
3735
2f407f0a
JH		 3736 /* Allow pairing if we're pairable, the initiators of the
3737 * pairing or if the remote is not requesting bonding.
3738 */
b6ae8457 3739 if (test_bit(HCI_BONDABLE, &hdev->dev_flags) ||
2f407f0a 3740 test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags) ||
807deac2 3741 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
17fa4b9d
JH		 3742 struct hci_cp_io_capability_reply cp;
3743
3744 bacpy(&cp.bdaddr, &ev->bdaddr);
7a7f1e7c
HG		 3745 /* Change the IO capability from KeyboardDisplay
3746 * to DisplayYesNo as it is not supported by BT spec. */
3747 cp.capability = (conn->io_capability == 0x04) ?
a767631a 3748 HCI_IO_DISPLAY_YESNO : conn->io_capability;
b7f94c88
MA		 3749
3750 /* If we are initiators, there is no remote information yet */
3751 if (conn->remote_auth == 0xff) {
b16c6604 3752 /* Request MITM protection if our IO caps allow it
4ad51a75 3753 * except for the no-bonding case.
b16c6604 3754 */
6fd6b915 3755 if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
9f743d74 3756 conn->auth_type != HCI_AT_NO_BONDING)
6c53823a 3757 conn->auth_type |= 0x01;
b7f94c88
MA		 3758 } else {
3759 conn->auth_type = hci_get_auth_req(conn);
b7f94c88 3760 }
17fa4b9d 3761
82c295b1
JH		 3762 /* If we're not bondable, force one of the non-bondable
3763 * authentication requirement values.
3764 */
3765 if (!test_bit(HCI_BONDABLE, &hdev->dev_flags))
3766 conn->auth_type &= HCI_AT_NO_BONDING_MITM;
3767
3768 cp.authentication = conn->auth_type;
3769
8fc9ced3
GP		 3770 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3771 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
ce85ee13
SJ		 3772 cp.oob_data = 0x01;
3773 else
3774 cp.oob_data = 0x00;
3775
17fa4b9d 3776 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
807deac2 3777 sizeof(cp), &cp);
03b555e1
JH		 3778 } else {
3779 struct hci_cp_io_capability_neg_reply cp;
3780
3781 bacpy(&cp.bdaddr, &ev->bdaddr);
9f5a0d7b 3782 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
0493684e 3783
03b555e1 3784 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
807deac2 3785 sizeof(cp), &cp);
03b555e1
JH		 3786 }
3787
3788unlock:
3789 hci_dev_unlock(hdev);
3790}
3791
6039aa73 3792static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
03b555e1
JH		 3793{
3794 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3795 struct hci_conn *conn;
3796
3797 BT_DBG("%s", hdev->name);
3798
3799 hci_dev_lock(hdev);
3800
3801 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3802 if (!conn)
3803 goto unlock;
3804
03b555e1 3805 conn->remote_cap = ev->capability;
03b555e1 3806 conn->remote_auth = ev->authentication;
58a681ef
JH		 3807 if (ev->oob_data)
3808 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
03b555e1
JH		 3809
3810unlock:
0493684e
MH		 3811 hci_dev_unlock(hdev);
3812}
3813
6039aa73
GP		 3814static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3815 struct sk_buff *skb)
a5c29683
JH		 3816{
3817 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
55bc1a37 3818 int loc_mitm, rem_mitm, confirm_hint = 0;
7a828908 3819 struct hci_conn *conn;
a5c29683
JH		 3820
3821 BT_DBG("%s", hdev->name);
3822
3823 hci_dev_lock(hdev);
3824
a8b2d5c2 3825 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
7a828908 3826 goto unlock;
a5c29683 3827
7a828908
JH		 3828 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3829 if (!conn)
3830 goto unlock;
3831
3832 loc_mitm = (conn->auth_type & 0x01);
3833 rem_mitm = (conn->remote_auth & 0x01);
3834
3835 /* If we require MITM but the remote device can't provide that
6c53823a
JH		 3836 * (it has NoInputNoOutput) then reject the confirmation
3837 * request. We check the security level here since it doesn't
3838 * necessarily match conn->auth_type.
6fd6b915 3839 */
6c53823a
JH		 3840 if (conn->pending_sec_level > BT_SECURITY_MEDIUM &&
3841 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
7a828908
JH		 3842 BT_DBG("Rejecting request: remote device can't provide MITM");
3843 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
807deac2 3844 sizeof(ev->bdaddr), &ev->bdaddr);
7a828908
JH		 3845 goto unlock;
3846 }
3847
3848 /* If no side requires MITM protection; auto-accept */
a767631a
MA		 3849 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3850 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
55bc1a37
JH		 3851
3852 /* If we're not the initiators request authorization to
3853 * proceed from user space (mgmt_user_confirm with
ba15a58b 3854 * confirm_hint set to 1). The exception is if neither
02f3e254
JH		 3855 * side had MITM or if the local IO capability is
3856 * NoInputNoOutput, in which case we do auto-accept
ba15a58b
JH		 3857 */
3858 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
02f3e254 3859 conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
ba15a58b 3860 (loc_mitm || rem_mitm)) {
55bc1a37
JH		 3861 BT_DBG("Confirming auto-accept as acceptor");
3862 confirm_hint = 1;
3863 goto confirm;
3864 }
3865
9f61656a 3866 BT_DBG("Auto-accept of user confirmation with %ums delay",
807deac2 3867 hdev->auto_accept_delay);
9f61656a
JH		 3868
3869 if (hdev->auto_accept_delay > 0) {
3870 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
7bc18d9d
JH		 3871 queue_delayed_work(conn->hdev->workqueue,
3872 &conn->auto_accept_work, delay);
9f61656a
JH		 3873 goto unlock;
3874 }
3875
7a828908 3876 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
807deac2 3877 sizeof(ev->bdaddr), &ev->bdaddr);
7a828908
JH		 3878 goto unlock;
3879 }
3880
55bc1a37 3881confirm:
39adbffe
JH		 3882 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
3883 le32_to_cpu(ev->passkey), confirm_hint);
7a828908
JH		 3884
3885unlock:
a5c29683
JH		 3886 hci_dev_unlock(hdev);
3887}
3888
6039aa73
GP		 3889static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3890 struct sk_buff *skb)
1143d458
BG		 3891{
3892 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3893
3894 BT_DBG("%s", hdev->name);
3895
a8b2d5c2 3896 if (test_bit(HCI_MGMT, &hdev->dev_flags))
272d90df 3897 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
1143d458
BG		 3898}
3899
92a25256
JH		 3900static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3901 struct sk_buff *skb)
3902{
3903 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3904 struct hci_conn *conn;
3905
3906 BT_DBG("%s", hdev->name);
3907
3908 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3909 if (!conn)
3910 return;
3911
3912 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3913 conn->passkey_entered = 0;
3914
3915 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3916 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3917 conn->dst_type, conn->passkey_notify,
3918 conn->passkey_entered);
3919}
3920
3921static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3922{
3923 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3924 struct hci_conn *conn;
3925
3926 BT_DBG("%s", hdev->name);
3927
3928 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3929 if (!conn)
3930 return;
3931
3932 switch (ev->type) {
3933 case HCI_KEYPRESS_STARTED:
3934 conn->passkey_entered = 0;
3935 return;
3936
3937 case HCI_KEYPRESS_ENTERED:
3938 conn->passkey_entered++;
3939 break;
3940
3941 case HCI_KEYPRESS_ERASED:
3942 conn->passkey_entered--;
3943 break;
3944
3945 case HCI_KEYPRESS_CLEARED:
3946 conn->passkey_entered = 0;
3947 break;
3948
3949 case HCI_KEYPRESS_COMPLETED:
3950 return;
3951 }
3952
3953 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3954 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3955 conn->dst_type, conn->passkey_notify,
3956 conn->passkey_entered);
3957}
3958
6039aa73
GP		 3959static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3960 struct sk_buff *skb)
0493684e
MH		 3961{
3962 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3963 struct hci_conn *conn;
3964
3965 BT_DBG("%s", hdev->name);
3966
3967 hci_dev_lock(hdev);
3968
3969 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2a611692
JH		 3970 if (!conn)
3971 goto unlock;
3972
c1d4fa7a
JH		 3973 /* Reset the authentication requirement to unknown */
3974 conn->remote_auth = 0xff;
3975
2a611692
JH		 3976 /* To avoid duplicate auth_failed events to user space we check
3977 * the HCI_CONN_AUTH_PEND flag which will be set if we
3978 * initiated the authentication. A traditional auth_complete
3979 * event gets always produced as initiator and is also mapped to
3980 * the mgmt_auth_failed event */
fa1bd918 3981 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
e1e930f5 3982 mgmt_auth_failed(conn, ev->status);
0493684e 3983
76a68ba0 3984 hci_conn_drop(conn);
2a611692
JH		 3985
3986unlock:
0493684e
MH		 3987 hci_dev_unlock(hdev);
3988}
3989
6039aa73
GP		 3990static void hci_remote_host_features_evt(struct hci_dev *hdev,
3991 struct sk_buff *skb)
41a96212
MH		 3992{
3993 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3994 struct inquiry_entry *ie;
cad718ed 3995 struct hci_conn *conn;
41a96212
MH		 3996
3997 BT_DBG("%s", hdev->name);
3998
3999 hci_dev_lock(hdev);
4000
cad718ed
JH		 4001 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4002 if (conn)
4003 memcpy(conn->features[1], ev->features, 8);
4004
cc11b9c1
AE		 4005 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
4006 if (ie)
02b7cc62 4007 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
41a96212
MH		 4008
4009 hci_dev_unlock(hdev);
4010}
4011
6039aa73
GP		 4012static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
4013 struct sk_buff *skb)
2763eda6
SJ		 4014{
4015 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
4016 struct oob_data *data;
4017
4018 BT_DBG("%s", hdev->name);
4019
4020 hci_dev_lock(hdev);
4021
a8b2d5c2 4022 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
e1ba1f15
SJ		 4023 goto unlock;
4024
2763eda6
SJ		 4025 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
4026 if (data) {
519ca9d0
MH		 4027 if (test_bit(HCI_SC_ENABLED, &hdev->dev_flags)) {
4028 struct hci_cp_remote_oob_ext_data_reply cp;
2763eda6 4029
519ca9d0
MH		 4030 bacpy(&cp.bdaddr, &ev->bdaddr);
4031 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
38da1703 4032 memcpy(cp.rand192, data->rand192, sizeof(cp.rand192));
519ca9d0 4033 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
38da1703 4034 memcpy(cp.rand256, data->rand256, sizeof(cp.rand256));
519ca9d0
MH		 4035
4036 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
4037 sizeof(cp), &cp);
4038 } else {
4039 struct hci_cp_remote_oob_data_reply cp;
2763eda6 4040
519ca9d0
MH		 4041 bacpy(&cp.bdaddr, &ev->bdaddr);
4042 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
38da1703 4043 memcpy(cp.rand, data->rand192, sizeof(cp.rand));
519ca9d0
MH		 4044
4045 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
4046 sizeof(cp), &cp);
4047 }
2763eda6
SJ		 4048 } else {
4049 struct hci_cp_remote_oob_data_neg_reply cp;
4050
4051 bacpy(&cp.bdaddr, &ev->bdaddr);
519ca9d0
MH		 4052 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
4053 sizeof(cp), &cp);
2763eda6
SJ		 4054 }
4055
e1ba1f15 4056unlock:
2763eda6
SJ		 4057 hci_dev_unlock(hdev);
4058}
4059
d5e91192
AE		 4060static void hci_phy_link_complete_evt(struct hci_dev *hdev,
4061 struct sk_buff *skb)
4062{
4063 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
4064 struct hci_conn *hcon, *bredr_hcon;
4065
4066 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
4067 ev->status);
4068
4069 hci_dev_lock(hdev);
4070
4071 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4072 if (!hcon) {
4073 hci_dev_unlock(hdev);
4074 return;
4075 }
4076
4077 if (ev->status) {
4078 hci_conn_del(hcon);
4079 hci_dev_unlock(hdev);
4080 return;
4081 }
4082
4083 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
4084
4085 hcon->state = BT_CONNECTED;
4086 bacpy(&hcon->dst, &bredr_hcon->dst);
4087
4088 hci_conn_hold(hcon);
4089 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 4090 hci_conn_drop(hcon);
d5e91192 4091
d5e91192
AE		 4092 hci_conn_add_sysfs(hcon);
4093
cf70ff22 4094 amp_physical_cfm(bredr_hcon, hcon);
d5e91192 4095
cf70ff22 4096 hci_dev_unlock(hdev);
d5e91192
AE		 4097}
4098
27695fb4
AE		 4099static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
4100{
4101 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
4102 struct hci_conn *hcon;
4103 struct hci_chan *hchan;
4104 struct amp_mgr *mgr;
4105
4106 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
4107 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
4108 ev->status);
4109
4110 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4111 if (!hcon)
4112 return;
4113
4114 /* Create AMP hchan */
4115 hchan = hci_chan_create(hcon);
4116 if (!hchan)
4117 return;
4118
4119 hchan->handle = le16_to_cpu(ev->handle);
4120
4121 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
4122
4123 mgr = hcon->amp_mgr;
4124 if (mgr && mgr->bredr_chan) {
4125 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
4126
4127 l2cap_chan_lock(bredr_chan);
4128
4129 bredr_chan->conn->mtu = hdev->block_mtu;
4130 l2cap_logical_cfm(bredr_chan, hchan, 0);
4131 hci_conn_hold(hcon);
4132
4133 l2cap_chan_unlock(bredr_chan);
4134 }
4135}
4136
606e2a10
AE		 4137static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
4138 struct sk_buff *skb)
4139{
4140 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
4141 struct hci_chan *hchan;
4142
4143 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
4144 le16_to_cpu(ev->handle), ev->status);
4145
4146 if (ev->status)
4147 return;
4148
4149 hci_dev_lock(hdev);
4150
4151 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
4152 if (!hchan)
4153 goto unlock;
4154
4155 amp_destroy_logical_link(hchan, ev->reason);
4156
4157unlock:
4158 hci_dev_unlock(hdev);
4159}
4160
9eef6b3a
AE		 4161static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
4162 struct sk_buff *skb)
4163{
4164 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
4165 struct hci_conn *hcon;
4166
4167 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4168
4169 if (ev->status)
4170 return;
4171
4172 hci_dev_lock(hdev);
4173
4174 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4175 if (hcon) {
4176 hcon->state = BT_CLOSED;
4177 hci_conn_del(hcon);
4178 }
4179
4180 hci_dev_unlock(hdev);
4181}
4182
6039aa73 4183static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
fcd89c09
VT		 4184{
4185 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
912b42ef 4186 struct hci_conn_params *params;
fcd89c09 4187 struct hci_conn *conn;
68d6f6de 4188 struct smp_irk *irk;
837d502e 4189 u8 addr_type;
fcd89c09 4190
9f1db00c 4191 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
fcd89c09
VT		 4192
4193 hci_dev_lock(hdev);
4194
fbd96c15
JH		 4195 /* All controllers implicitly stop advertising in the event of a
4196 * connection, so ensure that the state bit is cleared.
4197 */
4198 clear_bit(HCI_LE_ADV, &hdev->dev_flags);
4199
b47a09b3 4200 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
b62f328b 4201 if (!conn) {
a5c4e309 4202 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr, ev->role);
b62f328b
VT		 4203 if (!conn) {
4204 BT_ERR("No memory for new connection");
230fd16a 4205 goto unlock;
b62f328b 4206 }
29b7988a
AG		 4207
4208 conn->dst_type = ev->bdaddr_type;
b9b343d2 4209
cb1d68f7
JH		 4210 /* If we didn't have a hci_conn object previously
4211 * but we're in master role this must be something
4212 * initiated using a white list. Since white list based
4213 * connections are not "first class citizens" we don't
4214 * have full tracking of them. Therefore, we go ahead
4215 * with a "best effort" approach of determining the
4216 * initiator address based on the HCI_PRIVACY flag.
4217 */
4218 if (conn->out) {
4219 conn->resp_addr_type = ev->bdaddr_type;
4220 bacpy(&conn->resp_addr, &ev->bdaddr);
4221 if (test_bit(HCI_PRIVACY, &hdev->dev_flags)) {
4222 conn->init_addr_type = ADDR_LE_DEV_RANDOM;
4223 bacpy(&conn->init_addr, &hdev->rpa);
4224 } else {
4225 hci_copy_identity_address(hdev,
4226 &conn->init_addr,
4227 &conn->init_addr_type);
4228 }
cb1d68f7 4229 }
9489eca4
JH		 4230 } else {
4231 cancel_delayed_work(&conn->le_conn_timeout);
b62f328b 4232 }
fcd89c09 4233
80c24ab8
JH		 4234 if (!conn->out) {
4235 /* Set the responder (our side) address type based on
4236 * the advertising address type.
4237 */
4238 conn->resp_addr_type = hdev->adv_addr_type;
4239 if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM)
4240 bacpy(&conn->resp_addr, &hdev->random_addr);
4241 else
4242 bacpy(&conn->resp_addr, &hdev->bdaddr);
4243
4244 conn->init_addr_type = ev->bdaddr_type;
4245 bacpy(&conn->init_addr, &ev->bdaddr);
a720d735
MH		 4246
4247 /* For incoming connections, set the default minimum
4248 * and maximum connection interval. They will be used
4249 * to check if the parameters are in range and if not
4250 * trigger the connection update procedure.
4251 */
4252 conn->le_conn_min_interval = hdev->le_conn_min_interval;
4253 conn->le_conn_max_interval = hdev->le_conn_max_interval;
80c24ab8 4254 }
7be2edbb 4255
edb4b466
MH		 4256 /* Lookup the identity address from the stored connection
4257 * address and address type.
4258 *
4259 * When establishing connections to an identity address, the
4260 * connection procedure will store the resolvable random
4261 * address first. Now if it can be converted back into the
4262 * identity address, start using the identity address from
4263 * now on.
4264 */
4265 irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
68d6f6de
JH		 4266 if (irk) {
4267 bacpy(&conn->dst, &irk->bdaddr);
4268 conn->dst_type = irk->addr_type;
4269 }
4270
2d3c2260
JH		 4271 if (ev->status) {
4272 hci_le_conn_failed(conn, ev->status);
837d502e
JH		 4273 goto unlock;
4274 }
4275
08853f18
JH		 4276 if (conn->dst_type == ADDR_LE_DEV_PUBLIC)
4277 addr_type = BDADDR_LE_PUBLIC;
4278 else
4279 addr_type = BDADDR_LE_RANDOM;
4280
2d3c2260
JH		 4281 /* Drop the connection if the device is blocked */
4282 if (hci_bdaddr_list_lookup(&hdev->blacklist, &conn->dst, addr_type)) {
4283 hci_conn_drop(conn);
cd17decb
AG		 4284 goto unlock;
4285 }
4286
b644ba33 4287 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
48ec92fa 4288 mgmt_device_connected(hdev, conn, 0, NULL, 0);
83bc71b4 4289
7b5c0d52 4290 conn->sec_level = BT_SECURITY_LOW;
fcd89c09
VT		 4291 conn->handle = __le16_to_cpu(ev->handle);
4292 conn->state = BT_CONNECTED;
4293
e04fde60
MH		 4294 conn->le_conn_interval = le16_to_cpu(ev->interval);
4295 conn->le_conn_latency = le16_to_cpu(ev->latency);
4296 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4297
fcd89c09
VT		 4298 hci_conn_add_sysfs(conn);
4299
4300 hci_proto_connect_cfm(conn, ev->status);
4301
5477610f
JH		 4302 params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
4303 conn->dst_type);
f161dd41 4304 if (params) {
95305baa 4305 list_del_init(&params->action);
f161dd41
JH		 4306 if (params->conn) {
4307 hci_conn_drop(params->conn);
f8aaf9b6 4308 hci_conn_put(params->conn);
f161dd41
JH		 4309 params->conn = NULL;
4310 }
4311 }
a4790dbd 4312
fcd89c09 4313unlock:
223683a5 4314 hci_update_background_scan(hdev);
fcd89c09
VT		 4315 hci_dev_unlock(hdev);
4316}
4317
1855d92d
MH		 4318static void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
4319 struct sk_buff *skb)
4320{
4321 struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
4322 struct hci_conn *conn;
4323
4324 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4325
4326 if (ev->status)
4327 return;
4328
4329 hci_dev_lock(hdev);
4330
4331 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4332 if (conn) {
4333 conn->le_conn_interval = le16_to_cpu(ev->interval);
4334 conn->le_conn_latency = le16_to_cpu(ev->latency);
4335 conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
4336 }
4337
4338 hci_dev_unlock(hdev);
4339}
4340
a4790dbd 4341/* This function requires the caller holds hdev->lock */
fd45ada9
AA		 4342static struct hci_conn *check_pending_le_conn(struct hci_dev *hdev,
4343 bdaddr_t *addr,
4344 u8 addr_type, u8 adv_type)
a4790dbd
AG		 4345{
4346 struct hci_conn *conn;
4b9e7e75 4347 struct hci_conn_params *params;
a4790dbd 4348
1c1abcab
JH		 4349 /* If the event is not connectable don't proceed further */
4350 if (adv_type != LE_ADV_IND && adv_type != LE_ADV_DIRECT_IND)
fd45ada9 4351 return NULL;
1c1abcab
JH		 4352
4353 /* Ignore if the device is blocked */
dcc36c16 4354 if (hci_bdaddr_list_lookup(&hdev->blacklist, addr, addr_type))
fd45ada9 4355 return NULL;
1c1abcab 4356
f99353cf
JH		 4357 /* Most controller will fail if we try to create new connections
4358 * while we have an existing one in slave role.
4359 */
4360 if (hdev->conn_hash.le_num_slave > 0)
fd45ada9 4361 return NULL;
f99353cf 4362
1c1abcab
JH		 4363 /* If we're not connectable only connect devices that we have in
4364 * our pend_le_conns list.
4365 */
4b9e7e75
MH		 4366 params = hci_pend_le_action_lookup(&hdev->pend_le_conns,
4367 addr, addr_type);
4368 if (!params)
fd45ada9 4369 return NULL;
4b9e7e75
MH		 4370
4371 switch (params->auto_connect) {
4372 case HCI_AUTO_CONN_DIRECT:
4373 /* Only devices advertising with ADV_DIRECT_IND are
4374 * triggering a connection attempt. This is allowing
4375 * incoming connections from slave devices.
4376 */
4377 if (adv_type != LE_ADV_DIRECT_IND)
fd45ada9 4378 return NULL;
4b9e7e75
MH		 4379 break;
4380 case HCI_AUTO_CONN_ALWAYS:
4381 /* Devices advertising with ADV_IND or ADV_DIRECT_IND
4382 * are triggering a connection attempt. This means
4383 * that incoming connectioms from slave device are
4384 * accepted and also outgoing connections to slave
4385 * devices are established when found.
4386 */
4387 break;
4388 default:
fd45ada9 4389 return NULL;
4b9e7e75 4390 }
a4790dbd
AG		 4391
4392 conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
e804d25d 4393 HCI_LE_AUTOCONN_TIMEOUT, HCI_ROLE_MASTER);
f161dd41
JH		 4394 if (!IS_ERR(conn)) {
4395 /* Store the pointer since we don't really have any
4396 * other owner of the object besides the params that
4397 * triggered it. This way we can abort the connection if
4398 * the parameters get removed and keep the reference
4399 * count consistent once the connection is established.
4400 */
f8aaf9b6 4401 params->conn = hci_conn_get(conn);
fd45ada9 4402 return conn;
f161dd41 4403 }
a4790dbd
AG		 4404
4405 switch (PTR_ERR(conn)) {
4406 case -EBUSY:
4407 /* If hci_connect() returns -EBUSY it means there is already
4408 * an LE connection attempt going on. Since controllers don't
4409 * support more than one connection attempt at the time, we
4410 * don't consider this an error case.
4411 */
4412 break;
4413 default:
4414 BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
fd45ada9 4415 return NULL;
a4790dbd 4416 }
fd45ada9
AA		 4417
4418 return NULL;
a4790dbd
AG		 4419}
4420
4af605d8
JH		 4421static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
4422 u8 bdaddr_type, s8 rssi, u8 *data, u8 len)
4423{
b9a6328f 4424 struct discovery_state *d = &hdev->discovery;
1c1abcab 4425 struct smp_irk *irk;
fd45ada9 4426 struct hci_conn *conn;
474ee066 4427 bool match;
c70a7e4c 4428 u32 flags;
b9a6328f 4429
1c1abcab
JH		 4430 /* Check if we need to convert to identity address */
4431 irk = hci_get_irk(hdev, bdaddr, bdaddr_type);
4432 if (irk) {
4433 bdaddr = &irk->bdaddr;
4434 bdaddr_type = irk->addr_type;
4435 }
4436
4437 /* Check if we have been requested to connect to this device */
fd45ada9
AA		 4438 conn = check_pending_le_conn(hdev, bdaddr, bdaddr_type, type);
4439 if (conn && type == LE_ADV_IND) {
4440 /* Store report for later inclusion by
4441 * mgmt_device_connected
4442 */
4443 memcpy(conn->le_adv_data, data, len);
4444 conn->le_adv_data_len = len;
4445 }
1c1abcab 4446
0d2bf134
JH		 4447 /* Passive scanning shouldn't trigger any device found events,
4448 * except for devices marked as CONN_REPORT for which we do send
4449 * device found events.
4450 */
ca5c4be7 4451 if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
0d2bf134
JH		 4452 if (type == LE_ADV_DIRECT_IND)
4453 return;
4454
3a19b6fe
JH		 4455 if (!hci_pend_le_action_lookup(&hdev->pend_le_reports,
4456 bdaddr, bdaddr_type))
0d2bf134
JH		 4457 return;
4458
4459 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND)
4460 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4461 else
4462 flags = 0;
4463 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
4464 rssi, flags, data, len, NULL, 0);
97bf2e99 4465 return;
ca5c4be7 4466 }
4af605d8 4467
c70a7e4c
MH		 4468 /* When receiving non-connectable or scannable undirected
4469 * advertising reports, this means that the remote device is
4470 * not connectable and then clearly indicate this in the
4471 * device found event.
4472 *
4473 * When receiving a scan response, then there is no way to
4474 * know if the remote device is connectable or not. However
4475 * since scan responses are merged with a previously seen
4476 * advertising report, the flags field from that report
4477 * will be used.
4478 *
4479 * In the really unlikely case that a controller get confused
4480 * and just sends a scan response event, then it is marked as
4481 * not connectable as well.
4482 */
4483 if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND ||
4484 type == LE_ADV_SCAN_RSP)
4485 flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
4486 else
4487 flags = 0;
4488
b9a6328f
JH		 4489 /* If there's nothing pending either store the data from this
4490 * event or send an immediate device found event if the data
4491 * should not be stored for later.
4492 */
4493 if (!has_pending_adv_report(hdev)) {
4494 /* If the report will trigger a SCAN_REQ store it for
4495 * later merging.
4496 */
4497 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4498 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
c70a7e4c 4499 rssi, flags, data, len);
b9a6328f
JH		 4500 return;
4501 }
4502
4503 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
c70a7e4c 4504 rssi, flags, data, len, NULL, 0);
b9a6328f
JH		 4505 return;
4506 }
4507
474ee066
JH		 4508 /* Check if the pending report is for the same device as the new one */
4509 match = (!bacmp(bdaddr, &d->last_adv_addr) &&
4510 bdaddr_type == d->last_adv_addr_type);
4511
b9a6328f
JH		 4512 /* If the pending data doesn't match this report or this isn't a
4513 * scan response (e.g. we got a duplicate ADV_IND) then force
4514 * sending of the pending data.
4515 */
474ee066
JH		 4516 if (type != LE_ADV_SCAN_RSP || !match) {
4517 /* Send out whatever is in the cache, but skip duplicates */
4518 if (!match)
4519 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
ff5cd29f 4520 d->last_adv_addr_type, NULL,
c70a7e4c 4521 d->last_adv_rssi, d->last_adv_flags,
ff5cd29f 4522 d->last_adv_data,
474ee066 4523 d->last_adv_data_len, NULL, 0);
b9a6328f
JH		 4524
4525 /* If the new report will trigger a SCAN_REQ store it for
4526 * later merging.
4527 */
4528 if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
4529 store_pending_adv_report(hdev, bdaddr, bdaddr_type,
c70a7e4c 4530 rssi, flags, data, len);
b9a6328f
JH		 4531 return;
4532 }
4533
4534 /* The advertising reports cannot be merged, so clear
4535 * the pending report and send out a device found event.
4536 */
4537 clear_pending_adv_report(hdev);
5c5b93e4 4538 mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
c70a7e4c 4539 rssi, flags, data, len, NULL, 0);
b9a6328f
JH		 4540 return;
4541 }
4542
4543 /* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
4544 * the new event is a SCAN_RSP. We can therefore proceed with
4545 * sending a merged device found event.
4546 */
4547 mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
c70a7e4c 4548 d->last_adv_addr_type, NULL, rssi, d->last_adv_flags,
42bd6a56 4549 d->last_adv_data, d->last_adv_data_len, data, len);
b9a6328f 4550 clear_pending_adv_report(hdev);
4af605d8
JH		 4551}
4552
6039aa73 4553static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
9aa04c91 4554{
e95beb41
AG		 4555 u8 num_reports = skb->data[0];
4556 void *ptr = &skb->data[1];
9aa04c91 4557
a4790dbd
AG		 4558 hci_dev_lock(hdev);
4559
e95beb41
AG		 4560 while (num_reports--) {
4561 struct hci_ev_le_advertising_info *ev = ptr;
4af605d8 4562 s8 rssi;
a4790dbd 4563
3c9e9195 4564 rssi = ev->data[ev->length];
4af605d8
JH		 4565 process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
4566 ev->bdaddr_type, rssi, ev->data, ev->length);
3c9e9195 4567
e95beb41 4568 ptr += sizeof(*ev) + ev->length + 1;
9aa04c91 4569 }
a4790dbd
AG		 4570
4571 hci_dev_unlock(hdev);
9aa04c91
AG		 4572}
4573
6039aa73 4574static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a7a595f6
VCG		 4575{
4576 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
4577 struct hci_cp_le_ltk_reply cp;
bea710fe 4578 struct hci_cp_le_ltk_neg_reply neg;
a7a595f6 4579 struct hci_conn *conn;
c9839a11 4580 struct smp_ltk *ltk;
a7a595f6 4581
9f1db00c 4582 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
a7a595f6
VCG		 4583
4584 hci_dev_lock(hdev);
4585
4586 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
bea710fe
VCG		 4587 if (conn == NULL)
4588 goto not_found;
a7a595f6 4589
e804d25d 4590 ltk = hci_find_ltk(hdev, ev->ediv, ev->rand, conn->role);
bea710fe
VCG		 4591 if (ltk == NULL)
4592 goto not_found;
4593
4594 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
a7a595f6 4595 cp.handle = cpu_to_le16(conn->handle);
c9839a11 4596
a6f7833c 4597 conn->pending_sec_level = smp_ltk_sec_level(ltk);
a7a595f6 4598
89cbb4da 4599 conn->enc_key_size = ltk->enc_size;
a7a595f6
VCG		 4600
4601 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
4602
5981a882
CT		 4603 /* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
4604 * temporary key used to encrypt a connection following
4605 * pairing. It is used during the Encrypted Session Setup to
4606 * distribute the keys. Later, security can be re-established
4607 * using a distributed LTK.
4608 */
2ceba539 4609 if (ltk->type == SMP_STK) {
fe59a05f 4610 set_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
970d0f1b
JH		 4611 list_del_rcu(&ltk->list);
4612 kfree_rcu(ltk, rcu);
fe59a05f
JH		 4613 } else {
4614 clear_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
c9839a11
VCG		 4615 }
4616
a7a595f6 4617 hci_dev_unlock(hdev);
bea710fe
VCG		 4618
4619 return;
4620
4621not_found:
4622 neg.handle = ev->handle;
4623 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
4624 hci_dev_unlock(hdev);
a7a595f6
VCG		 4625}
4626
8e75b46a
AG		 4627static void send_conn_param_neg_reply(struct hci_dev *hdev, u16 handle,
4628 u8 reason)
4629{
4630 struct hci_cp_le_conn_param_req_neg_reply cp;
4631
4632 cp.handle = cpu_to_le16(handle);
4633 cp.reason = reason;
4634
4635 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_NEG_REPLY, sizeof(cp),
4636 &cp);
4637}
4638
4639static void hci_le_remote_conn_param_req_evt(struct hci_dev *hdev,
4640 struct sk_buff *skb)
4641{
4642 struct hci_ev_le_remote_conn_param_req *ev = (void *) skb->data;
4643 struct hci_cp_le_conn_param_req_reply cp;
4644 struct hci_conn *hcon;
4645 u16 handle, min, max, latency, timeout;
4646
4647 handle = le16_to_cpu(ev->handle);
4648 min = le16_to_cpu(ev->interval_min);
4649 max = le16_to_cpu(ev->interval_max);
4650 latency = le16_to_cpu(ev->latency);
4651 timeout = le16_to_cpu(ev->timeout);
4652
4653 hcon = hci_conn_hash_lookup_handle(hdev, handle);
4654 if (!hcon || hcon->state != BT_CONNECTED)
4655 return send_conn_param_neg_reply(hdev, handle,
4656 HCI_ERROR_UNKNOWN_CONN_ID);
4657
4658 if (hci_check_conn_params(min, max, latency, timeout))
4659 return send_conn_param_neg_reply(hdev, handle,
4660 HCI_ERROR_INVALID_LL_PARAMS);
4661
40bef302 4662 if (hcon->role == HCI_ROLE_MASTER) {
348d50b8 4663 struct hci_conn_params *params;
f4869e2a 4664 u8 store_hint;
348d50b8
JH		 4665
4666 hci_dev_lock(hdev);
4667
4668 params = hci_conn_params_lookup(hdev, &hcon->dst,
4669 hcon->dst_type);
4670 if (params) {
4671 params->conn_min_interval = min;
4672 params->conn_max_interval = max;
4673 params->conn_latency = latency;
4674 params->supervision_timeout = timeout;
f4869e2a
JH		 4675 store_hint = 0x01;
4676 } else{
4677 store_hint = 0x00;
348d50b8
JH		 4678 }
4679
4680 hci_dev_unlock(hdev);
4681
f4869e2a
JH		 4682 mgmt_new_conn_param(hdev, &hcon->dst, hcon->dst_type,
4683 store_hint, min, max, latency, timeout);
348d50b8 4684 }
ffb5a827 4685
8e75b46a
AG		 4686 cp.handle = ev->handle;
4687 cp.interval_min = ev->interval_min;
4688 cp.interval_max = ev->interval_max;
4689 cp.latency = ev->latency;
4690 cp.timeout = ev->timeout;
4691 cp.min_ce_len = 0;
4692 cp.max_ce_len = 0;
4693
4694 hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_REPLY, sizeof(cp), &cp);
4695}
4696
6039aa73 4697static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
fcd89c09
VT		 4698{
4699 struct hci_ev_le_meta *le_ev = (void *) skb->data;
4700
4701 skb_pull(skb, sizeof(*le_ev));
4702
4703 switch (le_ev->subevent) {
4704 case HCI_EV_LE_CONN_COMPLETE:
4705 hci_le_conn_complete_evt(hdev, skb);
4706 break;
4707
1855d92d
MH		 4708 case HCI_EV_LE_CONN_UPDATE_COMPLETE:
4709 hci_le_conn_update_complete_evt(hdev, skb);
4710 break;
4711
9aa04c91
AG		 4712 case HCI_EV_LE_ADVERTISING_REPORT:
4713 hci_le_adv_report_evt(hdev, skb);
4714 break;
4715
a7a595f6
VCG		 4716 case HCI_EV_LE_LTK_REQ:
4717 hci_le_ltk_request_evt(hdev, skb);
4718 break;
4719
8e75b46a
AG		 4720 case HCI_EV_LE_REMOTE_CONN_PARAM_REQ:
4721 hci_le_remote_conn_param_req_evt(hdev, skb);
4722 break;
4723
fcd89c09
VT		 4724 default:
4725 break;
4726 }
4727}
4728
9495b2ee
AE		 4729static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
4730{
4731 struct hci_ev_channel_selected *ev = (void *) skb->data;
4732 struct hci_conn *hcon;
4733
4734 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
4735
4736 skb_pull(skb, sizeof(*ev));
4737
4738 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
4739 if (!hcon)
4740 return;
4741
4742 amp_read_loc_assoc_final_data(hdev, hcon);
4743}
4744
a9de9248
MH		 4745void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
4746{
4747 struct hci_event_hdr *hdr = (void *) skb->data;
4748 __u8 event = hdr->evt;
4749
b6ddb638
JH		 4750 hci_dev_lock(hdev);
4751
4752 /* Received events are (currently) only needed when a request is
4753 * ongoing so avoid unnecessary memory allocation.
4754 */
899de765 4755 if (hci_req_pending(hdev)) {
b6ddb638
JH		 4756 kfree_skb(hdev->recv_evt);
4757 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
4758 }
4759
4760 hci_dev_unlock(hdev);
4761
a9de9248
MH		 4762 skb_pull(skb, HCI_EVENT_HDR_SIZE);
4763
02350a72 4764 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
c1f23a2b
JB		 4765 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
4766 u16 opcode = __le16_to_cpu(cmd_hdr->opcode);
02350a72
JH		 4767
4768 hci_req_cmd_complete(hdev, opcode, 0);
4769 }
4770
a9de9248 4771 switch (event) {
1da177e4
LT		 4772 case HCI_EV_INQUIRY_COMPLETE:
4773 hci_inquiry_complete_evt(hdev, skb);
4774 break;
4775
4776 case HCI_EV_INQUIRY_RESULT:
4777 hci_inquiry_result_evt(hdev, skb);
4778 break;
4779
a9de9248
MH		 4780 case HCI_EV_CONN_COMPLETE:
4781 hci_conn_complete_evt(hdev, skb);
21d9e30e
MH		 4782 break;
4783
1da177e4
LT		 4784 case HCI_EV_CONN_REQUEST:
4785 hci_conn_request_evt(hdev, skb);
4786 break;
4787
1da177e4
LT		 4788 case HCI_EV_DISCONN_COMPLETE:
4789 hci_disconn_complete_evt(hdev, skb);
4790 break;
4791
1da177e4
LT		 4792 case HCI_EV_AUTH_COMPLETE:
4793 hci_auth_complete_evt(hdev, skb);
4794 break;
4795
a9de9248
MH		 4796 case HCI_EV_REMOTE_NAME:
4797 hci_remote_name_evt(hdev, skb);
4798 break;
4799
1da177e4
LT		 4800 case HCI_EV_ENCRYPT_CHANGE:
4801 hci_encrypt_change_evt(hdev, skb);
4802 break;
4803
a9de9248
MH		 4804 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
4805 hci_change_link_key_complete_evt(hdev, skb);
4806 break;
4807
4808 case HCI_EV_REMOTE_FEATURES:
4809 hci_remote_features_evt(hdev, skb);
4810 break;
4811
a9de9248
MH		 4812 case HCI_EV_CMD_COMPLETE:
4813 hci_cmd_complete_evt(hdev, skb);
4814 break;
4815
4816 case HCI_EV_CMD_STATUS:
4817 hci_cmd_status_evt(hdev, skb);
4818 break;
4819
24dfa343
MH		 4820 case HCI_EV_HARDWARE_ERROR:
4821 hci_hardware_error_evt(hdev, skb);
4822 break;
4823
a9de9248
MH		 4824 case HCI_EV_ROLE_CHANGE:
4825 hci_role_change_evt(hdev, skb);
4826 break;
4827
4828 case HCI_EV_NUM_COMP_PKTS:
4829 hci_num_comp_pkts_evt(hdev, skb);
4830 break;
4831
4832 case HCI_EV_MODE_CHANGE:
4833 hci_mode_change_evt(hdev, skb);
1da177e4
LT		 4834 break;
4835
4836 case HCI_EV_PIN_CODE_REQ:
4837 hci_pin_code_request_evt(hdev, skb);
4838 break;
4839
4840 case HCI_EV_LINK_KEY_REQ:
4841 hci_link_key_request_evt(hdev, skb);
4842 break;
4843
4844 case HCI_EV_LINK_KEY_NOTIFY:
4845 hci_link_key_notify_evt(hdev, skb);
4846 break;
4847
4848 case HCI_EV_CLOCK_OFFSET:
4849 hci_clock_offset_evt(hdev, skb);
4850 break;
4851
a8746417
MH		 4852 case HCI_EV_PKT_TYPE_CHANGE:
4853 hci_pkt_type_change_evt(hdev, skb);
4854 break;
4855
85a1e930
MH		 4856 case HCI_EV_PSCAN_REP_MODE:
4857 hci_pscan_rep_mode_evt(hdev, skb);
4858 break;
4859
a9de9248
MH		 4860 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
4861 hci_inquiry_result_with_rssi_evt(hdev, skb);
04837f64
MH		 4862 break;
4863
a9de9248
MH		 4864 case HCI_EV_REMOTE_EXT_FEATURES:
4865 hci_remote_ext_features_evt(hdev, skb);
1da177e4
LT		 4866 break;
4867
a9de9248
MH		 4868 case HCI_EV_SYNC_CONN_COMPLETE:
4869 hci_sync_conn_complete_evt(hdev, skb);
4870 break;
1da177e4 4871
a9de9248
MH		 4872 case HCI_EV_EXTENDED_INQUIRY_RESULT:
4873 hci_extended_inquiry_result_evt(hdev, skb);
4874 break;
1da177e4 4875
1c2e0041
JH		 4876 case HCI_EV_KEY_REFRESH_COMPLETE:
4877 hci_key_refresh_complete_evt(hdev, skb);
4878 break;
4879
0493684e
MH		 4880 case HCI_EV_IO_CAPA_REQUEST:
4881 hci_io_capa_request_evt(hdev, skb);
4882 break;
4883
03b555e1
JH		 4884 case HCI_EV_IO_CAPA_REPLY:
4885 hci_io_capa_reply_evt(hdev, skb);
4886 break;
4887
a5c29683
JH		 4888 case HCI_EV_USER_CONFIRM_REQUEST:
4889 hci_user_confirm_request_evt(hdev, skb);
4890 break;
4891
1143d458
BG		 4892 case HCI_EV_USER_PASSKEY_REQUEST:
4893 hci_user_passkey_request_evt(hdev, skb);
4894 break;
4895
92a25256
JH		 4896 case HCI_EV_USER_PASSKEY_NOTIFY:
4897 hci_user_passkey_notify_evt(hdev, skb);
4898 break;
4899
4900 case HCI_EV_KEYPRESS_NOTIFY:
4901 hci_keypress_notify_evt(hdev, skb);
4902 break;
4903
0493684e
MH		 4904 case HCI_EV_SIMPLE_PAIR_COMPLETE:
4905 hci_simple_pair_complete_evt(hdev, skb);
4906 break;
4907
41a96212
MH		 4908 case HCI_EV_REMOTE_HOST_FEATURES:
4909 hci_remote_host_features_evt(hdev, skb);
4910 break;
4911
fcd89c09
VT		 4912 case HCI_EV_LE_META:
4913 hci_le_meta_evt(hdev, skb);
4914 break;
4915
9495b2ee
AE		 4916 case HCI_EV_CHANNEL_SELECTED:
4917 hci_chan_selected_evt(hdev, skb);
4918 break;
4919
2763eda6
SJ		 4920 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
4921 hci_remote_oob_data_request_evt(hdev, skb);
4922 break;
4923
d5e91192
AE		 4924 case HCI_EV_PHY_LINK_COMPLETE:
4925 hci_phy_link_complete_evt(hdev, skb);
4926 break;
4927
27695fb4
AE		 4928 case HCI_EV_LOGICAL_LINK_COMPLETE:
4929 hci_loglink_complete_evt(hdev, skb);
4930 break;
4931
606e2a10
AE		 4932 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
4933 hci_disconn_loglink_complete_evt(hdev, skb);
4934 break;
4935
9eef6b3a
AE		 4936 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
4937 hci_disconn_phylink_complete_evt(hdev, skb);
4938 break;
4939
25e89e99
AE		 4940 case HCI_EV_NUM_COMP_BLOCKS:
4941 hci_num_comp_blocks_evt(hdev, skb);
4942 break;
4943
a9de9248 4944 default:
9f1db00c 4945 BT_DBG("%s event 0x%2.2x", hdev->name, event);
1da177e4
LT		 4946 break;
4947 }
4948
4949 kfree_skb(skb);
4950 hdev->stat.evt_rx++;
4951}
ubuntu-bionic-kernel mirror