Bluetooth: Fix mgmt error code for negative PIN response
[linux-2.6-block.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"
1da177e4 35
1da177e4
LT
36/* Handle HCI Event packets */
37
a9de9248 38static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 39{
a9de9248 40 __u8 status = *((__u8 *) skb->data);
1da177e4 41
9f1db00c 42 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 43
82f4785c 44 if (status)
a9de9248 45 return;
1da177e4 46
89352e7d 47 clear_bit(HCI_INQUIRY, &hdev->flags);
3e13fa1e
AG
48 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
49 wake_up_bit(&hdev->flags, HCI_INQUIRY);
89352e7d 50
a9de9248
MH
51 hci_conn_check_pending(hdev);
52}
6bd57416 53
4d93483b
AG
54static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
55{
56 __u8 status = *((__u8 *) skb->data);
57
9f1db00c 58 BT_DBG("%s status 0x%2.2x", hdev->name, status);
ae854a70
AG
59
60 if (status)
61 return;
62
63 set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
4d93483b
AG
64}
65
a9de9248
MH
66static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
67{
68 __u8 status = *((__u8 *) skb->data);
6bd57416 69
9f1db00c 70 BT_DBG("%s status 0x%2.2x", hdev->name, status);
6bd57416 71
a9de9248
MH
72 if (status)
73 return;
1da177e4 74
ae854a70
AG
75 clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
76
a9de9248
MH
77 hci_conn_check_pending(hdev);
78}
79
807deac2
GP
80static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
81 struct sk_buff *skb)
a9de9248
MH
82{
83 BT_DBG("%s", hdev->name);
84}
85
86static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
87{
88 struct hci_rp_role_discovery *rp = (void *) skb->data;
89 struct hci_conn *conn;
90
9f1db00c 91 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH
92
93 if (rp->status)
94 return;
95
96 hci_dev_lock(hdev);
97
98 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
99 if (conn) {
100 if (rp->role)
101 conn->link_mode &= ~HCI_LM_MASTER;
102 else
103 conn->link_mode |= HCI_LM_MASTER;
1da177e4 104 }
a9de9248
MH
105
106 hci_dev_unlock(hdev);
1da177e4
LT
107}
108
e4e8e37c
MH
109static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
110{
111 struct hci_rp_read_link_policy *rp = (void *) skb->data;
112 struct hci_conn *conn;
113
9f1db00c 114 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
e4e8e37c
MH
115
116 if (rp->status)
117 return;
118
119 hci_dev_lock(hdev);
120
121 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
122 if (conn)
123 conn->link_policy = __le16_to_cpu(rp->policy);
124
125 hci_dev_unlock(hdev);
126}
127
a9de9248 128static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 129{
a9de9248 130 struct hci_rp_write_link_policy *rp = (void *) skb->data;
1da177e4 131 struct hci_conn *conn;
04837f64 132 void *sent;
1da177e4 133
9f1db00c 134 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 135
a9de9248
MH
136 if (rp->status)
137 return;
1da177e4 138
a9de9248
MH
139 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
140 if (!sent)
141 return;
1da177e4 142
a9de9248 143 hci_dev_lock(hdev);
1da177e4 144
a9de9248 145 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
e4e8e37c 146 if (conn)
83985319 147 conn->link_policy = get_unaligned_le16(sent + 2);
1da177e4 148
a9de9248
MH
149 hci_dev_unlock(hdev);
150}
1da177e4 151
807deac2
GP
152static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
153 struct sk_buff *skb)
e4e8e37c
MH
154{
155 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
156
9f1db00c 157 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
e4e8e37c
MH
158
159 if (rp->status)
160 return;
161
162 hdev->link_policy = __le16_to_cpu(rp->policy);
163}
164
807deac2
GP
165static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
166 struct sk_buff *skb)
e4e8e37c
MH
167{
168 __u8 status = *((__u8 *) skb->data);
169 void *sent;
170
9f1db00c 171 BT_DBG("%s status 0x%2.2x", hdev->name, status);
e4e8e37c
MH
172
173 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
174 if (!sent)
175 return;
176
177 if (!status)
178 hdev->link_policy = get_unaligned_le16(sent);
e4e8e37c
MH
179}
180
a9de9248
MH
181static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
182{
183 __u8 status = *((__u8 *) skb->data);
04837f64 184
9f1db00c 185 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 186
10572132
GP
187 clear_bit(HCI_RESET, &hdev->flags);
188
a297e97c 189 /* Reset all non-persistent flags */
2cc6fb00 190 hdev->dev_flags &= ~HCI_PERSISTENT_MASK;
69775ff6
AG
191
192 hdev->discovery.state = DISCOVERY_STOPPED;
bbaf444a
JH
193 hdev->inq_tx_power = HCI_TX_POWER_INVALID;
194 hdev->adv_tx_power = HCI_TX_POWER_INVALID;
3f0f524b
JH
195
196 memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
197 hdev->adv_data_len = 0;
f8e808bd
MH
198
199 memset(hdev->scan_rsp_data, 0, sizeof(hdev->scan_rsp_data));
200 hdev->scan_rsp_data_len = 0;
06f5b778
MH
201
202 hdev->ssp_debug_mode = 0;
a9de9248 203}
04837f64 204
a9de9248
MH
205static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
206{
207 __u8 status = *((__u8 *) skb->data);
208 void *sent;
04837f64 209
9f1db00c 210 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 211
a9de9248
MH
212 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
213 if (!sent)
214 return;
04837f64 215
56e5cb86
JH
216 hci_dev_lock(hdev);
217
f51d5b24
JH
218 if (test_bit(HCI_MGMT, &hdev->dev_flags))
219 mgmt_set_local_name_complete(hdev, sent, status);
28cc7bde
JH
220 else if (!status)
221 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
f51d5b24 222
56e5cb86 223 hci_dev_unlock(hdev);
a9de9248
MH
224}
225
226static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
227{
228 struct hci_rp_read_local_name *rp = (void *) skb->data;
229
9f1db00c 230 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH
231
232 if (rp->status)
233 return;
234
db99b5fc
JH
235 if (test_bit(HCI_SETUP, &hdev->dev_flags))
236 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
a9de9248
MH
237}
238
239static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
240{
241 __u8 status = *((__u8 *) skb->data);
242 void *sent;
243
9f1db00c 244 BT_DBG("%s status 0x%2.2x", hdev->name, status);
a9de9248
MH
245
246 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
247 if (!sent)
248 return;
249
250 if (!status) {
251 __u8 param = *((__u8 *) sent);
252
253 if (param == AUTH_ENABLED)
254 set_bit(HCI_AUTH, &hdev->flags);
255 else
256 clear_bit(HCI_AUTH, &hdev->flags);
1da177e4 257 }
a9de9248 258
33ef95ed
JH
259 if (test_bit(HCI_MGMT, &hdev->dev_flags))
260 mgmt_auth_enable_complete(hdev, status);
1da177e4
LT
261}
262
a9de9248 263static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 264{
a9de9248 265 __u8 status = *((__u8 *) skb->data);
1da177e4
LT
266 void *sent;
267
9f1db00c 268 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 269
a9de9248
MH
270 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
271 if (!sent)
272 return;
1da177e4 273
a9de9248
MH
274 if (!status) {
275 __u8 param = *((__u8 *) sent);
276
277 if (param)
278 set_bit(HCI_ENCRYPT, &hdev->flags);
279 else
280 clear_bit(HCI_ENCRYPT, &hdev->flags);
281 }
a9de9248 282}
1da177e4 283
a9de9248
MH
284static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
285{
36f7fc7e
JH
286 __u8 param, status = *((__u8 *) skb->data);
287 int old_pscan, old_iscan;
a9de9248 288 void *sent;
1da177e4 289
9f1db00c 290 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 291
a9de9248
MH
292 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
293 if (!sent)
294 return;
1da177e4 295
36f7fc7e
JH
296 param = *((__u8 *) sent);
297
56e5cb86
JH
298 hci_dev_lock(hdev);
299
fa1bd918 300 if (status) {
744cf19e 301 mgmt_write_scan_failed(hdev, param, status);
2d7cee58
JH
302 hdev->discov_timeout = 0;
303 goto done;
304 }
305
0663ca2a
JH
306 /* We need to ensure that we set this back on if someone changed
307 * the scan mode through a raw HCI socket.
308 */
309 set_bit(HCI_BREDR_ENABLED, &hdev->dev_flags);
310
36f7fc7e
JH
311 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
312 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
313
314 if (param & SCAN_INQUIRY) {
315 set_bit(HCI_ISCAN, &hdev->flags);
316 if (!old_iscan)
744cf19e 317 mgmt_discoverable(hdev, 1);
36f7fc7e 318 } else if (old_iscan)
744cf19e 319 mgmt_discoverable(hdev, 0);
36f7fc7e
JH
320
321 if (param & SCAN_PAGE) {
322 set_bit(HCI_PSCAN, &hdev->flags);
323 if (!old_pscan)
744cf19e 324 mgmt_connectable(hdev, 1);
36f7fc7e 325 } else if (old_pscan)
744cf19e 326 mgmt_connectable(hdev, 0);
1da177e4 327
36f7fc7e 328done:
56e5cb86 329 hci_dev_unlock(hdev);
a9de9248 330}
1da177e4 331
a9de9248
MH
332static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
333{
334 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
1da177e4 335
9f1db00c 336 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 337
a9de9248
MH
338 if (rp->status)
339 return;
1da177e4 340
a9de9248 341 memcpy(hdev->dev_class, rp->dev_class, 3);
1da177e4 342
a9de9248 343 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
807deac2 344 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
a9de9248 345}
1da177e4 346
a9de9248
MH
347static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
348{
349 __u8 status = *((__u8 *) skb->data);
350 void *sent;
1da177e4 351
9f1db00c 352 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 353
a9de9248
MH
354 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
355 if (!sent)
356 return;
1da177e4 357
7f9a903c
MH
358 hci_dev_lock(hdev);
359
360 if (status == 0)
361 memcpy(hdev->dev_class, sent, 3);
362
363 if (test_bit(HCI_MGMT, &hdev->dev_flags))
364 mgmt_set_class_of_dev_complete(hdev, sent, status);
365
366 hci_dev_unlock(hdev);
a9de9248 367}
1da177e4 368
a9de9248
MH
369static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
370{
371 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
372 __u16 setting;
373
9f1db00c 374 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH
375
376 if (rp->status)
377 return;
378
379 setting = __le16_to_cpu(rp->voice_setting);
380
f383f275 381 if (hdev->voice_setting == setting)
a9de9248
MH
382 return;
383
384 hdev->voice_setting = setting;
385
9f1db00c 386 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
a9de9248 387
3c54711c 388 if (hdev->notify)
a9de9248 389 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
a9de9248
MH
390}
391
8fc9ced3
GP
392static void hci_cc_write_voice_setting(struct hci_dev *hdev,
393 struct sk_buff *skb)
a9de9248
MH
394{
395 __u8 status = *((__u8 *) skb->data);
f383f275 396 __u16 setting;
a9de9248
MH
397 void *sent;
398
9f1db00c 399 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 400
f383f275
MH
401 if (status)
402 return;
403
a9de9248
MH
404 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
405 if (!sent)
406 return;
1da177e4 407
f383f275 408 setting = get_unaligned_le16(sent);
1da177e4 409
f383f275
MH
410 if (hdev->voice_setting == setting)
411 return;
412
413 hdev->voice_setting = setting;
1da177e4 414
9f1db00c 415 BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
1da177e4 416
3c54711c 417 if (hdev->notify)
f383f275 418 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
1da177e4
LT
419}
420
b4cb9fb2
MH
421static void hci_cc_read_num_supported_iac(struct hci_dev *hdev,
422 struct sk_buff *skb)
423{
424 struct hci_rp_read_num_supported_iac *rp = (void *) skb->data;
425
426 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
427
428 if (rp->status)
429 return;
430
431 hdev->num_iac = rp->num_iac;
432
433 BT_DBG("%s num iac %d", hdev->name, hdev->num_iac);
434}
435
333140b5
MH
436static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
437{
438 __u8 status = *((__u8 *) skb->data);
5ed8eb2f 439 struct hci_cp_write_ssp_mode *sent;
333140b5 440
9f1db00c 441 BT_DBG("%s status 0x%2.2x", hdev->name, status);
333140b5 442
333140b5
MH
443 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
444 if (!sent)
445 return;
446
5ed8eb2f
JH
447 if (!status) {
448 if (sent->mode)
cad718ed 449 hdev->features[1][0] |= LMP_HOST_SSP;
5ed8eb2f 450 else
cad718ed 451 hdev->features[1][0] &= ~LMP_HOST_SSP;
5ed8eb2f
JH
452 }
453
ed2c4ee3 454 if (test_bit(HCI_MGMT, &hdev->dev_flags))
5ed8eb2f 455 mgmt_ssp_enable_complete(hdev, sent->mode, status);
c0ecddc2 456 else if (!status) {
5ed8eb2f 457 if (sent->mode)
c0ecddc2
JH
458 set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
459 else
460 clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
461 }
333140b5
MH
462}
463
eac83dc6
MH
464static void hci_cc_write_sc_support(struct hci_dev *hdev, struct sk_buff *skb)
465{
466 u8 status = *((u8 *) skb->data);
467 struct hci_cp_write_sc_support *sent;
468
469 BT_DBG("%s status 0x%2.2x", hdev->name, status);
470
471 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SC_SUPPORT);
472 if (!sent)
473 return;
474
475 if (!status) {
476 if (sent->support)
477 hdev->features[1][0] |= LMP_HOST_SC;
478 else
479 hdev->features[1][0] &= ~LMP_HOST_SC;
480 }
481
482 if (test_bit(HCI_MGMT, &hdev->dev_flags))
483 mgmt_sc_enable_complete(hdev, sent->support, status);
484 else if (!status) {
485 if (sent->support)
486 set_bit(HCI_SC_ENABLED, &hdev->dev_flags);
487 else
488 clear_bit(HCI_SC_ENABLED, &hdev->dev_flags);
489 }
490}
491
a9de9248
MH
492static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
493{
494 struct hci_rp_read_local_version *rp = (void *) skb->data;
1143e5a6 495
9f1db00c 496 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1143e5a6 497
a9de9248 498 if (rp->status)
42c6b129 499 return;
1143e5a6 500
0d5551f5
MH
501 if (test_bit(HCI_SETUP, &hdev->dev_flags)) {
502 hdev->hci_ver = rp->hci_ver;
503 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
504 hdev->lmp_ver = rp->lmp_ver;
505 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
506 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
507 }
d5859e22
JH
508}
509
8fc9ced3
GP
510static void hci_cc_read_local_commands(struct hci_dev *hdev,
511 struct sk_buff *skb)
a9de9248
MH
512{
513 struct hci_rp_read_local_commands *rp = (void *) skb->data;
1da177e4 514
9f1db00c 515 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 516
6a070e6e
MH
517 if (rp->status)
518 return;
519
520 if (test_bit(HCI_SETUP, &hdev->dev_flags))
2177bab5 521 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
a9de9248 522}
1da177e4 523
8fc9ced3
GP
524static void hci_cc_read_local_features(struct hci_dev *hdev,
525 struct sk_buff *skb)
a9de9248
MH
526{
527 struct hci_rp_read_local_features *rp = (void *) skb->data;
5b7f9909 528
9f1db00c 529 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 530
a9de9248
MH
531 if (rp->status)
532 return;
5b7f9909 533
a9de9248 534 memcpy(hdev->features, rp->features, 8);
5b7f9909 535
a9de9248
MH
536 /* Adjust default settings according to features
537 * supported by device. */
1da177e4 538
cad718ed 539 if (hdev->features[0][0] & LMP_3SLOT)
a9de9248 540 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
1da177e4 541
cad718ed 542 if (hdev->features[0][0] & LMP_5SLOT)
a9de9248 543 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
1da177e4 544
cad718ed 545 if (hdev->features[0][1] & LMP_HV2) {
a9de9248
MH
546 hdev->pkt_type |= (HCI_HV2);
547 hdev->esco_type |= (ESCO_HV2);
548 }
1da177e4 549
cad718ed 550 if (hdev->features[0][1] & LMP_HV3) {
a9de9248
MH
551 hdev->pkt_type |= (HCI_HV3);
552 hdev->esco_type |= (ESCO_HV3);
553 }
1da177e4 554
45db810f 555 if (lmp_esco_capable(hdev))
a9de9248 556 hdev->esco_type |= (ESCO_EV3);
da1f5198 557
cad718ed 558 if (hdev->features[0][4] & LMP_EV4)
a9de9248 559 hdev->esco_type |= (ESCO_EV4);
da1f5198 560
cad718ed 561 if (hdev->features[0][4] & LMP_EV5)
a9de9248 562 hdev->esco_type |= (ESCO_EV5);
1da177e4 563
cad718ed 564 if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
efc7688b
MH
565 hdev->esco_type |= (ESCO_2EV3);
566
cad718ed 567 if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
efc7688b
MH
568 hdev->esco_type |= (ESCO_3EV3);
569
cad718ed 570 if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
efc7688b 571 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
a9de9248 572}
1da177e4 573
971e3a4b 574static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
807deac2 575 struct sk_buff *skb)
971e3a4b
AG
576{
577 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
578
9f1db00c 579 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
971e3a4b
AG
580
581 if (rp->status)
42c6b129 582 return;
971e3a4b 583
57af75a8
MH
584 if (hdev->max_page < rp->max_page)
585 hdev->max_page = rp->max_page;
d2c5d77f 586
cad718ed
JH
587 if (rp->page < HCI_MAX_PAGES)
588 memcpy(hdev->features[rp->page], rp->features, 8);
971e3a4b
AG
589}
590
1e89cffb 591static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
807deac2 592 struct sk_buff *skb)
1e89cffb
AE
593{
594 struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;
595
9f1db00c 596 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1e89cffb 597
42c6b129
JH
598 if (!rp->status)
599 hdev->flow_ctl_mode = rp->mode;
1e89cffb
AE
600}
601
a9de9248
MH
602static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
603{
604 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
1da177e4 605
9f1db00c 606 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1da177e4 607
a9de9248
MH
608 if (rp->status)
609 return;
1da177e4 610
a9de9248
MH
611 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
612 hdev->sco_mtu = rp->sco_mtu;
613 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
614 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
615
616 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
617 hdev->sco_mtu = 64;
618 hdev->sco_pkts = 8;
1da177e4 619 }
a9de9248
MH
620
621 hdev->acl_cnt = hdev->acl_pkts;
622 hdev->sco_cnt = hdev->sco_pkts;
623
807deac2
GP
624 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
625 hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
a9de9248
MH
626}
627
628static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
629{
630 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
631
9f1db00c 632 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a9de9248
MH
633
634 if (!rp->status)
635 bacpy(&hdev->bdaddr, &rp->bdaddr);
23bb5763
JH
636}
637
f332ec66
JH
638static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
639 struct sk_buff *skb)
640{
641 struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;
642
643 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
644
645 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status) {
646 hdev->page_scan_interval = __le16_to_cpu(rp->interval);
647 hdev->page_scan_window = __le16_to_cpu(rp->window);
648 }
649}
650
4a3ee763
JH
651static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
652 struct sk_buff *skb)
653{
654 u8 status = *((u8 *) skb->data);
655 struct hci_cp_write_page_scan_activity *sent;
656
657 BT_DBG("%s status 0x%2.2x", hdev->name, status);
658
659 if (status)
660 return;
661
662 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
663 if (!sent)
664 return;
665
666 hdev->page_scan_interval = __le16_to_cpu(sent->interval);
667 hdev->page_scan_window = __le16_to_cpu(sent->window);
668}
669
f332ec66
JH
670static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
671 struct sk_buff *skb)
672{
673 struct hci_rp_read_page_scan_type *rp = (void *) skb->data;
674
675 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
676
677 if (test_bit(HCI_INIT, &hdev->flags) && !rp->status)
678 hdev->page_scan_type = rp->type;
679}
680
4a3ee763
JH
681static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
682 struct sk_buff *skb)
683{
684 u8 status = *((u8 *) skb->data);
685 u8 *type;
686
687 BT_DBG("%s status 0x%2.2x", hdev->name, status);
688
689 if (status)
690 return;
691
692 type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
693 if (type)
694 hdev->page_scan_type = *type;
695}
696
350ee4cf 697static void hci_cc_read_data_block_size(struct hci_dev *hdev,
807deac2 698 struct sk_buff *skb)
350ee4cf
AE
699{
700 struct hci_rp_read_data_block_size *rp = (void *) skb->data;
701
9f1db00c 702 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
350ee4cf
AE
703
704 if (rp->status)
705 return;
706
707 hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
708 hdev->block_len = __le16_to_cpu(rp->block_len);
709 hdev->num_blocks = __le16_to_cpu(rp->num_blocks);
710
711 hdev->block_cnt = hdev->num_blocks;
712
713 BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
807deac2 714 hdev->block_cnt, hdev->block_len);
350ee4cf
AE
715}
716
928abaa7 717static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
807deac2 718 struct sk_buff *skb)
928abaa7
AE
719{
720 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
721
9f1db00c 722 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
928abaa7
AE
723
724 if (rp->status)
8e2a0d92 725 goto a2mp_rsp;
928abaa7
AE
726
727 hdev->amp_status = rp->amp_status;
728 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
729 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
730 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
731 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
732 hdev->amp_type = rp->amp_type;
733 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
734 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
735 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
736 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
737
8e2a0d92
AE
738a2mp_rsp:
739 a2mp_send_getinfo_rsp(hdev);
928abaa7
AE
740}
741
903e4541
AE
742static void hci_cc_read_local_amp_assoc(struct hci_dev *hdev,
743 struct sk_buff *skb)
744{
745 struct hci_rp_read_local_amp_assoc *rp = (void *) skb->data;
746 struct amp_assoc *assoc = &hdev->loc_assoc;
747 size_t rem_len, frag_len;
748
749 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
750
751 if (rp->status)
752 goto a2mp_rsp;
753
754 frag_len = skb->len - sizeof(*rp);
755 rem_len = __le16_to_cpu(rp->rem_len);
756
757 if (rem_len > frag_len) {
2e430be3 758 BT_DBG("frag_len %zu rem_len %zu", frag_len, rem_len);
903e4541
AE
759
760 memcpy(assoc->data + assoc->offset, rp->frag, frag_len);
761 assoc->offset += frag_len;
762
763 /* Read other fragments */
764 amp_read_loc_assoc_frag(hdev, rp->phy_handle);
765
766 return;
767 }
768
769 memcpy(assoc->data + assoc->offset, rp->frag, rem_len);
770 assoc->len = assoc->offset + rem_len;
771 assoc->offset = 0;
772
773a2mp_rsp:
774 /* Send A2MP Rsp when all fragments are received */
775 a2mp_send_getampassoc_rsp(hdev, rp->status);
9495b2ee 776 a2mp_send_create_phy_link_req(hdev, rp->status);
903e4541
AE
777}
778
d5859e22 779static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
807deac2 780 struct sk_buff *skb)
d5859e22 781{
91c4e9b1 782 struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
d5859e22 783
9f1db00c 784 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
91c4e9b1
MH
785
786 if (!rp->status)
787 hdev->inq_tx_power = rp->tx_power;
d5859e22
JH
788}
789
980e1a53
JH
790static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
791{
792 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
793 struct hci_cp_pin_code_reply *cp;
794 struct hci_conn *conn;
795
9f1db00c 796 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
980e1a53 797
56e5cb86
JH
798 hci_dev_lock(hdev);
799
a8b2d5c2 800 if (test_bit(HCI_MGMT, &hdev->dev_flags))
744cf19e 801 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
980e1a53 802
fa1bd918 803 if (rp->status)
56e5cb86 804 goto unlock;
980e1a53
JH
805
806 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
807 if (!cp)
56e5cb86 808 goto unlock;
980e1a53
JH
809
810 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
811 if (conn)
812 conn->pin_length = cp->pin_len;
56e5cb86
JH
813
814unlock:
815 hci_dev_unlock(hdev);
980e1a53
JH
816}
817
818static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
819{
820 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
821
9f1db00c 822 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
980e1a53 823
56e5cb86
JH
824 hci_dev_lock(hdev);
825
a8b2d5c2 826 if (test_bit(HCI_MGMT, &hdev->dev_flags))
744cf19e 827 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
807deac2 828 rp->status);
56e5cb86
JH
829
830 hci_dev_unlock(hdev);
980e1a53 831}
56e5cb86 832
6ed58ec5
VT
833static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
834 struct sk_buff *skb)
835{
836 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
837
9f1db00c 838 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
6ed58ec5
VT
839
840 if (rp->status)
841 return;
842
843 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
844 hdev->le_pkts = rp->le_max_pkt;
845
846 hdev->le_cnt = hdev->le_pkts;
847
848 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
6ed58ec5 849}
980e1a53 850
60e77321
JH
851static void hci_cc_le_read_local_features(struct hci_dev *hdev,
852 struct sk_buff *skb)
853{
854 struct hci_rp_le_read_local_features *rp = (void *) skb->data;
855
856 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
857
858 if (!rp->status)
859 memcpy(hdev->le_features, rp->features, 8);
60e77321
JH
860}
861
8fa19098
JH
862static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
863 struct sk_buff *skb)
864{
865 struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;
866
867 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
868
04b4edcb 869 if (!rp->status)
8fa19098 870 hdev->adv_tx_power = rp->tx_power;
8fa19098
JH
871}
872
a5c29683
JH
873static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
874{
875 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
876
9f1db00c 877 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a5c29683 878
56e5cb86
JH
879 hci_dev_lock(hdev);
880
a8b2d5c2 881 if (test_bit(HCI_MGMT, &hdev->dev_flags))
04124681
GP
882 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
883 rp->status);
56e5cb86
JH
884
885 hci_dev_unlock(hdev);
a5c29683
JH
886}
887
888static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
807deac2 889 struct sk_buff *skb)
a5c29683
JH
890{
891 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
892
9f1db00c 893 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
a5c29683 894
56e5cb86
JH
895 hci_dev_lock(hdev);
896
a8b2d5c2 897 if (test_bit(HCI_MGMT, &hdev->dev_flags))
744cf19e 898 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
04124681 899 ACL_LINK, 0, rp->status);
56e5cb86
JH
900
901 hci_dev_unlock(hdev);
a5c29683
JH
902}
903
1143d458
BG
904static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
905{
906 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
907
9f1db00c 908 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1143d458
BG
909
910 hci_dev_lock(hdev);
911
a8b2d5c2 912 if (test_bit(HCI_MGMT, &hdev->dev_flags))
272d90df 913 mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
04124681 914 0, rp->status);
1143d458
BG
915
916 hci_dev_unlock(hdev);
917}
918
919static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
807deac2 920 struct sk_buff *skb)
1143d458
BG
921{
922 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
923
9f1db00c 924 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1143d458
BG
925
926 hci_dev_lock(hdev);
927
a8b2d5c2 928 if (test_bit(HCI_MGMT, &hdev->dev_flags))
1143d458 929 mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
04124681 930 ACL_LINK, 0, rp->status);
1143d458
BG
931
932 hci_dev_unlock(hdev);
933}
934
4d2d2796
MH
935static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
936 struct sk_buff *skb)
c35938b2
SJ
937{
938 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
939
9f1db00c 940 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
c35938b2 941
56e5cb86 942 hci_dev_lock(hdev);
4d2d2796
MH
943 mgmt_read_local_oob_data_complete(hdev, rp->hash, rp->randomizer,
944 NULL, NULL, rp->status);
945 hci_dev_unlock(hdev);
946}
947
948static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
949 struct sk_buff *skb)
950{
951 struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;
952
953 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
954
955 hci_dev_lock(hdev);
956 mgmt_read_local_oob_data_complete(hdev, rp->hash192, rp->randomizer192,
957 rp->hash256, rp->randomizer256,
958 rp->status);
56e5cb86 959 hci_dev_unlock(hdev);
c35938b2
SJ
960}
961
c1d5dc4a
JH
962static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
963{
964 __u8 *sent, status = *((__u8 *) skb->data);
965
966 BT_DBG("%s status 0x%2.2x", hdev->name, status);
967
968 sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
969 if (!sent)
970 return;
971
972 hci_dev_lock(hdev);
973
974 if (!status) {
975 if (*sent)
f3d3444a 976 set_bit(HCI_ADVERTISING, &hdev->dev_flags);
c1d5dc4a 977 else
f3d3444a 978 clear_bit(HCI_ADVERTISING, &hdev->dev_flags);
c1d5dc4a
JH
979 }
980
04b4edcb 981 hci_dev_unlock(hdev);
c1d5dc4a
JH
982}
983
eb9d91f5 984static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
807deac2 985 struct sk_buff *skb)
eb9d91f5
AG
986{
987 struct hci_cp_le_set_scan_enable *cp;
988 __u8 status = *((__u8 *) skb->data);
989
9f1db00c 990 BT_DBG("%s status 0x%2.2x", hdev->name, status);
eb9d91f5 991
eb9d91f5
AG
992 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
993 if (!cp)
994 return;
995
3fd319b8
AG
996 if (status)
997 return;
998
68a8aea4 999 switch (cp->enable) {
76a388be 1000 case LE_SCAN_ENABLE:
d23264a8 1001 set_bit(HCI_LE_SCAN, &hdev->dev_flags);
68a8aea4
AE
1002 break;
1003
76a388be 1004 case LE_SCAN_DISABLE:
d23264a8 1005 clear_bit(HCI_LE_SCAN, &hdev->dev_flags);
68a8aea4
AE
1006 break;
1007
1008 default:
1009 BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
1010 break;
35815085 1011 }
eb9d91f5
AG
1012}
1013
cf1d081f
JH
1014static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
1015 struct sk_buff *skb)
1016{
1017 struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;
1018
1019 BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);
1020
1021 if (!rp->status)
1022 hdev->le_white_list_size = rp->size;
cf1d081f
JH
1023}
1024
9b008c04
JH
1025static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
1026 struct sk_buff *skb)
1027{
1028 struct hci_rp_le_read_supported_states *rp = (void *) skb->data;
1029
1030 BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1031
1032 if (!rp->status)
1033 memcpy(hdev->le_states, rp->le_states, 8);
9b008c04
JH
1034}
1035
6039aa73
GP
1036static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
1037 struct sk_buff *skb)
f9b49306 1038{
06199cf8 1039 struct hci_cp_write_le_host_supported *sent;
f9b49306
AG
1040 __u8 status = *((__u8 *) skb->data);
1041
9f1db00c 1042 BT_DBG("%s status 0x%2.2x", hdev->name, status);
f9b49306 1043
06199cf8 1044 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
8f984dfa 1045 if (!sent)
f9b49306
AG
1046 return;
1047
8f984dfa 1048 if (!status) {
416a4ae5 1049 if (sent->le) {
cad718ed 1050 hdev->features[1][0] |= LMP_HOST_LE;
416a4ae5
JH
1051 set_bit(HCI_LE_ENABLED, &hdev->dev_flags);
1052 } else {
cad718ed 1053 hdev->features[1][0] &= ~LMP_HOST_LE;
416a4ae5 1054 clear_bit(HCI_LE_ENABLED, &hdev->dev_flags);
f3d3444a 1055 clear_bit(HCI_ADVERTISING, &hdev->dev_flags);
416a4ae5 1056 }
53b2caab
JH
1057
1058 if (sent->simul)
cad718ed 1059 hdev->features[1][0] |= LMP_HOST_LE_BREDR;
53b2caab 1060 else
cad718ed 1061 hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
8f984dfa 1062 }
f9b49306
AG
1063}
1064
93c284ee
AE
1065static void hci_cc_write_remote_amp_assoc(struct hci_dev *hdev,
1066 struct sk_buff *skb)
1067{
1068 struct hci_rp_write_remote_amp_assoc *rp = (void *) skb->data;
1069
1070 BT_DBG("%s status 0x%2.2x phy_handle 0x%2.2x",
1071 hdev->name, rp->status, rp->phy_handle);
1072
1073 if (rp->status)
1074 return;
1075
1076 amp_write_rem_assoc_continue(hdev, rp->phy_handle);
1077}
1078
6039aa73 1079static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
a9de9248 1080{
9f1db00c 1081 BT_DBG("%s status 0x%2.2x", hdev->name, status);
a9de9248
MH
1082
1083 if (status) {
a9de9248 1084 hci_conn_check_pending(hdev);
314b2381
JH
1085 return;
1086 }
1087
89352e7d 1088 set_bit(HCI_INQUIRY, &hdev->flags);
1da177e4
LT
1089}
1090
6039aa73 1091static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
1da177e4 1092{
a9de9248 1093 struct hci_cp_create_conn *cp;
1da177e4 1094 struct hci_conn *conn;
1da177e4 1095
9f1db00c 1096 BT_DBG("%s status 0x%2.2x", hdev->name, status);
a9de9248
MH
1097
1098 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
1da177e4
LT
1099 if (!cp)
1100 return;
1101
1102 hci_dev_lock(hdev);
1103
1104 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1105
6ed93dc6 1106 BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
1da177e4
LT
1107
1108 if (status) {
1109 if (conn && conn->state == BT_CONNECT) {
4c67bc74
MH
1110 if (status != 0x0c || conn->attempt > 2) {
1111 conn->state = BT_CLOSED;
1112 hci_proto_connect_cfm(conn, status);
1113 hci_conn_del(conn);
1114 } else
1115 conn->state = BT_CONNECT2;
1da177e4
LT
1116 }
1117 } else {
1118 if (!conn) {
1119 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1120 if (conn) {
a0c808b3 1121 conn->out = true;
1da177e4
LT
1122 conn->link_mode |= HCI_LM_MASTER;
1123 } else
893ef971 1124 BT_ERR("No memory for new connection");
1da177e4
LT
1125 }
1126 }
1127
1128 hci_dev_unlock(hdev);
1129}
1130
a9de9248 1131static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
1da177e4 1132{
a9de9248
MH
1133 struct hci_cp_add_sco *cp;
1134 struct hci_conn *acl, *sco;
1135 __u16 handle;
1da177e4 1136
9f1db00c 1137 BT_DBG("%s status 0x%2.2x", hdev->name, status);
b6a0dc82 1138
a9de9248
MH
1139 if (!status)
1140 return;
1da177e4 1141
a9de9248
MH
1142 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1143 if (!cp)
1144 return;
1da177e4 1145
a9de9248 1146 handle = __le16_to_cpu(cp->handle);
1da177e4 1147
9f1db00c 1148 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
1da177e4 1149
a9de9248 1150 hci_dev_lock(hdev);
1da177e4 1151
a9de9248 1152 acl = hci_conn_hash_lookup_handle(hdev, handle);
5a08ecce
AE
1153 if (acl) {
1154 sco = acl->link;
1155 if (sco) {
1156 sco->state = BT_CLOSED;
1da177e4 1157
5a08ecce
AE
1158 hci_proto_connect_cfm(sco, status);
1159 hci_conn_del(sco);
1160 }
a9de9248 1161 }
1da177e4 1162
a9de9248
MH
1163 hci_dev_unlock(hdev);
1164}
1da177e4 1165
f8558555
MH
1166static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1167{
1168 struct hci_cp_auth_requested *cp;
1169 struct hci_conn *conn;
1170
9f1db00c 1171 BT_DBG("%s status 0x%2.2x", hdev->name, status);
f8558555
MH
1172
1173 if (!status)
1174 return;
1175
1176 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1177 if (!cp)
1178 return;
1179
1180 hci_dev_lock(hdev);
1181
1182 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1183 if (conn) {
1184 if (conn->state == BT_CONFIG) {
1185 hci_proto_connect_cfm(conn, status);
76a68ba0 1186 hci_conn_drop(conn);
f8558555
MH
1187 }
1188 }
1189
1190 hci_dev_unlock(hdev);
1191}
1192
1193static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1194{
1195 struct hci_cp_set_conn_encrypt *cp;
1196 struct hci_conn *conn;
1197
9f1db00c 1198 BT_DBG("%s status 0x%2.2x", hdev->name, status);
f8558555
MH
1199
1200 if (!status)
1201 return;
1202
1203 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1204 if (!cp)
1205 return;
1206
1207 hci_dev_lock(hdev);
1208
1209 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1210 if (conn) {
1211 if (conn->state == BT_CONFIG) {
1212 hci_proto_connect_cfm(conn, status);
76a68ba0 1213 hci_conn_drop(conn);
f8558555
MH
1214 }
1215 }
1216
1217 hci_dev_unlock(hdev);
1218}
1219
127178d2 1220static int hci_outgoing_auth_needed(struct hci_dev *hdev,
807deac2 1221 struct hci_conn *conn)
392599b9 1222{
392599b9
JH
1223 if (conn->state != BT_CONFIG || !conn->out)
1224 return 0;
1225
765c2a96 1226 if (conn->pending_sec_level == BT_SECURITY_SDP)
392599b9
JH
1227 return 0;
1228
1229 /* Only request authentication for SSP connections or non-SSP
264b8b4e
JH
1230 * devices with sec_level MEDIUM or HIGH or if MITM protection
1231 * is requested.
1232 */
807deac2 1233 if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
264b8b4e
JH
1234 conn->pending_sec_level != BT_SECURITY_HIGH &&
1235 conn->pending_sec_level != BT_SECURITY_MEDIUM)
392599b9
JH
1236 return 0;
1237
392599b9
JH
1238 return 1;
1239}
1240
6039aa73 1241static int hci_resolve_name(struct hci_dev *hdev,
04124681 1242 struct inquiry_entry *e)
30dc78e1
JH
1243{
1244 struct hci_cp_remote_name_req cp;
1245
1246 memset(&cp, 0, sizeof(cp));
1247
1248 bacpy(&cp.bdaddr, &e->data.bdaddr);
1249 cp.pscan_rep_mode = e->data.pscan_rep_mode;
1250 cp.pscan_mode = e->data.pscan_mode;
1251 cp.clock_offset = e->data.clock_offset;
1252
1253 return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1254}
1255
b644ba33 1256static bool hci_resolve_next_name(struct hci_dev *hdev)
30dc78e1
JH
1257{
1258 struct discovery_state *discov = &hdev->discovery;
1259 struct inquiry_entry *e;
1260
b644ba33
JH
1261 if (list_empty(&discov->resolve))
1262 return false;
1263
1264 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
c810089c
RM
1265 if (!e)
1266 return false;
1267
b644ba33
JH
1268 if (hci_resolve_name(hdev, e) == 0) {
1269 e->name_state = NAME_PENDING;
1270 return true;
1271 }
1272
1273 return false;
1274}
1275
1276static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
04124681 1277 bdaddr_t *bdaddr, u8 *name, u8 name_len)
b644ba33
JH
1278{
1279 struct discovery_state *discov = &hdev->discovery;
1280 struct inquiry_entry *e;
1281
1282 if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
04124681
GP
1283 mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
1284 name_len, conn->dev_class);
b644ba33
JH
1285
1286 if (discov->state == DISCOVERY_STOPPED)
1287 return;
1288
30dc78e1
JH
1289 if (discov->state == DISCOVERY_STOPPING)
1290 goto discov_complete;
1291
1292 if (discov->state != DISCOVERY_RESOLVING)
1293 return;
1294
1295 e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
7cc8380e
RM
1296 /* If the device was not found in a list of found devices names of which
1297 * are pending. there is no need to continue resolving a next name as it
1298 * will be done upon receiving another Remote Name Request Complete
1299 * Event */
1300 if (!e)
1301 return;
1302
1303 list_del(&e->list);
1304 if (name) {
30dc78e1 1305 e->name_state = NAME_KNOWN;
7cc8380e
RM
1306 mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
1307 e->data.rssi, name, name_len);
c3e7c0d9
RM
1308 } else {
1309 e->name_state = NAME_NOT_KNOWN;
30dc78e1
JH
1310 }
1311
b644ba33 1312 if (hci_resolve_next_name(hdev))
30dc78e1 1313 return;
30dc78e1
JH
1314
1315discov_complete:
1316 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1317}
1318
a9de9248
MH
1319static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1320{
127178d2
JH
1321 struct hci_cp_remote_name_req *cp;
1322 struct hci_conn *conn;
1323
9f1db00c 1324 BT_DBG("%s status 0x%2.2x", hdev->name, status);
127178d2
JH
1325
1326 /* If successful wait for the name req complete event before
1327 * checking for the need to do authentication */
1328 if (!status)
1329 return;
1330
1331 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1332 if (!cp)
1333 return;
1334
1335 hci_dev_lock(hdev);
1336
b644ba33
JH
1337 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1338
a8b2d5c2 1339 if (test_bit(HCI_MGMT, &hdev->dev_flags))
b644ba33 1340 hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
30dc78e1 1341
79c6c70c
JH
1342 if (!conn)
1343 goto unlock;
1344
1345 if (!hci_outgoing_auth_needed(hdev, conn))
1346 goto unlock;
1347
51a8efd7 1348 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
c1f23a2b
JB
1349 struct hci_cp_auth_requested auth_cp;
1350
1351 auth_cp.handle = __cpu_to_le16(conn->handle);
1352 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1353 sizeof(auth_cp), &auth_cp);
127178d2
JH
1354 }
1355
79c6c70c 1356unlock:
127178d2 1357 hci_dev_unlock(hdev);
a9de9248 1358}
1da177e4 1359
769be974
MH
1360static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1361{
1362 struct hci_cp_read_remote_features *cp;
1363 struct hci_conn *conn;
1364
9f1db00c 1365 BT_DBG("%s status 0x%2.2x", hdev->name, status);
769be974
MH
1366
1367 if (!status)
1368 return;
1369
1370 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1371 if (!cp)
1372 return;
1373
1374 hci_dev_lock(hdev);
1375
1376 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1377 if (conn) {
1378 if (conn->state == BT_CONFIG) {
769be974 1379 hci_proto_connect_cfm(conn, status);
76a68ba0 1380 hci_conn_drop(conn);
769be974
MH
1381 }
1382 }
1383
1384 hci_dev_unlock(hdev);
1385}
1386
1387static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1388{
1389 struct hci_cp_read_remote_ext_features *cp;
1390 struct hci_conn *conn;
1391
9f1db00c 1392 BT_DBG("%s status 0x%2.2x", hdev->name, status);
769be974
MH
1393
1394 if (!status)
1395 return;
1396
1397 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1398 if (!cp)
1399 return;
1400
1401 hci_dev_lock(hdev);
1402
1403 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1404 if (conn) {
1405 if (conn->state == BT_CONFIG) {
769be974 1406 hci_proto_connect_cfm(conn, status);
76a68ba0 1407 hci_conn_drop(conn);
769be974
MH
1408 }
1409 }
1410
1411 hci_dev_unlock(hdev);
1412}
1413
a9de9248
MH
1414static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1415{
b6a0dc82
MH
1416 struct hci_cp_setup_sync_conn *cp;
1417 struct hci_conn *acl, *sco;
1418 __u16 handle;
1419
9f1db00c 1420 BT_DBG("%s status 0x%2.2x", hdev->name, status);
b6a0dc82
MH
1421
1422 if (!status)
1423 return;
1424
1425 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1426 if (!cp)
1427 return;
1428
1429 handle = __le16_to_cpu(cp->handle);
1430
9f1db00c 1431 BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
b6a0dc82
MH
1432
1433 hci_dev_lock(hdev);
1434
1435 acl = hci_conn_hash_lookup_handle(hdev, handle);
5a08ecce
AE
1436 if (acl) {
1437 sco = acl->link;
1438 if (sco) {
1439 sco->state = BT_CLOSED;
b6a0dc82 1440
5a08ecce
AE
1441 hci_proto_connect_cfm(sco, status);
1442 hci_conn_del(sco);
1443 }
b6a0dc82
MH
1444 }
1445
1446 hci_dev_unlock(hdev);
1da177e4
LT
1447}
1448
a9de9248 1449static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1da177e4 1450{
a9de9248
MH
1451 struct hci_cp_sniff_mode *cp;
1452 struct hci_conn *conn;
1da177e4 1453
9f1db00c 1454 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 1455
a9de9248
MH
1456 if (!status)
1457 return;
04837f64 1458
a9de9248
MH
1459 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1460 if (!cp)
1461 return;
04837f64 1462
a9de9248 1463 hci_dev_lock(hdev);
04837f64 1464
a9de9248 1465 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
e73439d8 1466 if (conn) {
51a8efd7 1467 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
04837f64 1468
51a8efd7 1469 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
e73439d8
MH
1470 hci_sco_setup(conn, status);
1471 }
1472
a9de9248
MH
1473 hci_dev_unlock(hdev);
1474}
04837f64 1475
a9de9248
MH
1476static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1477{
1478 struct hci_cp_exit_sniff_mode *cp;
1479 struct hci_conn *conn;
04837f64 1480
9f1db00c 1481 BT_DBG("%s status 0x%2.2x", hdev->name, status);
04837f64 1482
a9de9248
MH
1483 if (!status)
1484 return;
04837f64 1485
a9de9248
MH
1486 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1487 if (!cp)
1488 return;
04837f64 1489
a9de9248 1490 hci_dev_lock(hdev);
1da177e4 1491
a9de9248 1492 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
e73439d8 1493 if (conn) {
51a8efd7 1494 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
1da177e4 1495
51a8efd7 1496 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
e73439d8
MH
1497 hci_sco_setup(conn, status);
1498 }
1499
a9de9248 1500 hci_dev_unlock(hdev);
1da177e4
LT
1501}
1502
88c3df13
JH
1503static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
1504{
1505 struct hci_cp_disconnect *cp;
1506 struct hci_conn *conn;
1507
1508 if (!status)
1509 return;
1510
1511 cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
1512 if (!cp)
1513 return;
1514
1515 hci_dev_lock(hdev);
1516
1517 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1518 if (conn)
1519 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
04124681 1520 conn->dst_type, status);
88c3df13
JH
1521
1522 hci_dev_unlock(hdev);
1523}
1524
a02226d6
AE
1525static void hci_cs_create_phylink(struct hci_dev *hdev, u8 status)
1526{
93c284ee
AE
1527 struct hci_cp_create_phy_link *cp;
1528
a02226d6 1529 BT_DBG("%s status 0x%2.2x", hdev->name, status);
93c284ee 1530
93c284ee
AE
1531 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_PHY_LINK);
1532 if (!cp)
1533 return;
1534
e58917b9
AE
1535 hci_dev_lock(hdev);
1536
1537 if (status) {
1538 struct hci_conn *hcon;
1539
1540 hcon = hci_conn_hash_lookup_handle(hdev, cp->phy_handle);
1541 if (hcon)
1542 hci_conn_del(hcon);
1543 } else {
1544 amp_write_remote_assoc(hdev, cp->phy_handle);
1545 }
1546
1547 hci_dev_unlock(hdev);
a02226d6
AE
1548}
1549
0b26ab9d
AE
1550static void hci_cs_accept_phylink(struct hci_dev *hdev, u8 status)
1551{
1552 struct hci_cp_accept_phy_link *cp;
1553
1554 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1555
1556 if (status)
1557 return;
1558
1559 cp = hci_sent_cmd_data(hdev, HCI_OP_ACCEPT_PHY_LINK);
1560 if (!cp)
1561 return;
1562
1563 amp_write_remote_assoc(hdev, cp->phy_handle);
1564}
1565
6039aa73 1566static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4
LT
1567{
1568 __u8 status = *((__u8 *) skb->data);
30dc78e1
JH
1569 struct discovery_state *discov = &hdev->discovery;
1570 struct inquiry_entry *e;
1da177e4 1571
9f1db00c 1572 BT_DBG("%s status 0x%2.2x", hdev->name, status);
1da177e4 1573
a9de9248 1574 hci_conn_check_pending(hdev);
89352e7d
AG
1575
1576 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1577 return;
1578
3e13fa1e
AG
1579 smp_mb__after_clear_bit(); /* wake_up_bit advises about this barrier */
1580 wake_up_bit(&hdev->flags, HCI_INQUIRY);
1581
a8b2d5c2 1582 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
30dc78e1
JH
1583 return;
1584
56e5cb86 1585 hci_dev_lock(hdev);
30dc78e1 1586
343f935b 1587 if (discov->state != DISCOVERY_FINDING)
30dc78e1
JH
1588 goto unlock;
1589
1590 if (list_empty(&discov->resolve)) {
1591 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1592 goto unlock;
1593 }
1594
1595 e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1596 if (e && hci_resolve_name(hdev, e) == 0) {
1597 e->name_state = NAME_PENDING;
1598 hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
1599 } else {
1600 hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1601 }
1602
1603unlock:
56e5cb86 1604 hci_dev_unlock(hdev);
1da177e4
LT
1605}
1606
6039aa73 1607static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1608{
45bb4bf0 1609 struct inquiry_data data;
a9de9248 1610 struct inquiry_info *info = (void *) (skb->data + 1);
1da177e4
LT
1611 int num_rsp = *((__u8 *) skb->data);
1612
1613 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1614
45bb4bf0
MH
1615 if (!num_rsp)
1616 return;
1617
1519cc17
AG
1618 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
1619 return;
1620
1da177e4 1621 hci_dev_lock(hdev);
45bb4bf0 1622
e17acd40 1623 for (; num_rsp; num_rsp--, info++) {
388fc8fa 1624 bool name_known, ssp;
3175405b 1625
1da177e4
LT
1626 bacpy(&data.bdaddr, &info->bdaddr);
1627 data.pscan_rep_mode = info->pscan_rep_mode;
1628 data.pscan_period_mode = info->pscan_period_mode;
1629 data.pscan_mode = info->pscan_mode;
1630 memcpy(data.dev_class, info->dev_class, 3);
1631 data.clock_offset = info->clock_offset;
1632 data.rssi = 0x00;
41a96212 1633 data.ssp_mode = 0x00;
3175405b 1634
388fc8fa 1635 name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
48264f06 1636 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681
GP
1637 info->dev_class, 0, !name_known, ssp, NULL,
1638 0);
1da177e4 1639 }
45bb4bf0 1640
1da177e4
LT
1641 hci_dev_unlock(hdev);
1642}
1643
6039aa73 1644static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1645{
a9de9248
MH
1646 struct hci_ev_conn_complete *ev = (void *) skb->data;
1647 struct hci_conn *conn;
1da177e4
LT
1648
1649 BT_DBG("%s", hdev->name);
1650
1651 hci_dev_lock(hdev);
1652
1653 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9499237a
MH
1654 if (!conn) {
1655 if (ev->link_type != SCO_LINK)
1656 goto unlock;
1657
1658 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1659 if (!conn)
1660 goto unlock;
1661
1662 conn->type = SCO_LINK;
1663 }
1da177e4
LT
1664
1665 if (!ev->status) {
1666 conn->handle = __le16_to_cpu(ev->handle);
769be974
MH
1667
1668 if (conn->type == ACL_LINK) {
1669 conn->state = BT_CONFIG;
1670 hci_conn_hold(conn);
a9ea3ed9
SJ
1671
1672 if (!conn->out && !hci_conn_ssp_enabled(conn) &&
1673 !hci_find_link_key(hdev, &ev->bdaddr))
1674 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1675 else
1676 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
769be974
MH
1677 } else
1678 conn->state = BT_CONNECTED;
1da177e4 1679
7d0db0a3
MH
1680 hci_conn_add_sysfs(conn);
1681
1da177e4
LT
1682 if (test_bit(HCI_AUTH, &hdev->flags))
1683 conn->link_mode |= HCI_LM_AUTH;
1684
1685 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1686 conn->link_mode |= HCI_LM_ENCRYPT;
1687
04837f64
MH
1688 /* Get remote features */
1689 if (conn->type == ACL_LINK) {
1690 struct hci_cp_read_remote_features cp;
1691 cp.handle = ev->handle;
769be974 1692 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
04124681 1693 sizeof(cp), &cp);
04837f64
MH
1694 }
1695
1da177e4 1696 /* Set packet type for incoming connection */
d095c1eb 1697 if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
1da177e4
LT
1698 struct hci_cp_change_conn_ptype cp;
1699 cp.handle = ev->handle;
a8746417 1700 cp.pkt_type = cpu_to_le16(conn->pkt_type);
04124681
GP
1701 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
1702 &cp);
1da177e4 1703 }
17d5c04c 1704 } else {
1da177e4 1705 conn->state = BT_CLOSED;
17d5c04c 1706 if (conn->type == ACL_LINK)
744cf19e 1707 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
04124681 1708 conn->dst_type, ev->status);
17d5c04c 1709 }
1da177e4 1710
e73439d8
MH
1711 if (conn->type == ACL_LINK)
1712 hci_sco_setup(conn, ev->status);
1da177e4 1713
769be974
MH
1714 if (ev->status) {
1715 hci_proto_connect_cfm(conn, ev->status);
1da177e4 1716 hci_conn_del(conn);
c89b6e6b
MH
1717 } else if (ev->link_type != ACL_LINK)
1718 hci_proto_connect_cfm(conn, ev->status);
1da177e4 1719
a9de9248 1720unlock:
1da177e4 1721 hci_dev_unlock(hdev);
1da177e4 1722
a9de9248 1723 hci_conn_check_pending(hdev);
1da177e4
LT
1724}
1725
6039aa73 1726static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1727{
a9de9248
MH
1728 struct hci_ev_conn_request *ev = (void *) skb->data;
1729 int mask = hdev->link_mode;
20714bfe 1730 __u8 flags = 0;
1da177e4 1731
6ed93dc6 1732 BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
807deac2 1733 ev->link_type);
1da177e4 1734
20714bfe
FD
1735 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
1736 &flags);
1da177e4 1737
138d22ef 1738 if ((mask & HCI_LM_ACCEPT) &&
b9ee0a78 1739 !hci_blacklist_lookup(hdev, &ev->bdaddr, BDADDR_BREDR)) {
a9de9248 1740 /* Connection accepted */
c7bdd502 1741 struct inquiry_entry *ie;
1da177e4 1742 struct hci_conn *conn;
1da177e4 1743
a9de9248 1744 hci_dev_lock(hdev);
b6a0dc82 1745
cc11b9c1
AE
1746 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1747 if (ie)
c7bdd502
MH
1748 memcpy(ie->data.dev_class, ev->dev_class, 3);
1749
8fc9ced3
GP
1750 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
1751 &ev->bdaddr);
a9de9248 1752 if (!conn) {
cc11b9c1
AE
1753 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1754 if (!conn) {
893ef971 1755 BT_ERR("No memory for new connection");
a9de9248
MH
1756 hci_dev_unlock(hdev);
1757 return;
1da177e4
LT
1758 }
1759 }
b6a0dc82 1760
a9de9248 1761 memcpy(conn->dev_class, ev->dev_class, 3);
b6a0dc82 1762
a9de9248 1763 hci_dev_unlock(hdev);
1da177e4 1764
20714bfe
FD
1765 if (ev->link_type == ACL_LINK ||
1766 (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
b6a0dc82 1767 struct hci_cp_accept_conn_req cp;
20714bfe 1768 conn->state = BT_CONNECT;
1da177e4 1769
b6a0dc82
MH
1770 bacpy(&cp.bdaddr, &ev->bdaddr);
1771
1772 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1773 cp.role = 0x00; /* Become master */
1774 else
1775 cp.role = 0x01; /* Remain slave */
1776
04124681
GP
1777 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
1778 &cp);
20714bfe 1779 } else if (!(flags & HCI_PROTO_DEFER)) {
b6a0dc82 1780 struct hci_cp_accept_sync_conn_req cp;
20714bfe 1781 conn->state = BT_CONNECT;
b6a0dc82
MH
1782
1783 bacpy(&cp.bdaddr, &ev->bdaddr);
a8746417 1784 cp.pkt_type = cpu_to_le16(conn->pkt_type);
b6a0dc82 1785
82781e63
AE
1786 cp.tx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1787 cp.rx_bandwidth = __constant_cpu_to_le32(0x00001f40);
1788 cp.max_latency = __constant_cpu_to_le16(0xffff);
b6a0dc82
MH
1789 cp.content_format = cpu_to_le16(hdev->voice_setting);
1790 cp.retrans_effort = 0xff;
1da177e4 1791
b6a0dc82 1792 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
04124681 1793 sizeof(cp), &cp);
20714bfe
FD
1794 } else {
1795 conn->state = BT_CONNECT2;
1796 hci_proto_connect_cfm(conn, 0);
b6a0dc82 1797 }
a9de9248
MH
1798 } else {
1799 /* Connection rejected */
1800 struct hci_cp_reject_conn_req cp;
1da177e4 1801
a9de9248 1802 bacpy(&cp.bdaddr, &ev->bdaddr);
9f5a0d7b 1803 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
a9de9248 1804 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
1da177e4 1805 }
1da177e4
LT
1806}
1807
f0d6a0ea
MA
1808static u8 hci_to_mgmt_reason(u8 err)
1809{
1810 switch (err) {
1811 case HCI_ERROR_CONNECTION_TIMEOUT:
1812 return MGMT_DEV_DISCONN_TIMEOUT;
1813 case HCI_ERROR_REMOTE_USER_TERM:
1814 case HCI_ERROR_REMOTE_LOW_RESOURCES:
1815 case HCI_ERROR_REMOTE_POWER_OFF:
1816 return MGMT_DEV_DISCONN_REMOTE;
1817 case HCI_ERROR_LOCAL_HOST_TERM:
1818 return MGMT_DEV_DISCONN_LOCAL_HOST;
1819 default:
1820 return MGMT_DEV_DISCONN_UNKNOWN;
1821 }
1822}
1823
6039aa73 1824static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
04837f64 1825{
a9de9248 1826 struct hci_ev_disconn_complete *ev = (void *) skb->data;
abf54a50 1827 u8 reason = hci_to_mgmt_reason(ev->reason);
04837f64 1828 struct hci_conn *conn;
3846220b 1829 u8 type;
04837f64 1830
9f1db00c 1831 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
04837f64
MH
1832
1833 hci_dev_lock(hdev);
1834
1835 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
f7520543
JH
1836 if (!conn)
1837 goto unlock;
7d0db0a3 1838
abf54a50
AG
1839 if (ev->status) {
1840 mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
1841 conn->dst_type, ev->status);
1842 goto unlock;
37d9ef76 1843 }
f7520543 1844
3846220b
AG
1845 conn->state = BT_CLOSED;
1846
abf54a50
AG
1847 if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
1848 mgmt_device_disconnected(hdev, &conn->dst, conn->type,
1849 conn->dst_type, reason);
1850
3846220b
AG
1851 if (conn->type == ACL_LINK && conn->flush_key)
1852 hci_remove_link_key(hdev, &conn->dst);
2210246c 1853
3846220b 1854 type = conn->type;
2210246c 1855
3846220b
AG
1856 hci_proto_disconn_cfm(conn, ev->reason);
1857 hci_conn_del(conn);
1858
1859 /* Re-enable advertising if necessary, since it might
1860 * have been disabled by the connection. From the
1861 * HCI_LE_Set_Advertise_Enable command description in
1862 * the core specification (v4.0):
1863 * "The Controller shall continue advertising until the Host
1864 * issues an LE_Set_Advertise_Enable command with
1865 * Advertising_Enable set to 0x00 (Advertising is disabled)
1866 * or until a connection is created or until the Advertising
1867 * is timed out due to Directed Advertising."
1868 */
1869 if (type == LE_LINK)
1870 mgmt_reenable_advertising(hdev);
f7520543
JH
1871
1872unlock:
04837f64
MH
1873 hci_dev_unlock(hdev);
1874}
1875
6039aa73 1876static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1877{
a9de9248 1878 struct hci_ev_auth_complete *ev = (void *) skb->data;
04837f64 1879 struct hci_conn *conn;
1da177e4 1880
9f1db00c 1881 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT
1882
1883 hci_dev_lock(hdev);
1884
04837f64 1885 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
d7556e20
WR
1886 if (!conn)
1887 goto unlock;
1888
1889 if (!ev->status) {
aa64a8b5 1890 if (!hci_conn_ssp_enabled(conn) &&
807deac2 1891 test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
d7556e20 1892 BT_INFO("re-auth of legacy device is not possible.");
2a611692 1893 } else {
d7556e20
WR
1894 conn->link_mode |= HCI_LM_AUTH;
1895 conn->sec_level = conn->pending_sec_level;
2a611692 1896 }
d7556e20 1897 } else {
bab73cb6 1898 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
04124681 1899 ev->status);
d7556e20 1900 }
1da177e4 1901
51a8efd7
JH
1902 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
1903 clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
1da177e4 1904
d7556e20 1905 if (conn->state == BT_CONFIG) {
aa64a8b5 1906 if (!ev->status && hci_conn_ssp_enabled(conn)) {
d7556e20
WR
1907 struct hci_cp_set_conn_encrypt cp;
1908 cp.handle = ev->handle;
1909 cp.encrypt = 0x01;
1910 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
807deac2 1911 &cp);
052b30b0 1912 } else {
d7556e20
WR
1913 conn->state = BT_CONNECTED;
1914 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 1915 hci_conn_drop(conn);
052b30b0 1916 }
d7556e20
WR
1917 } else {
1918 hci_auth_cfm(conn, ev->status);
052b30b0 1919
d7556e20
WR
1920 hci_conn_hold(conn);
1921 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 1922 hci_conn_drop(conn);
d7556e20
WR
1923 }
1924
51a8efd7 1925 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
d7556e20
WR
1926 if (!ev->status) {
1927 struct hci_cp_set_conn_encrypt cp;
1928 cp.handle = ev->handle;
1929 cp.encrypt = 0x01;
1930 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
807deac2 1931 &cp);
d7556e20 1932 } else {
51a8efd7 1933 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
d7556e20 1934 hci_encrypt_cfm(conn, ev->status, 0x00);
1da177e4
LT
1935 }
1936 }
1937
d7556e20 1938unlock:
1da177e4
LT
1939 hci_dev_unlock(hdev);
1940}
1941
6039aa73 1942static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1943{
127178d2
JH
1944 struct hci_ev_remote_name *ev = (void *) skb->data;
1945 struct hci_conn *conn;
1946
a9de9248 1947 BT_DBG("%s", hdev->name);
1da177e4 1948
a9de9248 1949 hci_conn_check_pending(hdev);
127178d2
JH
1950
1951 hci_dev_lock(hdev);
1952
b644ba33 1953 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
30dc78e1 1954
b644ba33
JH
1955 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
1956 goto check_auth;
a88a9652 1957
b644ba33
JH
1958 if (ev->status == 0)
1959 hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
04124681 1960 strnlen(ev->name, HCI_MAX_NAME_LENGTH));
b644ba33
JH
1961 else
1962 hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);
1963
1964check_auth:
79c6c70c
JH
1965 if (!conn)
1966 goto unlock;
1967
1968 if (!hci_outgoing_auth_needed(hdev, conn))
1969 goto unlock;
1970
51a8efd7 1971 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
127178d2
JH
1972 struct hci_cp_auth_requested cp;
1973 cp.handle = __cpu_to_le16(conn->handle);
1974 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1975 }
1976
79c6c70c 1977unlock:
127178d2 1978 hci_dev_unlock(hdev);
a9de9248
MH
1979}
1980
6039aa73 1981static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH
1982{
1983 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1984 struct hci_conn *conn;
1985
9f1db00c 1986 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT
1987
1988 hci_dev_lock(hdev);
1989
04837f64 1990 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT
1991 if (conn) {
1992 if (!ev->status) {
ae293196
MH
1993 if (ev->encrypt) {
1994 /* Encryption implies authentication */
1995 conn->link_mode |= HCI_LM_AUTH;
1da177e4 1996 conn->link_mode |= HCI_LM_ENCRYPT;
da85e5e5 1997 conn->sec_level = conn->pending_sec_level;
ae293196 1998 } else
1da177e4
LT
1999 conn->link_mode &= ~HCI_LM_ENCRYPT;
2000 }
2001
51a8efd7 2002 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
1da177e4 2003
a7d7723a 2004 if (ev->status && conn->state == BT_CONNECTED) {
bed71748 2005 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
76a68ba0 2006 hci_conn_drop(conn);
a7d7723a
GP
2007 goto unlock;
2008 }
2009
f8558555
MH
2010 if (conn->state == BT_CONFIG) {
2011 if (!ev->status)
2012 conn->state = BT_CONNECTED;
2013
2014 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 2015 hci_conn_drop(conn);
f8558555
MH
2016 } else
2017 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
1da177e4
LT
2018 }
2019
a7d7723a 2020unlock:
1da177e4
LT
2021 hci_dev_unlock(hdev);
2022}
2023
6039aa73
GP
2024static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
2025 struct sk_buff *skb)
1da177e4 2026{
a9de9248 2027 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
04837f64 2028 struct hci_conn *conn;
1da177e4 2029
9f1db00c 2030 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT
2031
2032 hci_dev_lock(hdev);
2033
04837f64 2034 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT
2035 if (conn) {
2036 if (!ev->status)
2037 conn->link_mode |= HCI_LM_SECURE;
2038
51a8efd7 2039 clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
1da177e4
LT
2040
2041 hci_key_change_cfm(conn, ev->status);
2042 }
2043
2044 hci_dev_unlock(hdev);
2045}
2046
6039aa73
GP
2047static void hci_remote_features_evt(struct hci_dev *hdev,
2048 struct sk_buff *skb)
1da177e4 2049{
a9de9248
MH
2050 struct hci_ev_remote_features *ev = (void *) skb->data;
2051 struct hci_conn *conn;
2052
9f1db00c 2053 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a9de9248 2054
a9de9248
MH
2055 hci_dev_lock(hdev);
2056
2057 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH
2058 if (!conn)
2059 goto unlock;
769be974 2060
ccd556fe 2061 if (!ev->status)
cad718ed 2062 memcpy(conn->features[0], ev->features, 8);
ccd556fe
JH
2063
2064 if (conn->state != BT_CONFIG)
2065 goto unlock;
2066
2067 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
2068 struct hci_cp_read_remote_ext_features cp;
2069 cp.handle = ev->handle;
2070 cp.page = 0x01;
2071 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
807deac2 2072 sizeof(cp), &cp);
392599b9
JH
2073 goto unlock;
2074 }
2075
671267bf 2076 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
127178d2
JH
2077 struct hci_cp_remote_name_req cp;
2078 memset(&cp, 0, sizeof(cp));
2079 bacpy(&cp.bdaddr, &conn->dst);
2080 cp.pscan_rep_mode = 0x02;
2081 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
b644ba33
JH
2082 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2083 mgmt_device_connected(hdev, &conn->dst, conn->type,
04124681
GP
2084 conn->dst_type, 0, NULL, 0,
2085 conn->dev_class);
392599b9 2086
127178d2 2087 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH
2088 conn->state = BT_CONNECTED;
2089 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 2090 hci_conn_drop(conn);
769be974 2091 }
a9de9248 2092
ccd556fe 2093unlock:
a9de9248 2094 hci_dev_unlock(hdev);
1da177e4
LT
2095}
2096
6039aa73 2097static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH
2098{
2099 struct hci_ev_cmd_complete *ev = (void *) skb->data;
9238f36a 2100 u8 status = skb->data[sizeof(*ev)];
a9de9248
MH
2101 __u16 opcode;
2102
2103 skb_pull(skb, sizeof(*ev));
2104
2105 opcode = __le16_to_cpu(ev->opcode);
2106
2107 switch (opcode) {
2108 case HCI_OP_INQUIRY_CANCEL:
2109 hci_cc_inquiry_cancel(hdev, skb);
2110 break;
2111
4d93483b
AG
2112 case HCI_OP_PERIODIC_INQ:
2113 hci_cc_periodic_inq(hdev, skb);
2114 break;
2115
a9de9248
MH
2116 case HCI_OP_EXIT_PERIODIC_INQ:
2117 hci_cc_exit_periodic_inq(hdev, skb);
2118 break;
2119
2120 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
2121 hci_cc_remote_name_req_cancel(hdev, skb);
2122 break;
2123
2124 case HCI_OP_ROLE_DISCOVERY:
2125 hci_cc_role_discovery(hdev, skb);
2126 break;
2127
e4e8e37c
MH
2128 case HCI_OP_READ_LINK_POLICY:
2129 hci_cc_read_link_policy(hdev, skb);
2130 break;
2131
a9de9248
MH
2132 case HCI_OP_WRITE_LINK_POLICY:
2133 hci_cc_write_link_policy(hdev, skb);
2134 break;
2135
e4e8e37c
MH
2136 case HCI_OP_READ_DEF_LINK_POLICY:
2137 hci_cc_read_def_link_policy(hdev, skb);
2138 break;
2139
2140 case HCI_OP_WRITE_DEF_LINK_POLICY:
2141 hci_cc_write_def_link_policy(hdev, skb);
2142 break;
2143
a9de9248
MH
2144 case HCI_OP_RESET:
2145 hci_cc_reset(hdev, skb);
2146 break;
2147
2148 case HCI_OP_WRITE_LOCAL_NAME:
2149 hci_cc_write_local_name(hdev, skb);
2150 break;
2151
2152 case HCI_OP_READ_LOCAL_NAME:
2153 hci_cc_read_local_name(hdev, skb);
2154 break;
2155
2156 case HCI_OP_WRITE_AUTH_ENABLE:
2157 hci_cc_write_auth_enable(hdev, skb);
2158 break;
2159
2160 case HCI_OP_WRITE_ENCRYPT_MODE:
2161 hci_cc_write_encrypt_mode(hdev, skb);
2162 break;
2163
2164 case HCI_OP_WRITE_SCAN_ENABLE:
2165 hci_cc_write_scan_enable(hdev, skb);
2166 break;
2167
2168 case HCI_OP_READ_CLASS_OF_DEV:
2169 hci_cc_read_class_of_dev(hdev, skb);
2170 break;
2171
2172 case HCI_OP_WRITE_CLASS_OF_DEV:
2173 hci_cc_write_class_of_dev(hdev, skb);
2174 break;
2175
2176 case HCI_OP_READ_VOICE_SETTING:
2177 hci_cc_read_voice_setting(hdev, skb);
2178 break;
2179
2180 case HCI_OP_WRITE_VOICE_SETTING:
2181 hci_cc_write_voice_setting(hdev, skb);
2182 break;
2183
b4cb9fb2
MH
2184 case HCI_OP_READ_NUM_SUPPORTED_IAC:
2185 hci_cc_read_num_supported_iac(hdev, skb);
2186 break;
2187
333140b5
MH
2188 case HCI_OP_WRITE_SSP_MODE:
2189 hci_cc_write_ssp_mode(hdev, skb);
2190 break;
2191
eac83dc6
MH
2192 case HCI_OP_WRITE_SC_SUPPORT:
2193 hci_cc_write_sc_support(hdev, skb);
2194 break;
2195
a9de9248
MH
2196 case HCI_OP_READ_LOCAL_VERSION:
2197 hci_cc_read_local_version(hdev, skb);
2198 break;
2199
2200 case HCI_OP_READ_LOCAL_COMMANDS:
2201 hci_cc_read_local_commands(hdev, skb);
2202 break;
2203
2204 case HCI_OP_READ_LOCAL_FEATURES:
2205 hci_cc_read_local_features(hdev, skb);
2206 break;
2207
971e3a4b
AG
2208 case HCI_OP_READ_LOCAL_EXT_FEATURES:
2209 hci_cc_read_local_ext_features(hdev, skb);
2210 break;
2211
a9de9248
MH
2212 case HCI_OP_READ_BUFFER_SIZE:
2213 hci_cc_read_buffer_size(hdev, skb);
2214 break;
2215
2216 case HCI_OP_READ_BD_ADDR:
2217 hci_cc_read_bd_addr(hdev, skb);
2218 break;
2219
f332ec66
JH
2220 case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
2221 hci_cc_read_page_scan_activity(hdev, skb);
2222 break;
2223
4a3ee763
JH
2224 case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
2225 hci_cc_write_page_scan_activity(hdev, skb);
2226 break;
2227
f332ec66
JH
2228 case HCI_OP_READ_PAGE_SCAN_TYPE:
2229 hci_cc_read_page_scan_type(hdev, skb);
2230 break;
2231
4a3ee763
JH
2232 case HCI_OP_WRITE_PAGE_SCAN_TYPE:
2233 hci_cc_write_page_scan_type(hdev, skb);
2234 break;
2235
350ee4cf
AE
2236 case HCI_OP_READ_DATA_BLOCK_SIZE:
2237 hci_cc_read_data_block_size(hdev, skb);
2238 break;
2239
1e89cffb
AE
2240 case HCI_OP_READ_FLOW_CONTROL_MODE:
2241 hci_cc_read_flow_control_mode(hdev, skb);
2242 break;
2243
928abaa7
AE
2244 case HCI_OP_READ_LOCAL_AMP_INFO:
2245 hci_cc_read_local_amp_info(hdev, skb);
2246 break;
2247
903e4541
AE
2248 case HCI_OP_READ_LOCAL_AMP_ASSOC:
2249 hci_cc_read_local_amp_assoc(hdev, skb);
2250 break;
2251
d5859e22
JH
2252 case HCI_OP_READ_INQ_RSP_TX_POWER:
2253 hci_cc_read_inq_rsp_tx_power(hdev, skb);
2254 break;
2255
980e1a53
JH
2256 case HCI_OP_PIN_CODE_REPLY:
2257 hci_cc_pin_code_reply(hdev, skb);
2258 break;
2259
2260 case HCI_OP_PIN_CODE_NEG_REPLY:
2261 hci_cc_pin_code_neg_reply(hdev, skb);
2262 break;
2263
c35938b2 2264 case HCI_OP_READ_LOCAL_OOB_DATA:
4d2d2796
MH
2265 hci_cc_read_local_oob_data(hdev, skb);
2266 break;
2267
2268 case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
2269 hci_cc_read_local_oob_ext_data(hdev, skb);
c35938b2
SJ
2270 break;
2271
6ed58ec5
VT
2272 case HCI_OP_LE_READ_BUFFER_SIZE:
2273 hci_cc_le_read_buffer_size(hdev, skb);
2274 break;
2275
60e77321
JH
2276 case HCI_OP_LE_READ_LOCAL_FEATURES:
2277 hci_cc_le_read_local_features(hdev, skb);
2278 break;
2279
8fa19098
JH
2280 case HCI_OP_LE_READ_ADV_TX_POWER:
2281 hci_cc_le_read_adv_tx_power(hdev, skb);
2282 break;
2283
a5c29683
JH
2284 case HCI_OP_USER_CONFIRM_REPLY:
2285 hci_cc_user_confirm_reply(hdev, skb);
2286 break;
2287
2288 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2289 hci_cc_user_confirm_neg_reply(hdev, skb);
2290 break;
2291
1143d458
BG
2292 case HCI_OP_USER_PASSKEY_REPLY:
2293 hci_cc_user_passkey_reply(hdev, skb);
2294 break;
2295
2296 case HCI_OP_USER_PASSKEY_NEG_REPLY:
2297 hci_cc_user_passkey_neg_reply(hdev, skb);
16cde993 2298 break;
07f7fa5d 2299
c1d5dc4a
JH
2300 case HCI_OP_LE_SET_ADV_ENABLE:
2301 hci_cc_le_set_adv_enable(hdev, skb);
2302 break;
2303
eb9d91f5
AG
2304 case HCI_OP_LE_SET_SCAN_ENABLE:
2305 hci_cc_le_set_scan_enable(hdev, skb);
2306 break;
2307
cf1d081f
JH
2308 case HCI_OP_LE_READ_WHITE_LIST_SIZE:
2309 hci_cc_le_read_white_list_size(hdev, skb);
2310 break;
2311
9b008c04
JH
2312 case HCI_OP_LE_READ_SUPPORTED_STATES:
2313 hci_cc_le_read_supported_states(hdev, skb);
2314 break;
2315
f9b49306
AG
2316 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2317 hci_cc_write_le_host_supported(hdev, skb);
2318 break;
2319
93c284ee
AE
2320 case HCI_OP_WRITE_REMOTE_AMP_ASSOC:
2321 hci_cc_write_remote_amp_assoc(hdev, skb);
2322 break;
2323
a9de9248 2324 default:
9f1db00c 2325 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
a9de9248
MH
2326 break;
2327 }
2328
ad82cdd1 2329 if (opcode != HCI_OP_NOP)
6bd32326
VT
2330 del_timer(&hdev->cmd_timer);
2331
ad82cdd1 2332 hci_req_cmd_complete(hdev, opcode, status);
9238f36a 2333
dbccd791 2334 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
a9de9248
MH
2335 atomic_set(&hdev->cmd_cnt, 1);
2336 if (!skb_queue_empty(&hdev->cmd_q))
c347b765 2337 queue_work(hdev->workqueue, &hdev->cmd_work);
a9de9248
MH
2338 }
2339}
2340
6039aa73 2341static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH
2342{
2343 struct hci_ev_cmd_status *ev = (void *) skb->data;
2344 __u16 opcode;
2345
2346 skb_pull(skb, sizeof(*ev));
2347
2348 opcode = __le16_to_cpu(ev->opcode);
2349
2350 switch (opcode) {
2351 case HCI_OP_INQUIRY:
2352 hci_cs_inquiry(hdev, ev->status);
2353 break;
2354
2355 case HCI_OP_CREATE_CONN:
2356 hci_cs_create_conn(hdev, ev->status);
2357 break;
2358
2359 case HCI_OP_ADD_SCO:
2360 hci_cs_add_sco(hdev, ev->status);
2361 break;
2362
f8558555
MH
2363 case HCI_OP_AUTH_REQUESTED:
2364 hci_cs_auth_requested(hdev, ev->status);
2365 break;
2366
2367 case HCI_OP_SET_CONN_ENCRYPT:
2368 hci_cs_set_conn_encrypt(hdev, ev->status);
2369 break;
2370
a9de9248
MH
2371 case HCI_OP_REMOTE_NAME_REQ:
2372 hci_cs_remote_name_req(hdev, ev->status);
2373 break;
2374
769be974
MH
2375 case HCI_OP_READ_REMOTE_FEATURES:
2376 hci_cs_read_remote_features(hdev, ev->status);
2377 break;
2378
2379 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2380 hci_cs_read_remote_ext_features(hdev, ev->status);
2381 break;
2382
a9de9248
MH
2383 case HCI_OP_SETUP_SYNC_CONN:
2384 hci_cs_setup_sync_conn(hdev, ev->status);
2385 break;
2386
2387 case HCI_OP_SNIFF_MODE:
2388 hci_cs_sniff_mode(hdev, ev->status);
2389 break;
2390
2391 case HCI_OP_EXIT_SNIFF_MODE:
2392 hci_cs_exit_sniff_mode(hdev, ev->status);
2393 break;
2394
8962ee74 2395 case HCI_OP_DISCONNECT:
88c3df13 2396 hci_cs_disconnect(hdev, ev->status);
8962ee74
JH
2397 break;
2398
a02226d6
AE
2399 case HCI_OP_CREATE_PHY_LINK:
2400 hci_cs_create_phylink(hdev, ev->status);
2401 break;
2402
0b26ab9d
AE
2403 case HCI_OP_ACCEPT_PHY_LINK:
2404 hci_cs_accept_phylink(hdev, ev->status);
2405 break;
2406
a9de9248 2407 default:
9f1db00c 2408 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
a9de9248
MH
2409 break;
2410 }
2411
ad82cdd1 2412 if (opcode != HCI_OP_NOP)
6bd32326
VT
2413 del_timer(&hdev->cmd_timer);
2414
02350a72
JH
2415 if (ev->status ||
2416 (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->req.event))
2417 hci_req_cmd_complete(hdev, opcode, ev->status);
9238f36a 2418
10572132 2419 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
a9de9248
MH
2420 atomic_set(&hdev->cmd_cnt, 1);
2421 if (!skb_queue_empty(&hdev->cmd_q))
c347b765 2422 queue_work(hdev->workqueue, &hdev->cmd_work);
a9de9248
MH
2423 }
2424}
2425
6039aa73 2426static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH
2427{
2428 struct hci_ev_role_change *ev = (void *) skb->data;
2429 struct hci_conn *conn;
2430
9f1db00c 2431 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a9de9248
MH
2432
2433 hci_dev_lock(hdev);
2434
2435 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2436 if (conn) {
2437 if (!ev->status) {
2438 if (ev->role)
2439 conn->link_mode &= ~HCI_LM_MASTER;
2440 else
2441 conn->link_mode |= HCI_LM_MASTER;
2442 }
2443
51a8efd7 2444 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
a9de9248
MH
2445
2446 hci_role_switch_cfm(conn, ev->status, ev->role);
2447 }
2448
2449 hci_dev_unlock(hdev);
2450}
2451
6039aa73 2452static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248
MH
2453{
2454 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
a9de9248
MH
2455 int i;
2456
32ac5b9b
AE
2457 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
2458 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2459 return;
2460 }
2461
c5993de8 2462 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
807deac2 2463 ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
a9de9248
MH
2464 BT_DBG("%s bad parameters", hdev->name);
2465 return;
2466 }
2467
c5993de8
AE
2468 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2469
613a1c0c
AE
2470 for (i = 0; i < ev->num_hndl; i++) {
2471 struct hci_comp_pkts_info *info = &ev->handles[i];
a9de9248
MH
2472 struct hci_conn *conn;
2473 __u16 handle, count;
2474
613a1c0c
AE
2475 handle = __le16_to_cpu(info->handle);
2476 count = __le16_to_cpu(info->count);
a9de9248
MH
2477
2478 conn = hci_conn_hash_lookup_handle(hdev, handle);
f4280918
AE
2479 if (!conn)
2480 continue;
2481
2482 conn->sent -= count;
2483
2484 switch (conn->type) {
2485 case ACL_LINK:
2486 hdev->acl_cnt += count;
2487 if (hdev->acl_cnt > hdev->acl_pkts)
2488 hdev->acl_cnt = hdev->acl_pkts;
2489 break;
2490
2491 case LE_LINK:
2492 if (hdev->le_pkts) {
2493 hdev->le_cnt += count;
2494 if (hdev->le_cnt > hdev->le_pkts)
2495 hdev->le_cnt = hdev->le_pkts;
2496 } else {
70f23020
AE
2497 hdev->acl_cnt += count;
2498 if (hdev->acl_cnt > hdev->acl_pkts)
a9de9248 2499 hdev->acl_cnt = hdev->acl_pkts;
a9de9248 2500 }
f4280918
AE
2501 break;
2502
2503 case SCO_LINK:
2504 hdev->sco_cnt += count;
2505 if (hdev->sco_cnt > hdev->sco_pkts)
2506 hdev->sco_cnt = hdev->sco_pkts;
2507 break;
2508
2509 default:
2510 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2511 break;
a9de9248
MH
2512 }
2513 }
2514
3eff45ea 2515 queue_work(hdev->workqueue, &hdev->tx_work);
a9de9248
MH
2516}
2517
76ef7cf7
AE
2518static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
2519 __u16 handle)
2520{
2521 struct hci_chan *chan;
2522
2523 switch (hdev->dev_type) {
2524 case HCI_BREDR:
2525 return hci_conn_hash_lookup_handle(hdev, handle);
2526 case HCI_AMP:
2527 chan = hci_chan_lookup_handle(hdev, handle);
2528 if (chan)
2529 return chan->conn;
2530 break;
2531 default:
2532 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type);
2533 break;
2534 }
2535
2536 return NULL;
2537}
2538
6039aa73 2539static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
25e89e99
AE
2540{
2541 struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
2542 int i;
2543
2544 if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
2545 BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
2546 return;
2547 }
2548
2549 if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
807deac2 2550 ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
25e89e99
AE
2551 BT_DBG("%s bad parameters", hdev->name);
2552 return;
2553 }
2554
2555 BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
807deac2 2556 ev->num_hndl);
25e89e99
AE
2557
2558 for (i = 0; i < ev->num_hndl; i++) {
2559 struct hci_comp_blocks_info *info = &ev->handles[i];
76ef7cf7 2560 struct hci_conn *conn = NULL;
25e89e99
AE
2561 __u16 handle, block_count;
2562
2563 handle = __le16_to_cpu(info->handle);
2564 block_count = __le16_to_cpu(info->blocks);
2565
76ef7cf7 2566 conn = __hci_conn_lookup_handle(hdev, handle);
25e89e99
AE
2567 if (!conn)
2568 continue;
2569
2570 conn->sent -= block_count;
2571
2572 switch (conn->type) {
2573 case ACL_LINK:
bd1eb66b 2574 case AMP_LINK:
25e89e99
AE
2575 hdev->block_cnt += block_count;
2576 if (hdev->block_cnt > hdev->num_blocks)
2577 hdev->block_cnt = hdev->num_blocks;
2578 break;
2579
2580 default:
2581 BT_ERR("Unknown type %d conn %p", conn->type, conn);
2582 break;
2583 }
2584 }
2585
2586 queue_work(hdev->workqueue, &hdev->tx_work);
2587}
2588
6039aa73 2589static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
04837f64 2590{
a9de9248 2591 struct hci_ev_mode_change *ev = (void *) skb->data;
04837f64
MH
2592 struct hci_conn *conn;
2593
9f1db00c 2594 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
04837f64
MH
2595
2596 hci_dev_lock(hdev);
2597
2598 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
a9de9248
MH
2599 if (conn) {
2600 conn->mode = ev->mode;
a9de9248 2601
8fc9ced3
GP
2602 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
2603 &conn->flags)) {
a9de9248 2604 if (conn->mode == HCI_CM_ACTIVE)
58a681ef 2605 set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
a9de9248 2606 else
58a681ef 2607 clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
a9de9248 2608 }
e73439d8 2609
51a8efd7 2610 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
e73439d8 2611 hci_sco_setup(conn, ev->status);
04837f64
MH
2612 }
2613
2614 hci_dev_unlock(hdev);
2615}
2616
6039aa73 2617static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248 2618{
052b30b0
MH
2619 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2620 struct hci_conn *conn;
2621
a9de9248 2622 BT_DBG("%s", hdev->name);
052b30b0
MH
2623
2624 hci_dev_lock(hdev);
2625
2626 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
b6f98044
WR
2627 if (!conn)
2628 goto unlock;
2629
2630 if (conn->state == BT_CONNECTED) {
052b30b0
MH
2631 hci_conn_hold(conn);
2632 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
76a68ba0 2633 hci_conn_drop(conn);
052b30b0
MH
2634 }
2635
a8b2d5c2 2636 if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
03b555e1 2637 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
807deac2 2638 sizeof(ev->bdaddr), &ev->bdaddr);
a8b2d5c2 2639 else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
a770bb5a
WR
2640 u8 secure;
2641
2642 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2643 secure = 1;
2644 else
2645 secure = 0;
2646
744cf19e 2647 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
a770bb5a 2648 }
980e1a53 2649
b6f98044 2650unlock:
052b30b0 2651 hci_dev_unlock(hdev);
a9de9248
MH
2652}
2653
6039aa73 2654static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248 2655{
55ed8ca1
JH
2656 struct hci_ev_link_key_req *ev = (void *) skb->data;
2657 struct hci_cp_link_key_reply cp;
2658 struct hci_conn *conn;
2659 struct link_key *key;
2660
a9de9248 2661 BT_DBG("%s", hdev->name);
55ed8ca1 2662
034cbea0 2663 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
55ed8ca1
JH
2664 return;
2665
2666 hci_dev_lock(hdev);
2667
2668 key = hci_find_link_key(hdev, &ev->bdaddr);
2669 if (!key) {
6ed93dc6
AE
2670 BT_DBG("%s link key not found for %pMR", hdev->name,
2671 &ev->bdaddr);
55ed8ca1
JH
2672 goto not_found;
2673 }
2674
6ed93dc6
AE
2675 BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
2676 &ev->bdaddr);
55ed8ca1 2677
a8b2d5c2 2678 if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
807deac2 2679 key->type == HCI_LK_DEBUG_COMBINATION) {
55ed8ca1
JH
2680 BT_DBG("%s ignoring debug key", hdev->name);
2681 goto not_found;
2682 }
2683
2684 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
60b83f57 2685 if (conn) {
66138ce8
MH
2686 if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
2687 key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
807deac2 2688 conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
60b83f57
WR
2689 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2690 goto not_found;
2691 }
55ed8ca1 2692
60b83f57 2693 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
807deac2 2694 conn->pending_sec_level == BT_SECURITY_HIGH) {
8fc9ced3
GP
2695 BT_DBG("%s ignoring key unauthenticated for high security",
2696 hdev->name);
60b83f57
WR
2697 goto not_found;
2698 }
2699
2700 conn->key_type = key->type;
2701 conn->pin_length = key->pin_len;
55ed8ca1
JH
2702 }
2703
2704 bacpy(&cp.bdaddr, &ev->bdaddr);
9b3b4460 2705 memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
55ed8ca1
JH
2706
2707 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2708
2709 hci_dev_unlock(hdev);
2710
2711 return;
2712
2713not_found:
2714 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2715 hci_dev_unlock(hdev);
a9de9248
MH
2716}
2717
6039aa73 2718static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
a9de9248 2719{
052b30b0
MH
2720 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2721 struct hci_conn *conn;
55ed8ca1 2722 u8 pin_len = 0;
052b30b0 2723
a9de9248 2724 BT_DBG("%s", hdev->name);
052b30b0
MH
2725
2726 hci_dev_lock(hdev);
2727
2728 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2729 if (conn) {
2730 hci_conn_hold(conn);
2731 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
980e1a53 2732 pin_len = conn->pin_length;
13d39315
WR
2733
2734 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2735 conn->key_type = ev->key_type;
2736
76a68ba0 2737 hci_conn_drop(conn);
052b30b0
MH
2738 }
2739
034cbea0 2740 if (test_bit(HCI_MGMT, &hdev->dev_flags))
d25e28ab 2741 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
807deac2 2742 ev->key_type, pin_len);
55ed8ca1 2743
052b30b0 2744 hci_dev_unlock(hdev);
a9de9248
MH
2745}
2746
6039aa73 2747static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2748{
a9de9248 2749 struct hci_ev_clock_offset *ev = (void *) skb->data;
04837f64 2750 struct hci_conn *conn;
1da177e4 2751
9f1db00c 2752 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1da177e4
LT
2753
2754 hci_dev_lock(hdev);
2755
04837f64 2756 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT
2757 if (conn && !ev->status) {
2758 struct inquiry_entry *ie;
2759
cc11b9c1
AE
2760 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2761 if (ie) {
1da177e4
LT
2762 ie->data.clock_offset = ev->clock_offset;
2763 ie->timestamp = jiffies;
2764 }
2765 }
2766
2767 hci_dev_unlock(hdev);
2768}
2769
6039aa73 2770static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
a8746417
MH
2771{
2772 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2773 struct hci_conn *conn;
2774
9f1db00c 2775 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
a8746417
MH
2776
2777 hci_dev_lock(hdev);
2778
2779 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2780 if (conn && !ev->status)
2781 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2782
2783 hci_dev_unlock(hdev);
2784}
2785
6039aa73 2786static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
85a1e930 2787{
a9de9248 2788 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
85a1e930
MH
2789 struct inquiry_entry *ie;
2790
2791 BT_DBG("%s", hdev->name);
2792
2793 hci_dev_lock(hdev);
2794
cc11b9c1
AE
2795 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2796 if (ie) {
85a1e930
MH
2797 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2798 ie->timestamp = jiffies;
2799 }
2800
2801 hci_dev_unlock(hdev);
2802}
2803
6039aa73
GP
2804static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
2805 struct sk_buff *skb)
a9de9248
MH
2806{
2807 struct inquiry_data data;
2808 int num_rsp = *((__u8 *) skb->data);
388fc8fa 2809 bool name_known, ssp;
a9de9248
MH
2810
2811 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2812
2813 if (!num_rsp)
2814 return;
2815
1519cc17
AG
2816 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
2817 return;
2818
a9de9248
MH
2819 hci_dev_lock(hdev);
2820
2821 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
138d22ef
SJ
2822 struct inquiry_info_with_rssi_and_pscan_mode *info;
2823 info = (void *) (skb->data + 1);
a9de9248 2824
e17acd40 2825 for (; num_rsp; num_rsp--, info++) {
a9de9248
MH
2826 bacpy(&data.bdaddr, &info->bdaddr);
2827 data.pscan_rep_mode = info->pscan_rep_mode;
2828 data.pscan_period_mode = info->pscan_period_mode;
2829 data.pscan_mode = info->pscan_mode;
2830 memcpy(data.dev_class, info->dev_class, 3);
2831 data.clock_offset = info->clock_offset;
2832 data.rssi = info->rssi;
41a96212 2833 data.ssp_mode = 0x00;
3175405b
JH
2834
2835 name_known = hci_inquiry_cache_update(hdev, &data,
04124681 2836 false, &ssp);
48264f06 2837 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681
GP
2838 info->dev_class, info->rssi,
2839 !name_known, ssp, NULL, 0);
a9de9248
MH
2840 }
2841 } else {
2842 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2843
e17acd40 2844 for (; num_rsp; num_rsp--, info++) {
a9de9248
MH
2845 bacpy(&data.bdaddr, &info->bdaddr);
2846 data.pscan_rep_mode = info->pscan_rep_mode;
2847 data.pscan_period_mode = info->pscan_period_mode;
2848 data.pscan_mode = 0x00;
2849 memcpy(data.dev_class, info->dev_class, 3);
2850 data.clock_offset = info->clock_offset;
2851 data.rssi = info->rssi;
41a96212 2852 data.ssp_mode = 0x00;
3175405b 2853 name_known = hci_inquiry_cache_update(hdev, &data,
04124681 2854 false, &ssp);
48264f06 2855 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681
GP
2856 info->dev_class, info->rssi,
2857 !name_known, ssp, NULL, 0);
a9de9248
MH
2858 }
2859 }
2860
2861 hci_dev_unlock(hdev);
2862}
2863
6039aa73
GP
2864static void hci_remote_ext_features_evt(struct hci_dev *hdev,
2865 struct sk_buff *skb)
a9de9248 2866{
41a96212
MH
2867 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2868 struct hci_conn *conn;
2869
a9de9248 2870 BT_DBG("%s", hdev->name);
41a96212 2871
41a96212
MH
2872 hci_dev_lock(hdev);
2873
2874 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH
2875 if (!conn)
2876 goto unlock;
41a96212 2877
cad718ed
JH
2878 if (ev->page < HCI_MAX_PAGES)
2879 memcpy(conn->features[ev->page], ev->features, 8);
2880
ccd556fe
JH
2881 if (!ev->status && ev->page == 0x01) {
2882 struct inquiry_entry *ie;
41a96212 2883
cc11b9c1
AE
2884 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2885 if (ie)
02b7cc62 2886 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
769be974 2887
bbb0eada 2888 if (ev->features[0] & LMP_HOST_SSP) {
58a681ef 2889 set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
bbb0eada
JK
2890 } else {
2891 /* It is mandatory by the Bluetooth specification that
2892 * Extended Inquiry Results are only used when Secure
2893 * Simple Pairing is enabled, but some devices violate
2894 * this.
2895 *
2896 * To make these devices work, the internal SSP
2897 * enabled flag needs to be cleared if the remote host
2898 * features do not indicate SSP support */
2899 clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
2900 }
ccd556fe
JH
2901 }
2902
2903 if (conn->state != BT_CONFIG)
2904 goto unlock;
2905
671267bf 2906 if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
127178d2
JH
2907 struct hci_cp_remote_name_req cp;
2908 memset(&cp, 0, sizeof(cp));
2909 bacpy(&cp.bdaddr, &conn->dst);
2910 cp.pscan_rep_mode = 0x02;
2911 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
b644ba33
JH
2912 } else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2913 mgmt_device_connected(hdev, &conn->dst, conn->type,
04124681
GP
2914 conn->dst_type, 0, NULL, 0,
2915 conn->dev_class);
392599b9 2916
127178d2 2917 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH
2918 conn->state = BT_CONNECTED;
2919 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 2920 hci_conn_drop(conn);
41a96212
MH
2921 }
2922
ccd556fe 2923unlock:
41a96212 2924 hci_dev_unlock(hdev);
a9de9248
MH
2925}
2926
6039aa73
GP
2927static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
2928 struct sk_buff *skb)
a9de9248 2929{
b6a0dc82
MH
2930 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2931 struct hci_conn *conn;
2932
9f1db00c 2933 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
b6a0dc82
MH
2934
2935 hci_dev_lock(hdev);
2936
2937 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9dc0a3af
MH
2938 if (!conn) {
2939 if (ev->link_type == ESCO_LINK)
2940 goto unlock;
2941
2942 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2943 if (!conn)
2944 goto unlock;
2945
2946 conn->type = SCO_LINK;
2947 }
b6a0dc82 2948
732547f9
MH
2949 switch (ev->status) {
2950 case 0x00:
b6a0dc82
MH
2951 conn->handle = __le16_to_cpu(ev->handle);
2952 conn->state = BT_CONNECTED;
7d0db0a3
MH
2953
2954 hci_conn_add_sysfs(conn);
732547f9
MH
2955 break;
2956
1a4c958c 2957 case 0x0d: /* Connection Rejected due to Limited Resources */
705e5711 2958 case 0x11: /* Unsupported Feature or Parameter Value */
732547f9 2959 case 0x1c: /* SCO interval rejected */
1038a00b 2960 case 0x1a: /* Unsupported Remote Feature */
732547f9 2961 case 0x1f: /* Unspecified error */
2dea632f 2962 if (conn->out) {
732547f9
MH
2963 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2964 (hdev->esco_type & EDR_ESCO_MASK);
2dea632f
FD
2965 if (hci_setup_sync(conn, conn->link->handle))
2966 goto unlock;
732547f9
MH
2967 }
2968 /* fall through */
2969
2970 default:
b6a0dc82 2971 conn->state = BT_CLOSED;
732547f9
MH
2972 break;
2973 }
b6a0dc82
MH
2974
2975 hci_proto_connect_cfm(conn, ev->status);
2976 if (ev->status)
2977 hci_conn_del(conn);
2978
2979unlock:
2980 hci_dev_unlock(hdev);
a9de9248
MH
2981}
2982
efdcf8e3
MH
2983static inline size_t eir_get_length(u8 *eir, size_t eir_len)
2984{
2985 size_t parsed = 0;
2986
2987 while (parsed < eir_len) {
2988 u8 field_len = eir[0];
2989
2990 if (field_len == 0)
2991 return parsed;
2992
2993 parsed += field_len + 1;
2994 eir += field_len + 1;
2995 }
2996
2997 return eir_len;
2998}
2999
6039aa73
GP
3000static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
3001 struct sk_buff *skb)
1da177e4 3002{
a9de9248
MH
3003 struct inquiry_data data;
3004 struct extended_inquiry_info *info = (void *) (skb->data + 1);
3005 int num_rsp = *((__u8 *) skb->data);
9d939d94 3006 size_t eir_len;
1da177e4 3007
a9de9248 3008 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1da177e4 3009
a9de9248
MH
3010 if (!num_rsp)
3011 return;
1da177e4 3012
1519cc17
AG
3013 if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
3014 return;
3015
a9de9248
MH
3016 hci_dev_lock(hdev);
3017
e17acd40 3018 for (; num_rsp; num_rsp--, info++) {
388fc8fa 3019 bool name_known, ssp;
561aafbc 3020
a9de9248 3021 bacpy(&data.bdaddr, &info->bdaddr);
138d22ef
SJ
3022 data.pscan_rep_mode = info->pscan_rep_mode;
3023 data.pscan_period_mode = info->pscan_period_mode;
3024 data.pscan_mode = 0x00;
a9de9248 3025 memcpy(data.dev_class, info->dev_class, 3);
138d22ef
SJ
3026 data.clock_offset = info->clock_offset;
3027 data.rssi = info->rssi;
41a96212 3028 data.ssp_mode = 0x01;
561aafbc 3029
a8b2d5c2 3030 if (test_bit(HCI_MGMT, &hdev->dev_flags))
4ddb1930 3031 name_known = eir_has_data_type(info->data,
04124681
GP
3032 sizeof(info->data),
3033 EIR_NAME_COMPLETE);
561aafbc
JH
3034 else
3035 name_known = true;
3036
388fc8fa 3037 name_known = hci_inquiry_cache_update(hdev, &data, name_known,
04124681 3038 &ssp);
9d939d94 3039 eir_len = eir_get_length(info->data, sizeof(info->data));
48264f06 3040 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
04124681 3041 info->dev_class, info->rssi, !name_known,
9d939d94 3042 ssp, info->data, eir_len);
a9de9248
MH
3043 }
3044
3045 hci_dev_unlock(hdev);
3046}
1da177e4 3047
1c2e0041
JH
3048static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
3049 struct sk_buff *skb)
3050{
3051 struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
3052 struct hci_conn *conn;
3053
9f1db00c 3054 BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
1c2e0041
JH
3055 __le16_to_cpu(ev->handle));
3056
3057 hci_dev_lock(hdev);
3058
3059 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3060 if (!conn)
3061 goto unlock;
3062
3063 if (!ev->status)
3064 conn->sec_level = conn->pending_sec_level;
3065
3066 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3067
3068 if (ev->status && conn->state == BT_CONNECTED) {
bed71748 3069 hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
76a68ba0 3070 hci_conn_drop(conn);
1c2e0041
JH
3071 goto unlock;
3072 }
3073
3074 if (conn->state == BT_CONFIG) {
3075 if (!ev->status)
3076 conn->state = BT_CONNECTED;
3077
3078 hci_proto_connect_cfm(conn, ev->status);
76a68ba0 3079 hci_conn_drop(conn);
1c2e0041
JH
3080 } else {
3081 hci_auth_cfm(conn, ev->status);
3082
3083 hci_conn_hold(conn);
3084 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 3085 hci_conn_drop(conn);
1c2e0041
JH
3086 }
3087
3088unlock:
3089 hci_dev_unlock(hdev);
3090}
3091
6039aa73 3092static u8 hci_get_auth_req(struct hci_conn *conn)
17fa4b9d
JH
3093{
3094 /* If remote requests dedicated bonding follow that lead */
acabae96
MA
3095 if (conn->remote_auth == HCI_AT_DEDICATED_BONDING ||
3096 conn->remote_auth == HCI_AT_DEDICATED_BONDING_MITM) {
17fa4b9d
JH
3097 /* If both remote and local IO capabilities allow MITM
3098 * protection then require it, otherwise don't */
acabae96
MA
3099 if (conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT ||
3100 conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)
3101 return HCI_AT_DEDICATED_BONDING;
17fa4b9d 3102 else
acabae96 3103 return HCI_AT_DEDICATED_BONDING_MITM;
17fa4b9d
JH
3104 }
3105
3106 /* If remote requests no-bonding follow that lead */
acabae96
MA
3107 if (conn->remote_auth == HCI_AT_NO_BONDING ||
3108 conn->remote_auth == HCI_AT_NO_BONDING_MITM)
58797bf7 3109 return conn->remote_auth | (conn->auth_type & 0x01);
17fa4b9d
JH
3110
3111 return conn->auth_type;
3112}
3113
6039aa73 3114static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
0493684e
MH
3115{
3116 struct hci_ev_io_capa_request *ev = (void *) skb->data;
3117 struct hci_conn *conn;
3118
3119 BT_DBG("%s", hdev->name);
3120
3121 hci_dev_lock(hdev);
3122
3123 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
03b555e1
JH
3124 if (!conn)
3125 goto unlock;
3126
3127 hci_conn_hold(conn);
3128
a8b2d5c2 3129 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
03b555e1
JH
3130 goto unlock;
3131
a8b2d5c2 3132 if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
807deac2 3133 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
17fa4b9d
JH
3134 struct hci_cp_io_capability_reply cp;
3135
3136 bacpy(&cp.bdaddr, &ev->bdaddr);
7a7f1e7c
HG
3137 /* Change the IO capability from KeyboardDisplay
3138 * to DisplayYesNo as it is not supported by BT spec. */
3139 cp.capability = (conn->io_capability == 0x04) ?
a767631a 3140 HCI_IO_DISPLAY_YESNO : conn->io_capability;
7cbc9bd9
JH
3141 conn->auth_type = hci_get_auth_req(conn);
3142 cp.authentication = conn->auth_type;
17fa4b9d 3143
8fc9ced3
GP
3144 if (hci_find_remote_oob_data(hdev, &conn->dst) &&
3145 (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
ce85ee13
SJ
3146 cp.oob_data = 0x01;
3147 else
3148 cp.oob_data = 0x00;
3149
17fa4b9d 3150 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
807deac2 3151 sizeof(cp), &cp);
03b555e1
JH
3152 } else {
3153 struct hci_cp_io_capability_neg_reply cp;
3154
3155 bacpy(&cp.bdaddr, &ev->bdaddr);
9f5a0d7b 3156 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
0493684e 3157
03b555e1 3158 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
807deac2 3159 sizeof(cp), &cp);
03b555e1
JH
3160 }
3161
3162unlock:
3163 hci_dev_unlock(hdev);
3164}
3165
6039aa73 3166static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
03b555e1
JH
3167{
3168 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
3169 struct hci_conn *conn;
3170
3171 BT_DBG("%s", hdev->name);
3172
3173 hci_dev_lock(hdev);
3174
3175 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3176 if (!conn)
3177 goto unlock;
3178
03b555e1 3179 conn->remote_cap = ev->capability;
03b555e1 3180 conn->remote_auth = ev->authentication;
58a681ef
JH
3181 if (ev->oob_data)
3182 set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
03b555e1
JH
3183
3184unlock:
0493684e
MH
3185 hci_dev_unlock(hdev);
3186}
3187
6039aa73
GP
3188static void hci_user_confirm_request_evt(struct hci_dev *hdev,
3189 struct sk_buff *skb)
a5c29683
JH
3190{
3191 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
55bc1a37 3192 int loc_mitm, rem_mitm, confirm_hint = 0;
7a828908 3193 struct hci_conn *conn;
a5c29683
JH
3194
3195 BT_DBG("%s", hdev->name);
3196
3197 hci_dev_lock(hdev);
3198
a8b2d5c2 3199 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
7a828908 3200 goto unlock;
a5c29683 3201
7a828908
JH
3202 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3203 if (!conn)
3204 goto unlock;
3205
3206 loc_mitm = (conn->auth_type & 0x01);
3207 rem_mitm = (conn->remote_auth & 0x01);
3208
3209 /* If we require MITM but the remote device can't provide that
3210 * (it has NoInputNoOutput) then reject the confirmation
3211 * request. The only exception is when we're dedicated bonding
3212 * initiators (connect_cfm_cb set) since then we always have the MITM
3213 * bit set. */
a767631a
MA
3214 if (!conn->connect_cfm_cb && loc_mitm &&
3215 conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
7a828908
JH
3216 BT_DBG("Rejecting request: remote device can't provide MITM");
3217 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
807deac2 3218 sizeof(ev->bdaddr), &ev->bdaddr);
7a828908
JH
3219 goto unlock;
3220 }
3221
3222 /* If no side requires MITM protection; auto-accept */
a767631a
MA
3223 if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
3224 (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
55bc1a37
JH
3225
3226 /* If we're not the initiators request authorization to
3227 * proceed from user space (mgmt_user_confirm with
3228 * confirm_hint set to 1). */
51a8efd7 3229 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
55bc1a37
JH
3230 BT_DBG("Confirming auto-accept as acceptor");
3231 confirm_hint = 1;
3232 goto confirm;
3233 }
3234
9f61656a 3235 BT_DBG("Auto-accept of user confirmation with %ums delay",
807deac2 3236 hdev->auto_accept_delay);
9f61656a
JH
3237
3238 if (hdev->auto_accept_delay > 0) {
3239 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
7bc18d9d
JH
3240 queue_delayed_work(conn->hdev->workqueue,
3241 &conn->auto_accept_work, delay);
9f61656a
JH
3242 goto unlock;
3243 }
3244
7a828908 3245 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
807deac2 3246 sizeof(ev->bdaddr), &ev->bdaddr);
7a828908
JH
3247 goto unlock;
3248 }
3249
55bc1a37 3250confirm:
272d90df 3251 mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
04124681 3252 confirm_hint);
7a828908
JH
3253
3254unlock:
a5c29683
JH
3255 hci_dev_unlock(hdev);
3256}
3257
6039aa73
GP
3258static void hci_user_passkey_request_evt(struct hci_dev *hdev,
3259 struct sk_buff *skb)
1143d458
BG
3260{
3261 struct hci_ev_user_passkey_req *ev = (void *) skb->data;
3262
3263 BT_DBG("%s", hdev->name);
3264
a8b2d5c2 3265 if (test_bit(HCI_MGMT, &hdev->dev_flags))
272d90df 3266 mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
1143d458
BG
3267}
3268
92a25256
JH
3269static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
3270 struct sk_buff *skb)
3271{
3272 struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
3273 struct hci_conn *conn;
3274
3275 BT_DBG("%s", hdev->name);
3276
3277 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3278 if (!conn)
3279 return;
3280
3281 conn->passkey_notify = __le32_to_cpu(ev->passkey);
3282 conn->passkey_entered = 0;
3283
3284 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3285 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3286 conn->dst_type, conn->passkey_notify,
3287 conn->passkey_entered);
3288}
3289
3290static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
3291{
3292 struct hci_ev_keypress_notify *ev = (void *) skb->data;
3293 struct hci_conn *conn;
3294
3295 BT_DBG("%s", hdev->name);
3296
3297 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3298 if (!conn)
3299 return;
3300
3301 switch (ev->type) {
3302 case HCI_KEYPRESS_STARTED:
3303 conn->passkey_entered = 0;
3304 return;
3305
3306 case HCI_KEYPRESS_ENTERED:
3307 conn->passkey_entered++;
3308 break;
3309
3310 case HCI_KEYPRESS_ERASED:
3311 conn->passkey_entered--;
3312 break;
3313
3314 case HCI_KEYPRESS_CLEARED:
3315 conn->passkey_entered = 0;
3316 break;
3317
3318 case HCI_KEYPRESS_COMPLETED:
3319 return;
3320 }
3321
3322 if (test_bit(HCI_MGMT, &hdev->dev_flags))
3323 mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
3324 conn->dst_type, conn->passkey_notify,
3325 conn->passkey_entered);
3326}
3327
6039aa73
GP
3328static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
3329 struct sk_buff *skb)
0493684e
MH
3330{
3331 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
3332 struct hci_conn *conn;
3333
3334 BT_DBG("%s", hdev->name);
3335
3336 hci_dev_lock(hdev);
3337
3338 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2a611692
JH
3339 if (!conn)
3340 goto unlock;
3341
3342 /* To avoid duplicate auth_failed events to user space we check
3343 * the HCI_CONN_AUTH_PEND flag which will be set if we
3344 * initiated the authentication. A traditional auth_complete
3345 * event gets always produced as initiator and is also mapped to
3346 * the mgmt_auth_failed event */
fa1bd918 3347 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
bab73cb6 3348 mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
04124681 3349 ev->status);
0493684e 3350
76a68ba0 3351 hci_conn_drop(conn);
2a611692
JH
3352
3353unlock:
0493684e
MH
3354 hci_dev_unlock(hdev);
3355}
3356
6039aa73
GP
3357static void hci_remote_host_features_evt(struct hci_dev *hdev,
3358 struct sk_buff *skb)
41a96212
MH
3359{
3360 struct hci_ev_remote_host_features *ev = (void *) skb->data;
3361 struct inquiry_entry *ie;
cad718ed 3362 struct hci_conn *conn;
41a96212
MH
3363
3364 BT_DBG("%s", hdev->name);
3365
3366 hci_dev_lock(hdev);
3367
cad718ed
JH
3368 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3369 if (conn)
3370 memcpy(conn->features[1], ev->features, 8);
3371
cc11b9c1
AE
3372 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
3373 if (ie)
02b7cc62 3374 ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
41a96212
MH
3375
3376 hci_dev_unlock(hdev);
3377}
3378
6039aa73
GP
3379static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
3380 struct sk_buff *skb)
2763eda6
SJ
3381{
3382 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
3383 struct oob_data *data;
3384
3385 BT_DBG("%s", hdev->name);
3386
3387 hci_dev_lock(hdev);
3388
a8b2d5c2 3389 if (!test_bit(HCI_MGMT, &hdev->dev_flags))
e1ba1f15
SJ
3390 goto unlock;
3391
2763eda6
SJ
3392 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
3393 if (data) {
519ca9d0
MH
3394 if (test_bit(HCI_SC_ENABLED, &hdev->dev_flags)) {
3395 struct hci_cp_remote_oob_ext_data_reply cp;
2763eda6 3396
519ca9d0
MH
3397 bacpy(&cp.bdaddr, &ev->bdaddr);
3398 memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
3399 memcpy(cp.randomizer192, data->randomizer192,
3400 sizeof(cp.randomizer192));
3401 memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
3402 memcpy(cp.randomizer256, data->randomizer256,
3403 sizeof(cp.randomizer256));
3404
3405 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
3406 sizeof(cp), &cp);
3407 } else {
3408 struct hci_cp_remote_oob_data_reply cp;
2763eda6 3409
519ca9d0
MH
3410 bacpy(&cp.bdaddr, &ev->bdaddr);
3411 memcpy(cp.hash, data->hash192, sizeof(cp.hash));
3412 memcpy(cp.randomizer, data->randomizer192,
3413 sizeof(cp.randomizer));
3414
3415 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
3416 sizeof(cp), &cp);
3417 }
2763eda6
SJ
3418 } else {
3419 struct hci_cp_remote_oob_data_neg_reply cp;
3420
3421 bacpy(&cp.bdaddr, &ev->bdaddr);
519ca9d0
MH
3422 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
3423 sizeof(cp), &cp);
2763eda6
SJ
3424 }
3425
e1ba1f15 3426unlock:
2763eda6
SJ
3427 hci_dev_unlock(hdev);
3428}
3429
d5e91192
AE
3430static void hci_phy_link_complete_evt(struct hci_dev *hdev,
3431 struct sk_buff *skb)
3432{
3433 struct hci_ev_phy_link_complete *ev = (void *) skb->data;
3434 struct hci_conn *hcon, *bredr_hcon;
3435
3436 BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
3437 ev->status);
3438
3439 hci_dev_lock(hdev);
3440
3441 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3442 if (!hcon) {
3443 hci_dev_unlock(hdev);
3444 return;
3445 }
3446
3447 if (ev->status) {
3448 hci_conn_del(hcon);
3449 hci_dev_unlock(hdev);
3450 return;
3451 }
3452
3453 bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;
3454
3455 hcon->state = BT_CONNECTED;
3456 bacpy(&hcon->dst, &bredr_hcon->dst);
3457
3458 hci_conn_hold(hcon);
3459 hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
76a68ba0 3460 hci_conn_drop(hcon);
d5e91192 3461
d5e91192
AE
3462 hci_conn_add_sysfs(hcon);
3463
cf70ff22 3464 amp_physical_cfm(bredr_hcon, hcon);
d5e91192 3465
cf70ff22 3466 hci_dev_unlock(hdev);
d5e91192
AE
3467}
3468
27695fb4
AE
3469static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
3470{
3471 struct hci_ev_logical_link_complete *ev = (void *) skb->data;
3472 struct hci_conn *hcon;
3473 struct hci_chan *hchan;
3474 struct amp_mgr *mgr;
3475
3476 BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
3477 hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
3478 ev->status);
3479
3480 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3481 if (!hcon)
3482 return;
3483
3484 /* Create AMP hchan */
3485 hchan = hci_chan_create(hcon);
3486 if (!hchan)
3487 return;
3488
3489 hchan->handle = le16_to_cpu(ev->handle);
3490
3491 BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);
3492
3493 mgr = hcon->amp_mgr;
3494 if (mgr && mgr->bredr_chan) {
3495 struct l2cap_chan *bredr_chan = mgr->bredr_chan;
3496
3497 l2cap_chan_lock(bredr_chan);
3498
3499 bredr_chan->conn->mtu = hdev->block_mtu;
3500 l2cap_logical_cfm(bredr_chan, hchan, 0);
3501 hci_conn_hold(hcon);
3502
3503 l2cap_chan_unlock(bredr_chan);
3504 }
3505}
3506
606e2a10
AE
3507static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
3508 struct sk_buff *skb)
3509{
3510 struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
3511 struct hci_chan *hchan;
3512
3513 BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
3514 le16_to_cpu(ev->handle), ev->status);
3515
3516 if (ev->status)
3517 return;
3518
3519 hci_dev_lock(hdev);
3520
3521 hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
3522 if (!hchan)
3523 goto unlock;
3524
3525 amp_destroy_logical_link(hchan, ev->reason);
3526
3527unlock:
3528 hci_dev_unlock(hdev);
3529}
3530
9eef6b3a
AE
3531static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
3532 struct sk_buff *skb)
3533{
3534 struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
3535 struct hci_conn *hcon;
3536
3537 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3538
3539 if (ev->status)
3540 return;
3541
3542 hci_dev_lock(hdev);
3543
3544 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3545 if (hcon) {
3546 hcon->state = BT_CLOSED;
3547 hci_conn_del(hcon);
3548 }
3549
3550 hci_dev_unlock(hdev);
3551}
3552
6039aa73 3553static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
fcd89c09
VT
3554{
3555 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
3556 struct hci_conn *conn;
3557
9f1db00c 3558 BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
fcd89c09
VT
3559
3560 hci_dev_lock(hdev);
3561
b47a09b3 3562 conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
b62f328b
VT
3563 if (!conn) {
3564 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
3565 if (!conn) {
3566 BT_ERR("No memory for new connection");
230fd16a 3567 goto unlock;
b62f328b 3568 }
29b7988a
AG
3569
3570 conn->dst_type = ev->bdaddr_type;
b9b343d2 3571
880be4e8
MH
3572 /* The advertising parameters for own address type
3573 * define which source address and source address
3574 * type this connections has.
3575 */
3576 if (bacmp(&conn->src, BDADDR_ANY)) {
3577 conn->src_type = ADDR_LE_DEV_PUBLIC;
3578 } else {
3579 bacpy(&conn->src, &hdev->static_addr);
3580 conn->src_type = ADDR_LE_DEV_RANDOM;
3581 }
3582
b9b343d2
AG
3583 if (ev->role == LE_CONN_ROLE_MASTER) {
3584 conn->out = true;
3585 conn->link_mode |= HCI_LM_MASTER;
3586 }
b62f328b 3587 }
fcd89c09 3588
cd17decb
AG
3589 if (ev->status) {
3590 mgmt_connect_failed(hdev, &conn->dst, conn->type,
3591 conn->dst_type, ev->status);
3592 hci_proto_connect_cfm(conn, ev->status);
3593 conn->state = BT_CLOSED;
3594 hci_conn_del(conn);
3595 goto unlock;
3596 }
3597
b644ba33
JH
3598 if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3599 mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
04124681 3600 conn->dst_type, 0, NULL, 0, NULL);
83bc71b4 3601
7b5c0d52 3602 conn->sec_level = BT_SECURITY_LOW;
fcd89c09
VT
3603 conn->handle = __le16_to_cpu(ev->handle);
3604 conn->state = BT_CONNECTED;
3605
18722c24
JR
3606 if (test_bit(HCI_6LOWPAN_ENABLED, &hdev->dev_flags))
3607 set_bit(HCI_CONN_6LOWPAN, &conn->flags);
3608
fcd89c09
VT
3609 hci_conn_add_sysfs(conn);
3610
3611 hci_proto_connect_cfm(conn, ev->status);
3612
3613unlock:
3614 hci_dev_unlock(hdev);
3615}
3616
6039aa73 3617static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
9aa04c91 3618{
e95beb41
AG
3619 u8 num_reports = skb->data[0];
3620 void *ptr = &skb->data[1];
3c9e9195 3621 s8 rssi;
9aa04c91 3622
e95beb41
AG
3623 while (num_reports--) {
3624 struct hci_ev_le_advertising_info *ev = ptr;
9aa04c91 3625
3c9e9195
AG
3626 rssi = ev->data[ev->length];
3627 mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
04124681 3628 NULL, rssi, 0, 1, ev->data, ev->length);
3c9e9195 3629
e95beb41 3630 ptr += sizeof(*ev) + ev->length + 1;
9aa04c91 3631 }
9aa04c91
AG
3632}
3633
6039aa73 3634static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
a7a595f6
VCG
3635{
3636 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
3637 struct hci_cp_le_ltk_reply cp;
bea710fe 3638 struct hci_cp_le_ltk_neg_reply neg;
a7a595f6 3639 struct hci_conn *conn;
c9839a11 3640 struct smp_ltk *ltk;
a7a595f6 3641
9f1db00c 3642 BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
a7a595f6
VCG
3643
3644 hci_dev_lock(hdev);
3645
3646 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
bea710fe
VCG
3647 if (conn == NULL)
3648 goto not_found;
a7a595f6 3649
bea710fe
VCG
3650 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
3651 if (ltk == NULL)
3652 goto not_found;
3653
3654 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
a7a595f6 3655 cp.handle = cpu_to_le16(conn->handle);
c9839a11
VCG
3656
3657 if (ltk->authenticated)
f8776218
AG
3658 conn->pending_sec_level = BT_SECURITY_HIGH;
3659 else
3660 conn->pending_sec_level = BT_SECURITY_MEDIUM;
a7a595f6 3661
89cbb4da 3662 conn->enc_key_size = ltk->enc_size;
a7a595f6
VCG
3663
3664 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
3665
c9839a11
VCG
3666 if (ltk->type & HCI_SMP_STK) {
3667 list_del(&ltk->list);
3668 kfree(ltk);
3669 }
3670
a7a595f6 3671 hci_dev_unlock(hdev);
bea710fe
VCG
3672
3673 return;
3674
3675not_found:
3676 neg.handle = ev->handle;
3677 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
3678 hci_dev_unlock(hdev);
a7a595f6
VCG
3679}
3680
6039aa73 3681static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
fcd89c09
VT
3682{
3683 struct hci_ev_le_meta *le_ev = (void *) skb->data;
3684
3685 skb_pull(skb, sizeof(*le_ev));
3686
3687 switch (le_ev->subevent) {
3688 case HCI_EV_LE_CONN_COMPLETE:
3689 hci_le_conn_complete_evt(hdev, skb);
3690 break;
3691
9aa04c91
AG
3692 case HCI_EV_LE_ADVERTISING_REPORT:
3693 hci_le_adv_report_evt(hdev, skb);
3694 break;
3695
a7a595f6
VCG
3696 case HCI_EV_LE_LTK_REQ:
3697 hci_le_ltk_request_evt(hdev, skb);
3698 break;
3699
fcd89c09
VT
3700 default:
3701 break;
3702 }
3703}
3704
9495b2ee
AE
3705static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
3706{
3707 struct hci_ev_channel_selected *ev = (void *) skb->data;
3708 struct hci_conn *hcon;
3709
3710 BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);
3711
3712 skb_pull(skb, sizeof(*ev));
3713
3714 hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
3715 if (!hcon)
3716 return;
3717
3718 amp_read_loc_assoc_final_data(hdev, hcon);
3719}
3720
a9de9248
MH
3721void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
3722{
3723 struct hci_event_hdr *hdr = (void *) skb->data;
3724 __u8 event = hdr->evt;
3725
b6ddb638
JH
3726 hci_dev_lock(hdev);
3727
3728 /* Received events are (currently) only needed when a request is
3729 * ongoing so avoid unnecessary memory allocation.
3730 */
3731 if (hdev->req_status == HCI_REQ_PEND) {
3732 kfree_skb(hdev->recv_evt);
3733 hdev->recv_evt = skb_clone(skb, GFP_KERNEL);
3734 }
3735
3736 hci_dev_unlock(hdev);
3737
a9de9248
MH
3738 skb_pull(skb, HCI_EVENT_HDR_SIZE);
3739
02350a72 3740 if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->req.event == event) {
c1f23a2b
JB
3741 struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
3742 u16 opcode = __le16_to_cpu(cmd_hdr->opcode);
02350a72
JH
3743
3744 hci_req_cmd_complete(hdev, opcode, 0);
3745 }
3746
a9de9248 3747 switch (event) {
1da177e4
LT
3748 case HCI_EV_INQUIRY_COMPLETE:
3749 hci_inquiry_complete_evt(hdev, skb);
3750 break;
3751
3752 case HCI_EV_INQUIRY_RESULT:
3753 hci_inquiry_result_evt(hdev, skb);
3754 break;
3755
a9de9248
MH
3756 case HCI_EV_CONN_COMPLETE:
3757 hci_conn_complete_evt(hdev, skb);
21d9e30e
MH
3758 break;
3759
1da177e4
LT
3760 case HCI_EV_CONN_REQUEST:
3761 hci_conn_request_evt(hdev, skb);
3762 break;
3763
1da177e4
LT
3764 case HCI_EV_DISCONN_COMPLETE:
3765 hci_disconn_complete_evt(hdev, skb);
3766 break;
3767
1da177e4
LT
3768 case HCI_EV_AUTH_COMPLETE:
3769 hci_auth_complete_evt(hdev, skb);
3770 break;
3771
a9de9248
MH
3772 case HCI_EV_REMOTE_NAME:
3773 hci_remote_name_evt(hdev, skb);
3774 break;
3775
1da177e4
LT
3776 case HCI_EV_ENCRYPT_CHANGE:
3777 hci_encrypt_change_evt(hdev, skb);
3778 break;
3779
a9de9248
MH
3780 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3781 hci_change_link_key_complete_evt(hdev, skb);
3782 break;
3783
3784 case HCI_EV_REMOTE_FEATURES:
3785 hci_remote_features_evt(hdev, skb);
3786 break;
3787
a9de9248
MH
3788 case HCI_EV_CMD_COMPLETE:
3789 hci_cmd_complete_evt(hdev, skb);
3790 break;
3791
3792 case HCI_EV_CMD_STATUS:
3793 hci_cmd_status_evt(hdev, skb);
3794 break;
3795
3796 case HCI_EV_ROLE_CHANGE:
3797 hci_role_change_evt(hdev, skb);
3798 break;
3799
3800 case HCI_EV_NUM_COMP_PKTS:
3801 hci_num_comp_pkts_evt(hdev, skb);
3802 break;
3803
3804 case HCI_EV_MODE_CHANGE:
3805 hci_mode_change_evt(hdev, skb);
1da177e4
LT
3806 break;
3807
3808 case HCI_EV_PIN_CODE_REQ:
3809 hci_pin_code_request_evt(hdev, skb);
3810 break;
3811
3812 case HCI_EV_LINK_KEY_REQ:
3813 hci_link_key_request_evt(hdev, skb);
3814 break;
3815
3816 case HCI_EV_LINK_KEY_NOTIFY:
3817 hci_link_key_notify_evt(hdev, skb);
3818 break;
3819
3820 case HCI_EV_CLOCK_OFFSET:
3821 hci_clock_offset_evt(hdev, skb);
3822 break;
3823
a8746417
MH
3824 case HCI_EV_PKT_TYPE_CHANGE:
3825 hci_pkt_type_change_evt(hdev, skb);
3826 break;
3827
85a1e930
MH
3828 case HCI_EV_PSCAN_REP_MODE:
3829 hci_pscan_rep_mode_evt(hdev, skb);
3830 break;
3831
a9de9248
MH
3832 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3833 hci_inquiry_result_with_rssi_evt(hdev, skb);
04837f64
MH
3834 break;
3835
a9de9248
MH
3836 case HCI_EV_REMOTE_EXT_FEATURES:
3837 hci_remote_ext_features_evt(hdev, skb);
1da177e4
LT
3838 break;
3839
a9de9248
MH
3840 case HCI_EV_SYNC_CONN_COMPLETE:
3841 hci_sync_conn_complete_evt(hdev, skb);
3842 break;
1da177e4 3843
a9de9248
MH
3844 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3845 hci_extended_inquiry_result_evt(hdev, skb);
3846 break;
1da177e4 3847
1c2e0041
JH
3848 case HCI_EV_KEY_REFRESH_COMPLETE:
3849 hci_key_refresh_complete_evt(hdev, skb);
3850 break;
3851
0493684e
MH
3852 case HCI_EV_IO_CAPA_REQUEST:
3853 hci_io_capa_request_evt(hdev, skb);
3854 break;
3855
03b555e1
JH
3856 case HCI_EV_IO_CAPA_REPLY:
3857 hci_io_capa_reply_evt(hdev, skb);
3858 break;
3859
a5c29683
JH
3860 case HCI_EV_USER_CONFIRM_REQUEST:
3861 hci_user_confirm_request_evt(hdev, skb);
3862 break;
3863
1143d458
BG
3864 case HCI_EV_USER_PASSKEY_REQUEST:
3865 hci_user_passkey_request_evt(hdev, skb);
3866 break;
3867
92a25256
JH
3868 case HCI_EV_USER_PASSKEY_NOTIFY:
3869 hci_user_passkey_notify_evt(hdev, skb);
3870 break;
3871
3872 case HCI_EV_KEYPRESS_NOTIFY:
3873 hci_keypress_notify_evt(hdev, skb);
3874 break;
3875
0493684e
MH
3876 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3877 hci_simple_pair_complete_evt(hdev, skb);
3878 break;
3879
41a96212
MH
3880 case HCI_EV_REMOTE_HOST_FEATURES:
3881 hci_remote_host_features_evt(hdev, skb);
3882 break;
3883
fcd89c09
VT
3884 case HCI_EV_LE_META:
3885 hci_le_meta_evt(hdev, skb);
3886 break;
3887
9495b2ee
AE
3888 case HCI_EV_CHANNEL_SELECTED:
3889 hci_chan_selected_evt(hdev, skb);
3890 break;
3891
2763eda6
SJ
3892 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3893 hci_remote_oob_data_request_evt(hdev, skb);
3894 break;
3895
d5e91192
AE
3896 case HCI_EV_PHY_LINK_COMPLETE:
3897 hci_phy_link_complete_evt(hdev, skb);
3898 break;
3899
27695fb4
AE
3900 case HCI_EV_LOGICAL_LINK_COMPLETE:
3901 hci_loglink_complete_evt(hdev, skb);
3902 break;
3903
606e2a10
AE
3904 case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
3905 hci_disconn_loglink_complete_evt(hdev, skb);
3906 break;
3907
9eef6b3a
AE
3908 case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
3909 hci_disconn_phylink_complete_evt(hdev, skb);
3910 break;
3911
25e89e99
AE
3912 case HCI_EV_NUM_COMP_BLOCKS:
3913 hci_num_comp_blocks_evt(hdev, skb);
3914 break;
3915
a9de9248 3916 default:
9f1db00c 3917 BT_DBG("%s event 0x%2.2x", hdev->name, event);
1da177e4
LT
3918 break;
3919 }
3920
3921 kfree_skb(skb);
3922 hdev->stat.evt_rx++;
3923}