projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
mwifiex: prevent corruption instead of just warning
[GitHub/mt8127/android_kernel_alcatel_ttab.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 <linux/module.h>
28
29#include <linux/types.h>
30#include <linux/errno.h>
31#include <linux/kernel.h>
1da177e4
LT		 32#include <linux/slab.h>
33#include <linux/poll.h>
34#include <linux/fcntl.h>
35#include <linux/init.h>
36#include <linux/skbuff.h>
37#include <linux/interrupt.h>
38#include <linux/notifier.h>
39#include <net/sock.h>
40
41#include <asm/system.h>
70f23020 42#include <linux/uaccess.h>
1da177e4
LT		 43#include <asm/unaligned.h>
44
45#include <net/bluetooth/bluetooth.h>
46#include <net/bluetooth/hci_core.h>
47
e6100a25
AG		 48static int enable_le;
49
1da177e4
LT		 50/* Handle HCI Event packets */
51
a9de9248 52static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 53{
a9de9248 54 __u8 status = *((__u8 *) skb->data);
1da177e4 55
a9de9248 56 BT_DBG("%s status 0x%x", hdev->name, status);
1da177e4 57
a9de9248
MH		 58 if (status)
59 return;
1da177e4 60
89352e7d
AG		 61 clear_bit(HCI_INQUIRY, &hdev->flags);
62
56e5cb86 63 hci_dev_lock(hdev);
744cf19e 64 mgmt_discovering(hdev, 0);
56e5cb86 65 hci_dev_unlock(hdev);
6bd57416 66
23bb5763 67 hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
a9de9248
MH		 68
69 hci_conn_check_pending(hdev);
70}
6bd57416 71
a9de9248
MH		 72static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
73{
74 __u8 status = *((__u8 *) skb->data);
6bd57416 75
a9de9248 76 BT_DBG("%s status 0x%x", hdev->name, status);
6bd57416 77
a9de9248
MH		 78 if (status)
79 return;
1da177e4 80
a9de9248
MH		 81 hci_conn_check_pending(hdev);
82}
83
84static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
85{
86 BT_DBG("%s", hdev->name);
87}
88
89static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
90{
91 struct hci_rp_role_discovery *rp = (void *) skb->data;
92 struct hci_conn *conn;
93
94 BT_DBG("%s status 0x%x", hdev->name, rp->status);
95
96 if (rp->status)
97 return;
98
99 hci_dev_lock(hdev);
100
101 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
102 if (conn) {
103 if (rp->role)
104 conn->link_mode &= ~HCI_LM_MASTER;
105 else
106 conn->link_mode |= HCI_LM_MASTER;
1da177e4 107 }
a9de9248
MH		 108
109 hci_dev_unlock(hdev);
1da177e4
LT		 110}
111
e4e8e37c
MH		 112static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
113{
114 struct hci_rp_read_link_policy *rp = (void *) skb->data;
115 struct hci_conn *conn;
116
117 BT_DBG("%s status 0x%x", hdev->name, rp->status);
118
119 if (rp->status)
120 return;
121
122 hci_dev_lock(hdev);
123
124 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
125 if (conn)
126 conn->link_policy = __le16_to_cpu(rp->policy);
127
128 hci_dev_unlock(hdev);
129}
130
a9de9248 131static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 132{
a9de9248 133 struct hci_rp_write_link_policy *rp = (void *) skb->data;
1da177e4 134 struct hci_conn *conn;
04837f64 135 void *sent;
1da177e4 136
a9de9248 137 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1da177e4 138
a9de9248
MH		 139 if (rp->status)
140 return;
1da177e4 141
a9de9248
MH		 142 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
143 if (!sent)
144 return;
1da177e4 145
a9de9248 146 hci_dev_lock(hdev);
1da177e4 147
a9de9248 148 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
e4e8e37c 149 if (conn)
83985319 150 conn->link_policy = get_unaligned_le16(sent + 2);
1da177e4 151
a9de9248
MH		 152 hci_dev_unlock(hdev);
153}
1da177e4 154
e4e8e37c
MH		 155static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
156{
157 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
158
159 BT_DBG("%s status 0x%x", hdev->name, rp->status);
160
161 if (rp->status)
162 return;
163
164 hdev->link_policy = __le16_to_cpu(rp->policy);
165}
166
167static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
168{
169 __u8 status = *((__u8 *) skb->data);
170 void *sent;
171
172 BT_DBG("%s status 0x%x", hdev->name, status);
173
174 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
175 if (!sent)
176 return;
177
178 if (!status)
179 hdev->link_policy = get_unaligned_le16(sent);
180
23bb5763 181 hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
e4e8e37c
MH		 182}
183
a9de9248
MH		 184static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
185{
186 __u8 status = *((__u8 *) skb->data);
04837f64 187
a9de9248 188 BT_DBG("%s status 0x%x", hdev->name, status);
04837f64 189
10572132
GP		 190 clear_bit(HCI_RESET, &hdev->flags);
191
23bb5763 192 hci_req_complete(hdev, HCI_OP_RESET, status);
a9de9248 193}
04837f64 194
a9de9248
MH		 195static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
196{
197 __u8 status = *((__u8 *) skb->data);
198 void *sent;
04837f64 199
a9de9248 200 BT_DBG("%s status 0x%x", hdev->name, status);
04837f64 201
a9de9248
MH		 202 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
203 if (!sent)
204 return;
04837f64 205
56e5cb86
JH		 206 hci_dev_lock(hdev);
207
b312b161 208 if (test_bit(HCI_MGMT, &hdev->flags))
744cf19e 209 mgmt_set_local_name_complete(hdev, sent, status);
b312b161 210
56e5cb86
JH		 211 if (status == 0)
212 memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
b312b161 213
56e5cb86 214 hci_dev_unlock(hdev);
a9de9248
MH		 215}
216
217static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
218{
219 struct hci_rp_read_local_name *rp = (void *) skb->data;
220
221 BT_DBG("%s status 0x%x", hdev->name, rp->status);
222
223 if (rp->status)
224 return;
225
1f6c6378 226 memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
a9de9248
MH		 227}
228
229static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
230{
231 __u8 status = *((__u8 *) skb->data);
232 void *sent;
233
234 BT_DBG("%s status 0x%x", hdev->name, status);
235
236 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
237 if (!sent)
238 return;
239
240 if (!status) {
241 __u8 param = *((__u8 *) sent);
242
243 if (param == AUTH_ENABLED)
244 set_bit(HCI_AUTH, &hdev->flags);
245 else
246 clear_bit(HCI_AUTH, &hdev->flags);
1da177e4 247 }
a9de9248 248
23bb5763 249 hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
1da177e4
LT		 250}
251
a9de9248 252static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 253{
a9de9248 254 __u8 status = *((__u8 *) skb->data);
1da177e4
LT		 255 void *sent;
256
a9de9248 257 BT_DBG("%s status 0x%x", hdev->name, status);
1da177e4 258
a9de9248
MH		 259 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
260 if (!sent)
261 return;
1da177e4 262
a9de9248
MH		 263 if (!status) {
264 __u8 param = *((__u8 *) sent);
265
266 if (param)
267 set_bit(HCI_ENCRYPT, &hdev->flags);
268 else
269 clear_bit(HCI_ENCRYPT, &hdev->flags);
270 }
1da177e4 271
23bb5763 272 hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
a9de9248 273}
1da177e4 274
a9de9248
MH		 275static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
276{
36f7fc7e
JH		 277 __u8 param, status = *((__u8 *) skb->data);
278 int old_pscan, old_iscan;
a9de9248 279 void *sent;
1da177e4 280
a9de9248 281 BT_DBG("%s status 0x%x", hdev->name, status);
1da177e4 282
a9de9248
MH		 283 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
284 if (!sent)
285 return;
1da177e4 286
36f7fc7e
JH		 287 param = *((__u8 *) sent);
288
56e5cb86
JH		 289 hci_dev_lock(hdev);
290
2d7cee58 291 if (status != 0) {
744cf19e 292 mgmt_write_scan_failed(hdev, param, status);
2d7cee58
JH		 293 hdev->discov_timeout = 0;
294 goto done;
295 }
296
36f7fc7e
JH		 297 old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
298 old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);
299
300 if (param & SCAN_INQUIRY) {
301 set_bit(HCI_ISCAN, &hdev->flags);
302 if (!old_iscan)
744cf19e 303 mgmt_discoverable(hdev, 1);
16ab91ab
JH		 304 if (hdev->discov_timeout > 0) {
305 int to = msecs_to_jiffies(hdev->discov_timeout * 1000);
306 queue_delayed_work(hdev->workqueue, &hdev->discov_off,
307 to);
308 }
36f7fc7e 309 } else if (old_iscan)
744cf19e 310 mgmt_discoverable(hdev, 0);
36f7fc7e
JH		 311
312 if (param & SCAN_PAGE) {
313 set_bit(HCI_PSCAN, &hdev->flags);
314 if (!old_pscan)
744cf19e 315 mgmt_connectable(hdev, 1);
36f7fc7e 316 } else if (old_pscan)
744cf19e 317 mgmt_connectable(hdev, 0);
1da177e4 318
36f7fc7e 319done:
56e5cb86 320 hci_dev_unlock(hdev);
23bb5763 321 hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
a9de9248 322}
1da177e4 323
a9de9248
MH		 324static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
325{
326 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
1da177e4 327
a9de9248 328 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1da177e4 329
a9de9248
MH		 330 if (rp->status)
331 return;
1da177e4 332
a9de9248 333 memcpy(hdev->dev_class, rp->dev_class, 3);
1da177e4 334
a9de9248
MH		 335 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
336 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
337}
1da177e4 338
a9de9248
MH		 339static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
340{
341 __u8 status = *((__u8 *) skb->data);
342 void *sent;
1da177e4 343
a9de9248 344 BT_DBG("%s status 0x%x", hdev->name, status);
1da177e4 345
f383f275
MH		 346 if (status)
347 return;
348
a9de9248
MH		 349 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
350 if (!sent)
351 return;
1da177e4 352
f383f275 353 memcpy(hdev->dev_class, sent, 3);
a9de9248 354}
1da177e4 355
a9de9248
MH		 356static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
357{
358 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
359 __u16 setting;
360
361 BT_DBG("%s status 0x%x", hdev->name, rp->status);
362
363 if (rp->status)
364 return;
365
366 setting = __le16_to_cpu(rp->voice_setting);
367
f383f275 368 if (hdev->voice_setting == setting)
a9de9248
MH		 369 return;
370
371 hdev->voice_setting = setting;
372
373 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
374
375 if (hdev->notify) {
376 tasklet_disable(&hdev->tx_task);
377 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
378 tasklet_enable(&hdev->tx_task);
379 }
380}
381
382static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
383{
384 __u8 status = *((__u8 *) skb->data);
f383f275 385 __u16 setting;
a9de9248
MH		 386 void *sent;
387
388 BT_DBG("%s status 0x%x", hdev->name, status);
1da177e4 389
f383f275
MH		 390 if (status)
391 return;
392
a9de9248
MH		 393 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
394 if (!sent)
395 return;
1da177e4 396
f383f275 397 setting = get_unaligned_le16(sent);
1da177e4 398
f383f275
MH		 399 if (hdev->voice_setting == setting)
400 return;
401
402 hdev->voice_setting = setting;
1da177e4 403
f383f275 404 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
1da177e4 405
f383f275
MH		 406 if (hdev->notify) {
407 tasklet_disable(&hdev->tx_task);
408 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
409 tasklet_enable(&hdev->tx_task);
1da177e4
LT		 410 }
411}
412
a9de9248 413static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 414{
a9de9248 415 __u8 status = *((__u8 *) skb->data);
1da177e4 416
a9de9248 417 BT_DBG("%s status 0x%x", hdev->name, status);
1da177e4 418
23bb5763 419 hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
a9de9248 420}
1143e5a6 421
333140b5
MH		 422static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
423{
424 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
425
426 BT_DBG("%s status 0x%x", hdev->name, rp->status);
427
428 if (rp->status)
429 return;
430
431 hdev->ssp_mode = rp->mode;
432}
433
434static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
435{
436 __u8 status = *((__u8 *) skb->data);
437 void *sent;
438
439 BT_DBG("%s status 0x%x", hdev->name, status);
440
441 if (status)
442 return;
443
444 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
445 if (!sent)
446 return;
447
448 hdev->ssp_mode = *((__u8 *) sent);
449}
450
d5859e22
JH		 451static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
452{
453 if (hdev->features[6] & LMP_EXT_INQ)
454 return 2;
455
456 if (hdev->features[3] & LMP_RSSI_INQ)
457 return 1;
458
459 if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
460 hdev->lmp_subver == 0x0757)
461 return 1;
462
463 if (hdev->manufacturer == 15) {
464 if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
465 return 1;
466 if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
467 return 1;
468 if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
469 return 1;
470 }
471
472 if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
473 hdev->lmp_subver == 0x1805)
474 return 1;
475
476 return 0;
477}
478
479static void hci_setup_inquiry_mode(struct hci_dev *hdev)
480{
481 u8 mode;
482
483 mode = hci_get_inquiry_mode(hdev);
484
485 hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
486}
487
488static void hci_setup_event_mask(struct hci_dev *hdev)
489{
490 /* The second byte is 0xff instead of 0x9f (two reserved bits
491 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
492 * command otherwise */
493 u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };
494
6de6c18d
VT		 495 /* CSR 1.1 dongles does not accept any bitfield so don't try to set
496 * any event mask for pre 1.2 devices */
497 if (hdev->lmp_ver <= 1)
498 return;
499
500 events[4] |= 0x01; /* Flow Specification Complete */
501 events[4] |= 0x02; /* Inquiry Result with RSSI */
502 events[4] |= 0x04; /* Read Remote Extended Features Complete */
503 events[5] |= 0x08; /* Synchronous Connection Complete */
504 events[5] |= 0x10; /* Synchronous Connection Changed */
d5859e22
JH		 505
506 if (hdev->features[3] & LMP_RSSI_INQ)
507 events[4] |= 0x04; /* Inquiry Result with RSSI */
508
509 if (hdev->features[5] & LMP_SNIFF_SUBR)
510 events[5] |= 0x20; /* Sniff Subrating */
511
512 if (hdev->features[5] & LMP_PAUSE_ENC)
513 events[5] |= 0x80; /* Encryption Key Refresh Complete */
514
515 if (hdev->features[6] & LMP_EXT_INQ)
516 events[5] |= 0x40; /* Extended Inquiry Result */
517
518 if (hdev->features[6] & LMP_NO_FLUSH)
519 events[7] |= 0x01; /* Enhanced Flush Complete */
520
521 if (hdev->features[7] & LMP_LSTO)
522 events[6] |= 0x80; /* Link Supervision Timeout Changed */
523
524 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
525 events[6] |= 0x01; /* IO Capability Request */
526 events[6] |= 0x02; /* IO Capability Response */
527 events[6] |= 0x04; /* User Confirmation Request */
528 events[6] |= 0x08; /* User Passkey Request */
529 events[6] |= 0x10; /* Remote OOB Data Request */
530 events[6] |= 0x20; /* Simple Pairing Complete */
531 events[7] |= 0x04; /* User Passkey Notification */
532 events[7] |= 0x08; /* Keypress Notification */
533 events[7] |= 0x10; /* Remote Host Supported
534 * Features Notification */
535 }
536
537 if (hdev->features[4] & LMP_LE)
538 events[7] |= 0x20; /* LE Meta-Event */
539
540 hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
541}
542
e6100a25
AG		 543static void hci_set_le_support(struct hci_dev *hdev)
544{
545 struct hci_cp_write_le_host_supported cp;
546
547 memset(&cp, 0, sizeof(cp));
548
549 if (enable_le) {
550 cp.le = 1;
551 cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
552 }
553
554 hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp), &cp);
555}
556
d5859e22
JH		 557static void hci_setup(struct hci_dev *hdev)
558{
559 hci_setup_event_mask(hdev);
560
561 if (hdev->lmp_ver > 1)
562 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);
563
564 if (hdev->features[6] & LMP_SIMPLE_PAIR) {
565 u8 mode = 0x01;
566 hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE, sizeof(mode), &mode);
567 }
568
569 if (hdev->features[3] & LMP_RSSI_INQ)
570 hci_setup_inquiry_mode(hdev);
571
572 if (hdev->features[7] & LMP_INQ_TX_PWR)
573 hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
971e3a4b
AG		 574
575 if (hdev->features[7] & LMP_EXTFEATURES) {
576 struct hci_cp_read_local_ext_features cp;
577
578 cp.page = 0x01;
579 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES,
580 sizeof(cp), &cp);
581 }
e6100a25
AG		 582
583 if (hdev->features[4] & LMP_LE)
584 hci_set_le_support(hdev);
d5859e22
JH		 585}
586
a9de9248
MH		 587static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
588{
589 struct hci_rp_read_local_version *rp = (void *) skb->data;
1143e5a6 590
a9de9248 591 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1143e5a6 592
a9de9248
MH		 593 if (rp->status)
594 return;
1143e5a6 595
a9de9248 596 hdev->hci_ver = rp->hci_ver;
e4e8e37c 597 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
d5859e22 598 hdev->lmp_ver = rp->lmp_ver;
e4e8e37c 599 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
d5859e22 600 hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
1143e5a6 601
a9de9248
MH		 602 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
603 hdev->manufacturer,
604 hdev->hci_ver, hdev->hci_rev);
d5859e22
JH		 605
606 if (test_bit(HCI_INIT, &hdev->flags))
607 hci_setup(hdev);
608}
609
610static void hci_setup_link_policy(struct hci_dev *hdev)
611{
612 u16 link_policy = 0;
613
614 if (hdev->features[0] & LMP_RSWITCH)
615 link_policy |= HCI_LP_RSWITCH;
616 if (hdev->features[0] & LMP_HOLD)
617 link_policy |= HCI_LP_HOLD;
618 if (hdev->features[0] & LMP_SNIFF)
619 link_policy |= HCI_LP_SNIFF;
620 if (hdev->features[1] & LMP_PARK)
621 link_policy |= HCI_LP_PARK;
622
623 link_policy = cpu_to_le16(link_policy);
624 hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY,
625 sizeof(link_policy), &link_policy);
a9de9248 626}
1da177e4 627
a9de9248
MH		 628static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
629{
630 struct hci_rp_read_local_commands *rp = (void *) skb->data;
1da177e4 631
a9de9248 632 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1da177e4 633
a9de9248 634 if (rp->status)
d5859e22 635 goto done;
1da177e4 636
a9de9248 637 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
d5859e22
JH		 638
639 if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
640 hci_setup_link_policy(hdev);
641
642done:
643 hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
a9de9248 644}
1da177e4 645
a9de9248
MH		 646static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
647{
648 struct hci_rp_read_local_features *rp = (void *) skb->data;
5b7f9909 649
a9de9248 650 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1da177e4 651
a9de9248
MH		 652 if (rp->status)
653 return;
5b7f9909 654
a9de9248 655 memcpy(hdev->features, rp->features, 8);
5b7f9909 656
a9de9248
MH		 657 /* Adjust default settings according to features
658 * supported by device. */
1da177e4 659
a9de9248
MH		 660 if (hdev->features[0] & LMP_3SLOT)
661 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
1da177e4 662
a9de9248
MH		 663 if (hdev->features[0] & LMP_5SLOT)
664 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
1da177e4 665
a9de9248
MH		 666 if (hdev->features[1] & LMP_HV2) {
667 hdev->pkt_type |= (HCI_HV2);
668 hdev->esco_type |= (ESCO_HV2);
669 }
1da177e4 670
a9de9248
MH		 671 if (hdev->features[1] & LMP_HV3) {
672 hdev->pkt_type |= (HCI_HV3);
673 hdev->esco_type |= (ESCO_HV3);
674 }
1da177e4 675
a9de9248
MH		 676 if (hdev->features[3] & LMP_ESCO)
677 hdev->esco_type |= (ESCO_EV3);
da1f5198 678
a9de9248
MH		 679 if (hdev->features[4] & LMP_EV4)
680 hdev->esco_type |= (ESCO_EV4);
da1f5198 681
a9de9248
MH		 682 if (hdev->features[4] & LMP_EV5)
683 hdev->esco_type |= (ESCO_EV5);
1da177e4 684
efc7688b
MH		 685 if (hdev->features[5] & LMP_EDR_ESCO_2M)
686 hdev->esco_type |= (ESCO_2EV3);
687
688 if (hdev->features[5] & LMP_EDR_ESCO_3M)
689 hdev->esco_type |= (ESCO_3EV3);
690
691 if (hdev->features[5] & LMP_EDR_3S_ESCO)
692 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
693
a9de9248
MH		 694 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
695 hdev->features[0], hdev->features[1],
696 hdev->features[2], hdev->features[3],
697 hdev->features[4], hdev->features[5],
698 hdev->features[6], hdev->features[7]);
699}
1da177e4 700
971e3a4b
AG		 701static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
702 struct sk_buff *skb)
703{
704 struct hci_rp_read_local_ext_features *rp = (void *) skb->data;
705
706 BT_DBG("%s status 0x%x", hdev->name, rp->status);
707
708 if (rp->status)
709 return;
710
711 memcpy(hdev->extfeatures, rp->features, 8);
712
713 hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
714}
715
a9de9248
MH		 716static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
717{
718 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
1da177e4 719
a9de9248 720 BT_DBG("%s status 0x%x", hdev->name, rp->status);
1da177e4 721
a9de9248
MH		 722 if (rp->status)
723 return;
1da177e4 724
a9de9248
MH		 725 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
726 hdev->sco_mtu = rp->sco_mtu;
727 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
728 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
729
730 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
731 hdev->sco_mtu = 64;
732 hdev->sco_pkts = 8;
1da177e4 733 }
a9de9248
MH		 734
735 hdev->acl_cnt = hdev->acl_pkts;
736 hdev->sco_cnt = hdev->sco_pkts;
737
738 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
739 hdev->acl_mtu, hdev->acl_pkts,
740 hdev->sco_mtu, hdev->sco_pkts);
741}
742
743static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
744{
745 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
746
747 BT_DBG("%s status 0x%x", hdev->name, rp->status);
748
749 if (!rp->status)
750 bacpy(&hdev->bdaddr, &rp->bdaddr);
751
23bb5763
JH		 752 hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
753}
754
755static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
756{
757 __u8 status = *((__u8 *) skb->data);
758
759 BT_DBG("%s status 0x%x", hdev->name, status);
760
761 hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
a9de9248
MH		 762}
763
928abaa7
AE		 764static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
765 struct sk_buff *skb)
766{
767 struct hci_rp_read_local_amp_info *rp = (void *) skb->data;
768
769 BT_DBG("%s status 0x%x", hdev->name, rp->status);
770
771 if (rp->status)
772 return;
773
774 hdev->amp_status = rp->amp_status;
775 hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
776 hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
777 hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
778 hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
779 hdev->amp_type = rp->amp_type;
780 hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
781 hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
782 hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
783 hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
784
785 hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
786}
787
b0916ea0
JH		 788static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
789 struct sk_buff *skb)
790{
791 __u8 status = *((__u8 *) skb->data);
792
793 BT_DBG("%s status 0x%x", hdev->name, status);
794
795 hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
796}
797
d5859e22
JH		 798static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
799{
800 __u8 status = *((__u8 *) skb->data);
801
802 BT_DBG("%s status 0x%x", hdev->name, status);
803
804 hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
805}
806
807static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
808 struct sk_buff *skb)
809{
810 __u8 status = *((__u8 *) skb->data);
811
812 BT_DBG("%s status 0x%x", hdev->name, status);
813
814 hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
815}
816
817static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
818 struct sk_buff *skb)
819{
820 __u8 status = *((__u8 *) skb->data);
821
822 BT_DBG("%s status 0x%x", hdev->name, status);
823
824 hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, status);
825}
826
827static void hci_cc_set_event_flt(struct hci_dev *hdev, struct sk_buff *skb)
828{
829 __u8 status = *((__u8 *) skb->data);
830
831 BT_DBG("%s status 0x%x", hdev->name, status);
832
833 hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
834}
835
980e1a53
JH		 836static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
837{
838 struct hci_rp_pin_code_reply *rp = (void *) skb->data;
839 struct hci_cp_pin_code_reply *cp;
840 struct hci_conn *conn;
841
842 BT_DBG("%s status 0x%x", hdev->name, rp->status);
843
56e5cb86
JH		 844 hci_dev_lock(hdev);
845
980e1a53 846 if (test_bit(HCI_MGMT, &hdev->flags))
744cf19e 847 mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
980e1a53
JH		 848
849 if (rp->status != 0)
56e5cb86 850 goto unlock;
980e1a53
JH		 851
852 cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
853 if (!cp)
56e5cb86 854 goto unlock;
980e1a53
JH		 855
856 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
857 if (conn)
858 conn->pin_length = cp->pin_len;
56e5cb86
JH		 859
860unlock:
861 hci_dev_unlock(hdev);
980e1a53
JH		 862}
863
864static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
865{
866 struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;
867
868 BT_DBG("%s status 0x%x", hdev->name, rp->status);
869
56e5cb86
JH		 870 hci_dev_lock(hdev);
871
980e1a53 872 if (test_bit(HCI_MGMT, &hdev->flags))
744cf19e 873 mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
980e1a53 874 rp->status);
56e5cb86
JH		 875
876 hci_dev_unlock(hdev);
980e1a53 877}
56e5cb86 878
6ed58ec5
VT		 879static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
880 struct sk_buff *skb)
881{
882 struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;
883
884 BT_DBG("%s status 0x%x", hdev->name, rp->status);
885
886 if (rp->status)
887 return;
888
889 hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
890 hdev->le_pkts = rp->le_max_pkt;
891
892 hdev->le_cnt = hdev->le_pkts;
893
894 BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
895
896 hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
897}
980e1a53 898
a5c29683
JH		 899static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
900{
901 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
902
903 BT_DBG("%s status 0x%x", hdev->name, rp->status);
904
56e5cb86
JH		 905 hci_dev_lock(hdev);
906
a5c29683 907 if (test_bit(HCI_MGMT, &hdev->flags))
744cf19e 908 mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr,
a5c29683 909 rp->status);
56e5cb86
JH		 910
911 hci_dev_unlock(hdev);
a5c29683
JH		 912}
913
914static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
915 struct sk_buff *skb)
916{
917 struct hci_rp_user_confirm_reply *rp = (void *) skb->data;
918
919 BT_DBG("%s status 0x%x", hdev->name, rp->status);
920
56e5cb86
JH		 921 hci_dev_lock(hdev);
922
a5c29683 923 if (test_bit(HCI_MGMT, &hdev->flags))
744cf19e 924 mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
a5c29683 925 rp->status);
56e5cb86
JH		 926
927 hci_dev_unlock(hdev);
a5c29683
JH		 928}
929
c35938b2
SJ		 930static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
931 struct sk_buff *skb)
932{
933 struct hci_rp_read_local_oob_data *rp = (void *) skb->data;
934
935 BT_DBG("%s status 0x%x", hdev->name, rp->status);
936
56e5cb86 937 hci_dev_lock(hdev);
744cf19e 938 mgmt_read_local_oob_data_reply_complete(hdev, rp->hash,
c35938b2 939 rp->randomizer, rp->status);
56e5cb86 940 hci_dev_unlock(hdev);
c35938b2
SJ		 941}
942
eb9d91f5
AG		 943static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
944 struct sk_buff *skb)
945{
946 struct hci_cp_le_set_scan_enable *cp;
947 __u8 status = *((__u8 *) skb->data);
948
949 BT_DBG("%s status 0x%x", hdev->name, status);
950
951 if (status)
952 return;
953
954 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
955 if (!cp)
956 return;
957
35815085
AG		 958 if (cp->enable == 0x01) {
959 del_timer(&hdev->adv_timer);
a8f13c8c
AG		 960
961 hci_dev_lock(hdev);
eb9d91f5 962 hci_adv_entries_clear(hdev);
a8f13c8c 963 hci_dev_unlock(hdev);
35815085
AG		 964 } else if (cp->enable == 0x00) {
965 mod_timer(&hdev->adv_timer, jiffies + ADV_CLEAR_TIMEOUT);
966 }
eb9d91f5
AG		 967}
968
a7a595f6
VCG		 969static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
970{
971 struct hci_rp_le_ltk_reply *rp = (void *) skb->data;
972
973 BT_DBG("%s status 0x%x", hdev->name, rp->status);
974
975 if (rp->status)
976 return;
977
978 hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
979}
980
981static void hci_cc_le_ltk_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
982{
983 struct hci_rp_le_ltk_neg_reply *rp = (void *) skb->data;
984
985 BT_DBG("%s status 0x%x", hdev->name, rp->status);
986
987 if (rp->status)
988 return;
989
990 hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
991}
992
f9b49306
AG		 993static inline void hci_cc_write_le_host_supported(struct hci_dev *hdev,
994 struct sk_buff *skb)
995{
996 struct hci_cp_read_local_ext_features cp;
997 __u8 status = *((__u8 *) skb->data);
998
999 BT_DBG("%s status 0x%x", hdev->name, status);
1000
1001 if (status)
1002 return;
1003
1004 cp.page = 0x01;
1005 hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp), &cp);
1006}
1007
a9de9248
MH		 1008static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
1009{
1010 BT_DBG("%s status 0x%x", hdev->name, status);
1011
1012 if (status) {
23bb5763 1013 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
a9de9248 1014 hci_conn_check_pending(hdev);
56e5cb86 1015 hci_dev_lock(hdev);
164a6e78 1016 if (test_bit(HCI_MGMT, &hdev->flags))
744cf19e 1017 mgmt_inquiry_failed(hdev, status);
56e5cb86 1018 hci_dev_unlock(hdev);
314b2381
JH		 1019 return;
1020 }
1021
89352e7d
AG		 1022 set_bit(HCI_INQUIRY, &hdev->flags);
1023
56e5cb86 1024 hci_dev_lock(hdev);
744cf19e 1025 mgmt_discovering(hdev, 1);
56e5cb86 1026 hci_dev_unlock(hdev);
1da177e4
LT		 1027}
1028
1da177e4
LT		 1029static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
1030{
a9de9248 1031 struct hci_cp_create_conn *cp;
1da177e4 1032 struct hci_conn *conn;
1da177e4 1033
a9de9248
MH		 1034 BT_DBG("%s status 0x%x", hdev->name, status);
1035
1036 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
1da177e4
LT		 1037 if (!cp)
1038 return;
1039
1040 hci_dev_lock(hdev);
1041
1042 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
1043
a9de9248 1044 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
1da177e4
LT		 1045
1046 if (status) {
1047 if (conn && conn->state == BT_CONNECT) {
4c67bc74
MH		 1048 if (status != 0x0c || conn->attempt > 2) {
1049 conn->state = BT_CLOSED;
1050 hci_proto_connect_cfm(conn, status);
1051 hci_conn_del(conn);
1052 } else
1053 conn->state = BT_CONNECT2;
1da177e4
LT		 1054 }
1055 } else {
1056 if (!conn) {
1057 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
1058 if (conn) {
1059 conn->out = 1;
1060 conn->link_mode |= HCI_LM_MASTER;
1061 } else
893ef971 1062 BT_ERR("No memory for new connection");
1da177e4
LT		 1063 }
1064 }
1065
1066 hci_dev_unlock(hdev);
1067}
1068
a9de9248 1069static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
1da177e4 1070{
a9de9248
MH		 1071 struct hci_cp_add_sco *cp;
1072 struct hci_conn *acl, *sco;
1073 __u16 handle;
1da177e4 1074
b6a0dc82
MH		 1075 BT_DBG("%s status 0x%x", hdev->name, status);
1076
a9de9248
MH		 1077 if (!status)
1078 return;
1da177e4 1079
a9de9248
MH		 1080 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
1081 if (!cp)
1082 return;
1da177e4 1083
a9de9248 1084 handle = __le16_to_cpu(cp->handle);
1da177e4 1085
a9de9248 1086 BT_DBG("%s handle %d", hdev->name, handle);
1da177e4 1087
a9de9248 1088 hci_dev_lock(hdev);
1da177e4 1089
a9de9248 1090 acl = hci_conn_hash_lookup_handle(hdev, handle);
5a08ecce
AE		 1091 if (acl) {
1092 sco = acl->link;
1093 if (sco) {
1094 sco->state = BT_CLOSED;
1da177e4 1095
5a08ecce
AE		 1096 hci_proto_connect_cfm(sco, status);
1097 hci_conn_del(sco);
1098 }
a9de9248 1099 }
1da177e4 1100
a9de9248
MH		 1101 hci_dev_unlock(hdev);
1102}
1da177e4 1103
f8558555
MH		 1104static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
1105{
1106 struct hci_cp_auth_requested *cp;
1107 struct hci_conn *conn;
1108
1109 BT_DBG("%s status 0x%x", hdev->name, status);
1110
1111 if (!status)
1112 return;
1113
1114 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
1115 if (!cp)
1116 return;
1117
1118 hci_dev_lock(hdev);
1119
1120 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1121 if (conn) {
1122 if (conn->state == BT_CONFIG) {
1123 hci_proto_connect_cfm(conn, status);
1124 hci_conn_put(conn);
1125 }
1126 }
1127
1128 hci_dev_unlock(hdev);
1129}
1130
1131static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
1132{
1133 struct hci_cp_set_conn_encrypt *cp;
1134 struct hci_conn *conn;
1135
1136 BT_DBG("%s status 0x%x", hdev->name, status);
1137
1138 if (!status)
1139 return;
1140
1141 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
1142 if (!cp)
1143 return;
1144
1145 hci_dev_lock(hdev);
1146
1147 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1148 if (conn) {
1149 if (conn->state == BT_CONFIG) {
1150 hci_proto_connect_cfm(conn, status);
1151 hci_conn_put(conn);
1152 }
1153 }
1154
1155 hci_dev_unlock(hdev);
1156}
1157
127178d2 1158static int hci_outgoing_auth_needed(struct hci_dev *hdev,
138d22ef 1159 struct hci_conn *conn)
392599b9 1160{
392599b9
JH		 1161 if (conn->state != BT_CONFIG || !conn->out)
1162 return 0;
1163
765c2a96 1164 if (conn->pending_sec_level == BT_SECURITY_SDP)
392599b9
JH		 1165 return 0;
1166
1167 /* Only request authentication for SSP connections or non-SSP
e9bf2bf0 1168 * devices with sec_level HIGH or if MITM protection is requested */
392599b9 1169 if (!(hdev->ssp_mode > 0 && conn->ssp_mode > 0) &&
e9bf2bf0
VCG		 1170 conn->pending_sec_level != BT_SECURITY_HIGH &&
1171 !(conn->auth_type & 0x01))
392599b9
JH		 1172 return 0;
1173
392599b9
JH		 1174 return 1;
1175}
1176
a9de9248
MH		 1177static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
1178{
127178d2
JH		 1179 struct hci_cp_remote_name_req *cp;
1180 struct hci_conn *conn;
1181
a9de9248 1182 BT_DBG("%s status 0x%x", hdev->name, status);
127178d2
JH		 1183
1184 /* If successful wait for the name req complete event before
1185 * checking for the need to do authentication */
1186 if (!status)
1187 return;
1188
1189 cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
1190 if (!cp)
1191 return;
1192
1193 hci_dev_lock(hdev);
1194
1195 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
79c6c70c
JH		 1196 if (!conn)
1197 goto unlock;
1198
1199 if (!hci_outgoing_auth_needed(hdev, conn))
1200 goto unlock;
1201
1202 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
127178d2
JH		 1203 struct hci_cp_auth_requested cp;
1204 cp.handle = __cpu_to_le16(conn->handle);
1205 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1206 }
1207
79c6c70c 1208unlock:
127178d2 1209 hci_dev_unlock(hdev);
a9de9248 1210}
1da177e4 1211
769be974
MH		 1212static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
1213{
1214 struct hci_cp_read_remote_features *cp;
1215 struct hci_conn *conn;
1216
1217 BT_DBG("%s status 0x%x", hdev->name, status);
1218
1219 if (!status)
1220 return;
1221
1222 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
1223 if (!cp)
1224 return;
1225
1226 hci_dev_lock(hdev);
1227
1228 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1229 if (conn) {
1230 if (conn->state == BT_CONFIG) {
769be974
MH		 1231 hci_proto_connect_cfm(conn, status);
1232 hci_conn_put(conn);
1233 }
1234 }
1235
1236 hci_dev_unlock(hdev);
1237}
1238
1239static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
1240{
1241 struct hci_cp_read_remote_ext_features *cp;
1242 struct hci_conn *conn;
1243
1244 BT_DBG("%s status 0x%x", hdev->name, status);
1245
1246 if (!status)
1247 return;
1248
1249 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
1250 if (!cp)
1251 return;
1252
1253 hci_dev_lock(hdev);
1254
1255 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1256 if (conn) {
1257 if (conn->state == BT_CONFIG) {
769be974
MH		 1258 hci_proto_connect_cfm(conn, status);
1259 hci_conn_put(conn);
1260 }
1261 }
1262
1263 hci_dev_unlock(hdev);
1264}
1265
a9de9248
MH		 1266static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
1267{
b6a0dc82
MH		 1268 struct hci_cp_setup_sync_conn *cp;
1269 struct hci_conn *acl, *sco;
1270 __u16 handle;
1271
a9de9248 1272 BT_DBG("%s status 0x%x", hdev->name, status);
b6a0dc82
MH		 1273
1274 if (!status)
1275 return;
1276
1277 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
1278 if (!cp)
1279 return;
1280
1281 handle = __le16_to_cpu(cp->handle);
1282
1283 BT_DBG("%s handle %d", hdev->name, handle);
1284
1285 hci_dev_lock(hdev);
1286
1287 acl = hci_conn_hash_lookup_handle(hdev, handle);
5a08ecce
AE		 1288 if (acl) {
1289 sco = acl->link;
1290 if (sco) {
1291 sco->state = BT_CLOSED;
b6a0dc82 1292
5a08ecce
AE		 1293 hci_proto_connect_cfm(sco, status);
1294 hci_conn_del(sco);
1295 }
b6a0dc82
MH		 1296 }
1297
1298 hci_dev_unlock(hdev);
1da177e4
LT		 1299}
1300
a9de9248 1301static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
1da177e4 1302{
a9de9248
MH		 1303 struct hci_cp_sniff_mode *cp;
1304 struct hci_conn *conn;
1da177e4 1305
a9de9248 1306 BT_DBG("%s status 0x%x", hdev->name, status);
04837f64 1307
a9de9248
MH		 1308 if (!status)
1309 return;
04837f64 1310
a9de9248
MH		 1311 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
1312 if (!cp)
1313 return;
04837f64 1314
a9de9248 1315 hci_dev_lock(hdev);
04837f64 1316
a9de9248 1317 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
e73439d8 1318 if (conn) {
a9de9248 1319 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
04837f64 1320
e73439d8
MH		 1321 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1322 hci_sco_setup(conn, status);
1323 }
1324
a9de9248
MH		 1325 hci_dev_unlock(hdev);
1326}
04837f64 1327
a9de9248
MH		 1328static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
1329{
1330 struct hci_cp_exit_sniff_mode *cp;
1331 struct hci_conn *conn;
04837f64 1332
a9de9248 1333 BT_DBG("%s status 0x%x", hdev->name, status);
04837f64 1334
a9de9248
MH		 1335 if (!status)
1336 return;
04837f64 1337
a9de9248
MH		 1338 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
1339 if (!cp)
1340 return;
04837f64 1341
a9de9248 1342 hci_dev_lock(hdev);
1da177e4 1343
a9de9248 1344 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
e73439d8 1345 if (conn) {
a9de9248 1346 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
1da177e4 1347
e73439d8
MH		 1348 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
1349 hci_sco_setup(conn, status);
1350 }
1351
a9de9248 1352 hci_dev_unlock(hdev);
1da177e4
LT		 1353}
1354
fcd89c09
VT		 1355static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
1356{
1357 struct hci_cp_le_create_conn *cp;
1358 struct hci_conn *conn;
1359
1360 BT_DBG("%s status 0x%x", hdev->name, status);
1361
1362 cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
1363 if (!cp)
1364 return;
1365
1366 hci_dev_lock(hdev);
1367
1368 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &cp->peer_addr);
1369
1370 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->peer_addr),
1371 conn);
1372
1373 if (status) {
1374 if (conn && conn->state == BT_CONNECT) {
1375 conn->state = BT_CLOSED;
1376 hci_proto_connect_cfm(conn, status);
1377 hci_conn_del(conn);
1378 }
1379 } else {
1380 if (!conn) {
1381 conn = hci_conn_add(hdev, LE_LINK, &cp->peer_addr);
29b7988a
AG		 1382 if (conn) {
1383 conn->dst_type = cp->peer_addr_type;
fcd89c09 1384 conn->out = 1;
29b7988a 1385 } else {
fcd89c09 1386 BT_ERR("No memory for new connection");
29b7988a 1387 }
fcd89c09
VT		 1388 }
1389 }
1390
1391 hci_dev_unlock(hdev);
1392}
1393
a7a595f6
VCG		 1394static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
1395{
1396 BT_DBG("%s status 0x%x", hdev->name, status);
1397}
1398
1da177e4
LT		 1399static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1400{
1401 __u8 status = *((__u8 *) skb->data);
1402
1403 BT_DBG("%s status %d", hdev->name, status);
1404
23bb5763 1405 hci_req_complete(hdev, HCI_OP_INQUIRY, status);
6bd57416 1406
a9de9248 1407 hci_conn_check_pending(hdev);
89352e7d
AG		 1408
1409 if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
1410 return;
1411
56e5cb86 1412 hci_dev_lock(hdev);
744cf19e 1413 mgmt_discovering(hdev, 0);
56e5cb86 1414 hci_dev_unlock(hdev);
1da177e4
LT		 1415}
1416
1da177e4
LT		 1417static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1418{
45bb4bf0 1419 struct inquiry_data data;
a9de9248 1420 struct inquiry_info *info = (void *) (skb->data + 1);
1da177e4
LT		 1421 int num_rsp = *((__u8 *) skb->data);
1422
1423 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1424
45bb4bf0
MH		 1425 if (!num_rsp)
1426 return;
1427
1da177e4 1428 hci_dev_lock(hdev);
45bb4bf0 1429
e17acd40 1430 for (; num_rsp; num_rsp--, info++) {
1da177e4
LT		 1431 bacpy(&data.bdaddr, &info->bdaddr);
1432 data.pscan_rep_mode = info->pscan_rep_mode;
1433 data.pscan_period_mode = info->pscan_period_mode;
1434 data.pscan_mode = info->pscan_mode;
1435 memcpy(data.dev_class, info->dev_class, 3);
1436 data.clock_offset = info->clock_offset;
1437 data.rssi = 0x00;
41a96212 1438 data.ssp_mode = 0x00;
1da177e4 1439 hci_inquiry_cache_update(hdev, &data);
744cf19e 1440 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK,
4c659c39 1441 info->dev_class, 0, NULL);
1da177e4 1442 }
45bb4bf0 1443
1da177e4
LT		 1444 hci_dev_unlock(hdev);
1445}
1446
1da177e4
LT		 1447static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1448{
a9de9248
MH		 1449 struct hci_ev_conn_complete *ev = (void *) skb->data;
1450 struct hci_conn *conn;
1da177e4
LT		 1451
1452 BT_DBG("%s", hdev->name);
1453
1454 hci_dev_lock(hdev);
1455
1456 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9499237a
MH		 1457 if (!conn) {
1458 if (ev->link_type != SCO_LINK)
1459 goto unlock;
1460
1461 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1462 if (!conn)
1463 goto unlock;
1464
1465 conn->type = SCO_LINK;
1466 }
1da177e4
LT		 1467
1468 if (!ev->status) {
1469 conn->handle = __le16_to_cpu(ev->handle);
769be974
MH		 1470
1471 if (conn->type == ACL_LINK) {
1472 conn->state = BT_CONFIG;
1473 hci_conn_hold(conn);
052b30b0 1474 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
744cf19e 1475 mgmt_connected(hdev, &ev->bdaddr, conn->type);
769be974
MH		 1476 } else
1477 conn->state = BT_CONNECTED;
1da177e4 1478
9eba32b8 1479 hci_conn_hold_device(conn);
7d0db0a3
MH		 1480 hci_conn_add_sysfs(conn);
1481
1da177e4
LT		 1482 if (test_bit(HCI_AUTH, &hdev->flags))
1483 conn->link_mode |= HCI_LM_AUTH;
1484
1485 if (test_bit(HCI_ENCRYPT, &hdev->flags))
1486 conn->link_mode |= HCI_LM_ENCRYPT;
1487
04837f64
MH		 1488 /* Get remote features */
1489 if (conn->type == ACL_LINK) {
1490 struct hci_cp_read_remote_features cp;
1491 cp.handle = ev->handle;
769be974
MH		 1492 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1493 sizeof(cp), &cp);
04837f64
MH		 1494 }
1495
1da177e4 1496 /* Set packet type for incoming connection */
a8746417 1497 if (!conn->out && hdev->hci_ver < 3) {
1da177e4
LT		 1498 struct hci_cp_change_conn_ptype cp;
1499 cp.handle = ev->handle;
a8746417
MH		 1500 cp.pkt_type = cpu_to_le16(conn->pkt_type);
1501 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
1502 sizeof(cp), &cp);
1da177e4 1503 }
17d5c04c 1504 } else {
1da177e4 1505 conn->state = BT_CLOSED;
17d5c04c 1506 if (conn->type == ACL_LINK)
744cf19e 1507 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
4c659c39 1508 ev->status);
17d5c04c 1509 }
1da177e4 1510
e73439d8
MH		 1511 if (conn->type == ACL_LINK)
1512 hci_sco_setup(conn, ev->status);
1da177e4 1513
769be974
MH		 1514 if (ev->status) {
1515 hci_proto_connect_cfm(conn, ev->status);
1da177e4 1516 hci_conn_del(conn);
c89b6e6b
MH		 1517 } else if (ev->link_type != ACL_LINK)
1518 hci_proto_connect_cfm(conn, ev->status);
1da177e4 1519
a9de9248 1520unlock:
1da177e4 1521 hci_dev_unlock(hdev);
1da177e4 1522
a9de9248 1523 hci_conn_check_pending(hdev);
1da177e4
LT		 1524}
1525
a9de9248 1526static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1527{
a9de9248
MH		 1528 struct hci_ev_conn_request *ev = (void *) skb->data;
1529 int mask = hdev->link_mode;
1da177e4 1530
a9de9248
MH		 1531 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
1532 batostr(&ev->bdaddr), ev->link_type);
1da177e4 1533
a9de9248 1534 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
1da177e4 1535
138d22ef
SJ		 1536 if ((mask & HCI_LM_ACCEPT) &&
1537 !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
a9de9248 1538 /* Connection accepted */
c7bdd502 1539 struct inquiry_entry *ie;
1da177e4 1540 struct hci_conn *conn;
1da177e4 1541
a9de9248 1542 hci_dev_lock(hdev);
b6a0dc82 1543
cc11b9c1
AE		 1544 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
1545 if (ie)
c7bdd502
MH		 1546 memcpy(ie->data.dev_class, ev->dev_class, 3);
1547
a9de9248
MH		 1548 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1549 if (!conn) {
cc11b9c1
AE		 1550 conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
1551 if (!conn) {
893ef971 1552 BT_ERR("No memory for new connection");
a9de9248
MH		 1553 hci_dev_unlock(hdev);
1554 return;
1da177e4
LT		 1555 }
1556 }
b6a0dc82 1557
a9de9248
MH		 1558 memcpy(conn->dev_class, ev->dev_class, 3);
1559 conn->state = BT_CONNECT;
b6a0dc82 1560
a9de9248 1561 hci_dev_unlock(hdev);
1da177e4 1562
b6a0dc82
MH		 1563 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
1564 struct hci_cp_accept_conn_req cp;
1da177e4 1565
b6a0dc82
MH		 1566 bacpy(&cp.bdaddr, &ev->bdaddr);
1567
1568 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
1569 cp.role = 0x00; /* Become master */
1570 else
1571 cp.role = 0x01; /* Remain slave */
1572
1573 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
1574 sizeof(cp), &cp);
1575 } else {
1576 struct hci_cp_accept_sync_conn_req cp;
1577
1578 bacpy(&cp.bdaddr, &ev->bdaddr);
a8746417 1579 cp.pkt_type = cpu_to_le16(conn->pkt_type);
b6a0dc82
MH		 1580
1581 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
1582 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
1583 cp.max_latency = cpu_to_le16(0xffff);
1584 cp.content_format = cpu_to_le16(hdev->voice_setting);
1585 cp.retrans_effort = 0xff;
1da177e4 1586
b6a0dc82
MH		 1587 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1588 sizeof(cp), &cp);
1589 }
a9de9248
MH		 1590 } else {
1591 /* Connection rejected */
1592 struct hci_cp_reject_conn_req cp;
1da177e4 1593
a9de9248 1594 bacpy(&cp.bdaddr, &ev->bdaddr);
9f5a0d7b 1595 cp.reason = HCI_ERROR_REJ_BAD_ADDR;
a9de9248 1596 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
1da177e4 1597 }
1da177e4
LT		 1598}
1599
a9de9248 1600static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
04837f64 1601{
a9de9248 1602 struct hci_ev_disconn_complete *ev = (void *) skb->data;
04837f64
MH		 1603 struct hci_conn *conn;
1604
1605 BT_DBG("%s status %d", hdev->name, ev->status);
1606
8962ee74 1607 if (ev->status) {
56e5cb86 1608 hci_dev_lock(hdev);
744cf19e 1609 mgmt_disconnect_failed(hdev);
56e5cb86 1610 hci_dev_unlock(hdev);
a9de9248 1611 return;
8962ee74 1612 }
a9de9248 1613
04837f64
MH		 1614 hci_dev_lock(hdev);
1615
1616 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
f7520543
JH		 1617 if (!conn)
1618 goto unlock;
7d0db0a3 1619
f7520543 1620 conn->state = BT_CLOSED;
04837f64 1621
83bc71b4 1622 if (conn->type == ACL_LINK || conn->type == LE_LINK)
744cf19e 1623 mgmt_disconnected(hdev, &conn->dst, conn->type);
f7520543
JH		 1624
1625 hci_proto_disconn_cfm(conn, ev->reason);
1626 hci_conn_del(conn);
1627
1628unlock:
04837f64
MH		 1629 hci_dev_unlock(hdev);
1630}
1631
1da177e4
LT		 1632static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1633{
a9de9248 1634 struct hci_ev_auth_complete *ev = (void *) skb->data;
04837f64 1635 struct hci_conn *conn;
1da177e4
LT		 1636
1637 BT_DBG("%s status %d", hdev->name, ev->status);
1638
1639 hci_dev_lock(hdev);
1640
04837f64 1641 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
d7556e20
WR		 1642 if (!conn)
1643 goto unlock;
1644
1645 if (!ev->status) {
1646 if (!(conn->ssp_mode > 0 && hdev->ssp_mode > 0) &&
1647 test_bit(HCI_CONN_REAUTH_PEND, &conn->pend)) {
1648 BT_INFO("re-auth of legacy device is not possible.");
2a611692 1649 } else {
d7556e20
WR		 1650 conn->link_mode |= HCI_LM_AUTH;
1651 conn->sec_level = conn->pending_sec_level;
2a611692 1652 }
d7556e20 1653 } else {
744cf19e 1654 mgmt_auth_failed(hdev, &conn->dst, ev->status);
d7556e20 1655 }
1da177e4 1656
d7556e20
WR		 1657 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1658 clear_bit(HCI_CONN_REAUTH_PEND, &conn->pend);
1da177e4 1659
d7556e20
WR		 1660 if (conn->state == BT_CONFIG) {
1661 if (!ev->status && hdev->ssp_mode > 0 && conn->ssp_mode > 0) {
1662 struct hci_cp_set_conn_encrypt cp;
1663 cp.handle = ev->handle;
1664 cp.encrypt = 0x01;
1665 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1666 &cp);
052b30b0 1667 } else {
d7556e20
WR		 1668 conn->state = BT_CONNECTED;
1669 hci_proto_connect_cfm(conn, ev->status);
052b30b0
MH		 1670 hci_conn_put(conn);
1671 }
d7556e20
WR		 1672 } else {
1673 hci_auth_cfm(conn, ev->status);
052b30b0 1674
d7556e20
WR		 1675 hci_conn_hold(conn);
1676 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1677 hci_conn_put(conn);
1678 }
1679
1680 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1681 if (!ev->status) {
1682 struct hci_cp_set_conn_encrypt cp;
1683 cp.handle = ev->handle;
1684 cp.encrypt = 0x01;
1685 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
1686 &cp);
1687 } else {
1688 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1689 hci_encrypt_cfm(conn, ev->status, 0x00);
1da177e4
LT		 1690 }
1691 }
1692
d7556e20 1693unlock:
1da177e4
LT		 1694 hci_dev_unlock(hdev);
1695}
1696
a9de9248 1697static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1698{
127178d2
JH		 1699 struct hci_ev_remote_name *ev = (void *) skb->data;
1700 struct hci_conn *conn;
1701
a9de9248 1702 BT_DBG("%s", hdev->name);
1da177e4 1703
a9de9248 1704 hci_conn_check_pending(hdev);
127178d2
JH		 1705
1706 hci_dev_lock(hdev);
1707
a88a9652 1708 if (ev->status == 0 && test_bit(HCI_MGMT, &hdev->flags))
744cf19e 1709 mgmt_remote_name(hdev, &ev->bdaddr, ev->name);
a88a9652 1710
127178d2 1711 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
79c6c70c
JH		 1712 if (!conn)
1713 goto unlock;
1714
1715 if (!hci_outgoing_auth_needed(hdev, conn))
1716 goto unlock;
1717
1718 if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
127178d2
JH		 1719 struct hci_cp_auth_requested cp;
1720 cp.handle = __cpu_to_le16(conn->handle);
1721 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
1722 }
1723
79c6c70c 1724unlock:
127178d2 1725 hci_dev_unlock(hdev);
a9de9248
MH		 1726}
1727
1728static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1729{
1730 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1731 struct hci_conn *conn;
1732
1733 BT_DBG("%s status %d", hdev->name, ev->status);
1da177e4
LT		 1734
1735 hci_dev_lock(hdev);
1736
04837f64 1737 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT		 1738 if (conn) {
1739 if (!ev->status) {
ae293196
MH		 1740 if (ev->encrypt) {
1741 /* Encryption implies authentication */
1742 conn->link_mode |= HCI_LM_AUTH;
1da177e4 1743 conn->link_mode |= HCI_LM_ENCRYPT;
da85e5e5 1744 conn->sec_level = conn->pending_sec_level;
ae293196 1745 } else
1da177e4
LT		 1746 conn->link_mode &= ~HCI_LM_ENCRYPT;
1747 }
1748
1749 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1750
f8558555
MH		 1751 if (conn->state == BT_CONFIG) {
1752 if (!ev->status)
1753 conn->state = BT_CONNECTED;
1754
1755 hci_proto_connect_cfm(conn, ev->status);
1756 hci_conn_put(conn);
1757 } else
1758 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
1da177e4
LT		 1759 }
1760
1761 hci_dev_unlock(hdev);
1762}
1763
a9de9248 1764static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1765{
a9de9248 1766 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
04837f64 1767 struct hci_conn *conn;
1da177e4
LT		 1768
1769 BT_DBG("%s status %d", hdev->name, ev->status);
1770
1771 hci_dev_lock(hdev);
1772
04837f64 1773 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT		 1774 if (conn) {
1775 if (!ev->status)
1776 conn->link_mode |= HCI_LM_SECURE;
1777
1778 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1779
1780 hci_key_change_cfm(conn, ev->status);
1781 }
1782
1783 hci_dev_unlock(hdev);
1784}
1785
a9de9248 1786static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1787{
a9de9248
MH		 1788 struct hci_ev_remote_features *ev = (void *) skb->data;
1789 struct hci_conn *conn;
1790
1791 BT_DBG("%s status %d", hdev->name, ev->status);
1792
a9de9248
MH		 1793 hci_dev_lock(hdev);
1794
1795 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH		 1796 if (!conn)
1797 goto unlock;
769be974 1798
ccd556fe
JH		 1799 if (!ev->status)
1800 memcpy(conn->features, ev->features, 8);
1801
1802 if (conn->state != BT_CONFIG)
1803 goto unlock;
1804
1805 if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
1806 struct hci_cp_read_remote_ext_features cp;
1807 cp.handle = ev->handle;
1808 cp.page = 0x01;
1809 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
bdb7524a 1810 sizeof(cp), &cp);
392599b9
JH		 1811 goto unlock;
1812 }
1813
127178d2
JH		 1814 if (!ev->status) {
1815 struct hci_cp_remote_name_req cp;
1816 memset(&cp, 0, sizeof(cp));
1817 bacpy(&cp.bdaddr, &conn->dst);
1818 cp.pscan_rep_mode = 0x02;
1819 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
1820 }
392599b9 1821
127178d2 1822 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH		 1823 conn->state = BT_CONNECTED;
1824 hci_proto_connect_cfm(conn, ev->status);
1825 hci_conn_put(conn);
769be974 1826 }
a9de9248 1827
ccd556fe 1828unlock:
a9de9248 1829 hci_dev_unlock(hdev);
1da177e4
LT		 1830}
1831
a9de9248 1832static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1833{
a9de9248 1834 BT_DBG("%s", hdev->name);
1da177e4
LT		 1835}
1836
a9de9248 1837static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 1838{
a9de9248 1839 BT_DBG("%s", hdev->name);
1da177e4
LT		 1840}
1841
a9de9248
MH		 1842static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1843{
1844 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1845 __u16 opcode;
1846
1847 skb_pull(skb, sizeof(*ev));
1848
1849 opcode = __le16_to_cpu(ev->opcode);
1850
1851 switch (opcode) {
1852 case HCI_OP_INQUIRY_CANCEL:
1853 hci_cc_inquiry_cancel(hdev, skb);
1854 break;
1855
1856 case HCI_OP_EXIT_PERIODIC_INQ:
1857 hci_cc_exit_periodic_inq(hdev, skb);
1858 break;
1859
1860 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1861 hci_cc_remote_name_req_cancel(hdev, skb);
1862 break;
1863
1864 case HCI_OP_ROLE_DISCOVERY:
1865 hci_cc_role_discovery(hdev, skb);
1866 break;
1867
e4e8e37c
MH		 1868 case HCI_OP_READ_LINK_POLICY:
1869 hci_cc_read_link_policy(hdev, skb);
1870 break;
1871
a9de9248
MH		 1872 case HCI_OP_WRITE_LINK_POLICY:
1873 hci_cc_write_link_policy(hdev, skb);
1874 break;
1875
e4e8e37c
MH		 1876 case HCI_OP_READ_DEF_LINK_POLICY:
1877 hci_cc_read_def_link_policy(hdev, skb);
1878 break;
1879
1880 case HCI_OP_WRITE_DEF_LINK_POLICY:
1881 hci_cc_write_def_link_policy(hdev, skb);
1882 break;
1883
a9de9248
MH		 1884 case HCI_OP_RESET:
1885 hci_cc_reset(hdev, skb);
1886 break;
1887
1888 case HCI_OP_WRITE_LOCAL_NAME:
1889 hci_cc_write_local_name(hdev, skb);
1890 break;
1891
1892 case HCI_OP_READ_LOCAL_NAME:
1893 hci_cc_read_local_name(hdev, skb);
1894 break;
1895
1896 case HCI_OP_WRITE_AUTH_ENABLE:
1897 hci_cc_write_auth_enable(hdev, skb);
1898 break;
1899
1900 case HCI_OP_WRITE_ENCRYPT_MODE:
1901 hci_cc_write_encrypt_mode(hdev, skb);
1902 break;
1903
1904 case HCI_OP_WRITE_SCAN_ENABLE:
1905 hci_cc_write_scan_enable(hdev, skb);
1906 break;
1907
1908 case HCI_OP_READ_CLASS_OF_DEV:
1909 hci_cc_read_class_of_dev(hdev, skb);
1910 break;
1911
1912 case HCI_OP_WRITE_CLASS_OF_DEV:
1913 hci_cc_write_class_of_dev(hdev, skb);
1914 break;
1915
1916 case HCI_OP_READ_VOICE_SETTING:
1917 hci_cc_read_voice_setting(hdev, skb);
1918 break;
1919
1920 case HCI_OP_WRITE_VOICE_SETTING:
1921 hci_cc_write_voice_setting(hdev, skb);
1922 break;
1923
1924 case HCI_OP_HOST_BUFFER_SIZE:
1925 hci_cc_host_buffer_size(hdev, skb);
1926 break;
1927
333140b5
MH		 1928 case HCI_OP_READ_SSP_MODE:
1929 hci_cc_read_ssp_mode(hdev, skb);
1930 break;
1931
1932 case HCI_OP_WRITE_SSP_MODE:
1933 hci_cc_write_ssp_mode(hdev, skb);
1934 break;
1935
a9de9248
MH		 1936 case HCI_OP_READ_LOCAL_VERSION:
1937 hci_cc_read_local_version(hdev, skb);
1938 break;
1939
1940 case HCI_OP_READ_LOCAL_COMMANDS:
1941 hci_cc_read_local_commands(hdev, skb);
1942 break;
1943
1944 case HCI_OP_READ_LOCAL_FEATURES:
1945 hci_cc_read_local_features(hdev, skb);
1946 break;
1947
971e3a4b
AG		 1948 case HCI_OP_READ_LOCAL_EXT_FEATURES:
1949 hci_cc_read_local_ext_features(hdev, skb);
1950 break;
1951
a9de9248
MH		 1952 case HCI_OP_READ_BUFFER_SIZE:
1953 hci_cc_read_buffer_size(hdev, skb);
1954 break;
1955
1956 case HCI_OP_READ_BD_ADDR:
1957 hci_cc_read_bd_addr(hdev, skb);
1958 break;
1959
23bb5763
JH		 1960 case HCI_OP_WRITE_CA_TIMEOUT:
1961 hci_cc_write_ca_timeout(hdev, skb);
1962 break;
1963
928abaa7
AE		 1964 case HCI_OP_READ_LOCAL_AMP_INFO:
1965 hci_cc_read_local_amp_info(hdev, skb);
1966 break;
1967
b0916ea0
JH		 1968 case HCI_OP_DELETE_STORED_LINK_KEY:
1969 hci_cc_delete_stored_link_key(hdev, skb);
1970 break;
1971
d5859e22
JH		 1972 case HCI_OP_SET_EVENT_MASK:
1973 hci_cc_set_event_mask(hdev, skb);
1974 break;
1975
1976 case HCI_OP_WRITE_INQUIRY_MODE:
1977 hci_cc_write_inquiry_mode(hdev, skb);
1978 break;
1979
1980 case HCI_OP_READ_INQ_RSP_TX_POWER:
1981 hci_cc_read_inq_rsp_tx_power(hdev, skb);
1982 break;
1983
1984 case HCI_OP_SET_EVENT_FLT:
1985 hci_cc_set_event_flt(hdev, skb);
1986 break;
1987
980e1a53
JH		 1988 case HCI_OP_PIN_CODE_REPLY:
1989 hci_cc_pin_code_reply(hdev, skb);
1990 break;
1991
1992 case HCI_OP_PIN_CODE_NEG_REPLY:
1993 hci_cc_pin_code_neg_reply(hdev, skb);
1994 break;
1995
c35938b2
SJ		 1996 case HCI_OP_READ_LOCAL_OOB_DATA:
1997 hci_cc_read_local_oob_data_reply(hdev, skb);
1998 break;
1999
6ed58ec5
VT		 2000 case HCI_OP_LE_READ_BUFFER_SIZE:
2001 hci_cc_le_read_buffer_size(hdev, skb);
2002 break;
2003
a5c29683
JH		 2004 case HCI_OP_USER_CONFIRM_REPLY:
2005 hci_cc_user_confirm_reply(hdev, skb);
2006 break;
2007
2008 case HCI_OP_USER_CONFIRM_NEG_REPLY:
2009 hci_cc_user_confirm_neg_reply(hdev, skb);
2010 break;
2011
eb9d91f5
AG		 2012 case HCI_OP_LE_SET_SCAN_ENABLE:
2013 hci_cc_le_set_scan_enable(hdev, skb);
2014 break;
2015
a7a595f6
VCG		 2016 case HCI_OP_LE_LTK_REPLY:
2017 hci_cc_le_ltk_reply(hdev, skb);
2018 break;
2019
2020 case HCI_OP_LE_LTK_NEG_REPLY:
2021 hci_cc_le_ltk_neg_reply(hdev, skb);
2022 break;
2023
f9b49306
AG		 2024 case HCI_OP_WRITE_LE_HOST_SUPPORTED:
2025 hci_cc_write_le_host_supported(hdev, skb);
2026 break;
2027
a9de9248
MH		 2028 default:
2029 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2030 break;
2031 }
2032
6bd32326
VT		 2033 if (ev->opcode != HCI_OP_NOP)
2034 del_timer(&hdev->cmd_timer);
2035
a9de9248
MH		 2036 if (ev->ncmd) {
2037 atomic_set(&hdev->cmd_cnt, 1);
2038 if (!skb_queue_empty(&hdev->cmd_q))
c78ae283 2039 tasklet_schedule(&hdev->cmd_task);
a9de9248
MH		 2040 }
2041}
2042
2043static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
2044{
2045 struct hci_ev_cmd_status *ev = (void *) skb->data;
2046 __u16 opcode;
2047
2048 skb_pull(skb, sizeof(*ev));
2049
2050 opcode = __le16_to_cpu(ev->opcode);
2051
2052 switch (opcode) {
2053 case HCI_OP_INQUIRY:
2054 hci_cs_inquiry(hdev, ev->status);
2055 break;
2056
2057 case HCI_OP_CREATE_CONN:
2058 hci_cs_create_conn(hdev, ev->status);
2059 break;
2060
2061 case HCI_OP_ADD_SCO:
2062 hci_cs_add_sco(hdev, ev->status);
2063 break;
2064
f8558555
MH		 2065 case HCI_OP_AUTH_REQUESTED:
2066 hci_cs_auth_requested(hdev, ev->status);
2067 break;
2068
2069 case HCI_OP_SET_CONN_ENCRYPT:
2070 hci_cs_set_conn_encrypt(hdev, ev->status);
2071 break;
2072
a9de9248
MH		 2073 case HCI_OP_REMOTE_NAME_REQ:
2074 hci_cs_remote_name_req(hdev, ev->status);
2075 break;
2076
769be974
MH		 2077 case HCI_OP_READ_REMOTE_FEATURES:
2078 hci_cs_read_remote_features(hdev, ev->status);
2079 break;
2080
2081 case HCI_OP_READ_REMOTE_EXT_FEATURES:
2082 hci_cs_read_remote_ext_features(hdev, ev->status);
2083 break;
2084
a9de9248
MH		 2085 case HCI_OP_SETUP_SYNC_CONN:
2086 hci_cs_setup_sync_conn(hdev, ev->status);
2087 break;
2088
2089 case HCI_OP_SNIFF_MODE:
2090 hci_cs_sniff_mode(hdev, ev->status);
2091 break;
2092
2093 case HCI_OP_EXIT_SNIFF_MODE:
2094 hci_cs_exit_sniff_mode(hdev, ev->status);
2095 break;
2096
8962ee74
JH		 2097 case HCI_OP_DISCONNECT:
2098 if (ev->status != 0)
744cf19e 2099 mgmt_disconnect_failed(hdev);
8962ee74
JH		 2100 break;
2101
fcd89c09
VT		 2102 case HCI_OP_LE_CREATE_CONN:
2103 hci_cs_le_create_conn(hdev, ev->status);
2104 break;
2105
a7a595f6
VCG		 2106 case HCI_OP_LE_START_ENC:
2107 hci_cs_le_start_enc(hdev, ev->status);
2108 break;
2109
a9de9248
MH		 2110 default:
2111 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
2112 break;
2113 }
2114
6bd32326
VT		 2115 if (ev->opcode != HCI_OP_NOP)
2116 del_timer(&hdev->cmd_timer);
2117
10572132 2118 if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
a9de9248
MH		 2119 atomic_set(&hdev->cmd_cnt, 1);
2120 if (!skb_queue_empty(&hdev->cmd_q))
c78ae283 2121 tasklet_schedule(&hdev->cmd_task);
a9de9248
MH		 2122 }
2123}
2124
2125static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2126{
2127 struct hci_ev_role_change *ev = (void *) skb->data;
2128 struct hci_conn *conn;
2129
2130 BT_DBG("%s status %d", hdev->name, ev->status);
2131
2132 hci_dev_lock(hdev);
2133
2134 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2135 if (conn) {
2136 if (!ev->status) {
2137 if (ev->role)
2138 conn->link_mode &= ~HCI_LM_MASTER;
2139 else
2140 conn->link_mode |= HCI_LM_MASTER;
2141 }
2142
2143 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
2144
2145 hci_role_switch_cfm(conn, ev->status, ev->role);
2146 }
2147
2148 hci_dev_unlock(hdev);
2149}
2150
2151static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2152{
2153 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
2154 __le16 *ptr;
2155 int i;
2156
2157 skb_pull(skb, sizeof(*ev));
2158
2159 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
2160
2161 if (skb->len < ev->num_hndl * 4) {
2162 BT_DBG("%s bad parameters", hdev->name);
2163 return;
2164 }
2165
2166 tasklet_disable(&hdev->tx_task);
2167
2168 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
2169 struct hci_conn *conn;
2170 __u16 handle, count;
2171
83985319
HH		 2172 handle = get_unaligned_le16(ptr++);
2173 count = get_unaligned_le16(ptr++);
a9de9248
MH		 2174
2175 conn = hci_conn_hash_lookup_handle(hdev, handle);
2176 if (conn) {
2177 conn->sent -= count;
2178
2179 if (conn->type == ACL_LINK) {
70f23020
AE		 2180 hdev->acl_cnt += count;
2181 if (hdev->acl_cnt > hdev->acl_pkts)
a9de9248 2182 hdev->acl_cnt = hdev->acl_pkts;
6ed58ec5
VT		 2183 } else if (conn->type == LE_LINK) {
2184 if (hdev->le_pkts) {
2185 hdev->le_cnt += count;
2186 if (hdev->le_cnt > hdev->le_pkts)
2187 hdev->le_cnt = hdev->le_pkts;
2188 } else {
2189 hdev->acl_cnt += count;
2190 if (hdev->acl_cnt > hdev->acl_pkts)
2191 hdev->acl_cnt = hdev->acl_pkts;
2192 }
a9de9248 2193 } else {
70f23020
AE		 2194 hdev->sco_cnt += count;
2195 if (hdev->sco_cnt > hdev->sco_pkts)
a9de9248
MH		 2196 hdev->sco_cnt = hdev->sco_pkts;
2197 }
2198 }
2199 }
2200
c78ae283 2201 tasklet_schedule(&hdev->tx_task);
a9de9248
MH		 2202
2203 tasklet_enable(&hdev->tx_task);
2204}
2205
2206static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
04837f64 2207{
a9de9248 2208 struct hci_ev_mode_change *ev = (void *) skb->data;
04837f64
MH		 2209 struct hci_conn *conn;
2210
2211 BT_DBG("%s status %d", hdev->name, ev->status);
2212
2213 hci_dev_lock(hdev);
2214
2215 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
a9de9248
MH		 2216 if (conn) {
2217 conn->mode = ev->mode;
2218 conn->interval = __le16_to_cpu(ev->interval);
2219
2220 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
2221 if (conn->mode == HCI_CM_ACTIVE)
2222 conn->power_save = 1;
2223 else
2224 conn->power_save = 0;
2225 }
e73439d8
MH		 2226
2227 if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->pend))
2228 hci_sco_setup(conn, ev->status);
04837f64
MH		 2229 }
2230
2231 hci_dev_unlock(hdev);
2232}
2233
a9de9248
MH		 2234static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2235{
052b30b0
MH		 2236 struct hci_ev_pin_code_req *ev = (void *) skb->data;
2237 struct hci_conn *conn;
2238
a9de9248 2239 BT_DBG("%s", hdev->name);
052b30b0
MH		 2240
2241 hci_dev_lock(hdev);
2242
2243 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
b6f98044
WR		 2244 if (!conn)
2245 goto unlock;
2246
2247 if (conn->state == BT_CONNECTED) {
052b30b0
MH		 2248 hci_conn_hold(conn);
2249 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
2250 hci_conn_put(conn);
2251 }
2252
03b555e1
JH		 2253 if (!test_bit(HCI_PAIRABLE, &hdev->flags))
2254 hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2255 sizeof(ev->bdaddr), &ev->bdaddr);
582fbe9e 2256 else if (test_bit(HCI_MGMT, &hdev->flags)) {
a770bb5a
WR		 2257 u8 secure;
2258
2259 if (conn->pending_sec_level == BT_SECURITY_HIGH)
2260 secure = 1;
2261 else
2262 secure = 0;
2263
744cf19e 2264 mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
a770bb5a 2265 }
980e1a53 2266
b6f98044 2267unlock:
052b30b0 2268 hci_dev_unlock(hdev);
a9de9248
MH		 2269}
2270
2271static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2272{
55ed8ca1
JH		 2273 struct hci_ev_link_key_req *ev = (void *) skb->data;
2274 struct hci_cp_link_key_reply cp;
2275 struct hci_conn *conn;
2276 struct link_key *key;
2277
a9de9248 2278 BT_DBG("%s", hdev->name);
55ed8ca1
JH		 2279
2280 if (!test_bit(HCI_LINK_KEYS, &hdev->flags))
2281 return;
2282
2283 hci_dev_lock(hdev);
2284
2285 key = hci_find_link_key(hdev, &ev->bdaddr);
2286 if (!key) {
2287 BT_DBG("%s link key not found for %s", hdev->name,
2288 batostr(&ev->bdaddr));
2289 goto not_found;
2290 }
2291
2292 BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2293 batostr(&ev->bdaddr));
2294
b6020ba0
WR		 2295 if (!test_bit(HCI_DEBUG_KEYS, &hdev->flags) &&
2296 key->type == HCI_LK_DEBUG_COMBINATION) {
55ed8ca1
JH		 2297 BT_DBG("%s ignoring debug key", hdev->name);
2298 goto not_found;
2299 }
2300
2301 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
60b83f57
WR		 2302 if (conn) {
2303 if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2304 conn->auth_type != 0xff &&
2305 (conn->auth_type & 0x01)) {
2306 BT_DBG("%s ignoring unauthenticated key", hdev->name);
2307 goto not_found;
2308 }
55ed8ca1 2309
60b83f57
WR		 2310 if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2311 conn->pending_sec_level == BT_SECURITY_HIGH) {
2312 BT_DBG("%s ignoring key unauthenticated for high \
2313 security", hdev->name);
2314 goto not_found;
2315 }
2316
2317 conn->key_type = key->type;
2318 conn->pin_length = key->pin_len;
55ed8ca1
JH		 2319 }
2320
2321 bacpy(&cp.bdaddr, &ev->bdaddr);
2322 memcpy(cp.link_key, key->val, 16);
2323
2324 hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);
2325
2326 hci_dev_unlock(hdev);
2327
2328 return;
2329
2330not_found:
2331 hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
2332 hci_dev_unlock(hdev);
a9de9248
MH		 2333}
2334
2335static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2336{
052b30b0
MH		 2337 struct hci_ev_link_key_notify *ev = (void *) skb->data;
2338 struct hci_conn *conn;
55ed8ca1 2339 u8 pin_len = 0;
052b30b0 2340
a9de9248 2341 BT_DBG("%s", hdev->name);
052b30b0
MH		 2342
2343 hci_dev_lock(hdev);
2344
2345 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2346 if (conn) {
2347 hci_conn_hold(conn);
2348 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
980e1a53 2349 pin_len = conn->pin_length;
13d39315
WR		 2350
2351 if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
2352 conn->key_type = ev->key_type;
2353
052b30b0
MH		 2354 hci_conn_put(conn);
2355 }
2356
55ed8ca1 2357 if (test_bit(HCI_LINK_KEYS, &hdev->flags))
d25e28ab 2358 hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
55ed8ca1
JH		 2359 ev->key_type, pin_len);
2360
052b30b0 2361 hci_dev_unlock(hdev);
a9de9248
MH		 2362}
2363
1da177e4
LT		 2364static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
2365{
a9de9248 2366 struct hci_ev_clock_offset *ev = (void *) skb->data;
04837f64 2367 struct hci_conn *conn;
1da177e4
LT		 2368
2369 BT_DBG("%s status %d", hdev->name, ev->status);
2370
2371 hci_dev_lock(hdev);
2372
04837f64 2373 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1da177e4
LT		 2374 if (conn && !ev->status) {
2375 struct inquiry_entry *ie;
2376
cc11b9c1
AE		 2377 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2378 if (ie) {
1da177e4
LT		 2379 ie->data.clock_offset = ev->clock_offset;
2380 ie->timestamp = jiffies;
2381 }
2382 }
2383
2384 hci_dev_unlock(hdev);
2385}
2386
a8746417
MH		 2387static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2388{
2389 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
2390 struct hci_conn *conn;
2391
2392 BT_DBG("%s status %d", hdev->name, ev->status);
2393
2394 hci_dev_lock(hdev);
2395
2396 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2397 if (conn && !ev->status)
2398 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
2399
2400 hci_dev_unlock(hdev);
2401}
2402
85a1e930
MH		 2403static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2404{
a9de9248 2405 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
85a1e930
MH		 2406 struct inquiry_entry *ie;
2407
2408 BT_DBG("%s", hdev->name);
2409
2410 hci_dev_lock(hdev);
2411
cc11b9c1
AE		 2412 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2413 if (ie) {
85a1e930
MH		 2414 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
2415 ie->timestamp = jiffies;
2416 }
2417
2418 hci_dev_unlock(hdev);
2419}
2420
a9de9248
MH		 2421static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
2422{
2423 struct inquiry_data data;
2424 int num_rsp = *((__u8 *) skb->data);
2425
2426 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
2427
2428 if (!num_rsp)
2429 return;
2430
2431 hci_dev_lock(hdev);
2432
2433 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
138d22ef
SJ		 2434 struct inquiry_info_with_rssi_and_pscan_mode *info;
2435 info = (void *) (skb->data + 1);
a9de9248 2436
e17acd40 2437 for (; num_rsp; num_rsp--, info++) {
a9de9248
MH		 2438 bacpy(&data.bdaddr, &info->bdaddr);
2439 data.pscan_rep_mode = info->pscan_rep_mode;
2440 data.pscan_period_mode = info->pscan_period_mode;
2441 data.pscan_mode = info->pscan_mode;
2442 memcpy(data.dev_class, info->dev_class, 3);
2443 data.clock_offset = info->clock_offset;
2444 data.rssi = info->rssi;
41a96212 2445 data.ssp_mode = 0x00;
a9de9248 2446 hci_inquiry_cache_update(hdev, &data);
744cf19e 2447 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK,
e17acd40
JH		 2448 info->dev_class, info->rssi,
2449 NULL);
a9de9248
MH		 2450 }
2451 } else {
2452 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
2453
e17acd40 2454 for (; num_rsp; num_rsp--, info++) {
a9de9248
MH		 2455 bacpy(&data.bdaddr, &info->bdaddr);
2456 data.pscan_rep_mode = info->pscan_rep_mode;
2457 data.pscan_period_mode = info->pscan_period_mode;
2458 data.pscan_mode = 0x00;
2459 memcpy(data.dev_class, info->dev_class, 3);
2460 data.clock_offset = info->clock_offset;
2461 data.rssi = info->rssi;
41a96212 2462 data.ssp_mode = 0x00;
a9de9248 2463 hci_inquiry_cache_update(hdev, &data);
744cf19e 2464 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK,
e17acd40
JH		 2465 info->dev_class, info->rssi,
2466 NULL);
a9de9248
MH		 2467 }
2468 }
2469
2470 hci_dev_unlock(hdev);
2471}
2472
2473static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2474{
41a96212
MH		 2475 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
2476 struct hci_conn *conn;
2477
a9de9248 2478 BT_DBG("%s", hdev->name);
41a96212 2479
41a96212
MH		 2480 hci_dev_lock(hdev);
2481
2482 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
ccd556fe
JH		 2483 if (!conn)
2484 goto unlock;
41a96212 2485
ccd556fe
JH		 2486 if (!ev->status && ev->page == 0x01) {
2487 struct inquiry_entry *ie;
41a96212 2488
cc11b9c1
AE		 2489 ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
2490 if (ie)
ccd556fe 2491 ie->data.ssp_mode = (ev->features[0] & 0x01);
769be974 2492
ccd556fe
JH		 2493 conn->ssp_mode = (ev->features[0] & 0x01);
2494 }
2495
2496 if (conn->state != BT_CONFIG)
2497 goto unlock;
2498
127178d2
JH		 2499 if (!ev->status) {
2500 struct hci_cp_remote_name_req cp;
2501 memset(&cp, 0, sizeof(cp));
2502 bacpy(&cp.bdaddr, &conn->dst);
2503 cp.pscan_rep_mode = 0x02;
2504 hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
2505 }
392599b9 2506
127178d2 2507 if (!hci_outgoing_auth_needed(hdev, conn)) {
ccd556fe
JH		 2508 conn->state = BT_CONNECTED;
2509 hci_proto_connect_cfm(conn, ev->status);
2510 hci_conn_put(conn);
41a96212
MH		 2511 }
2512
ccd556fe 2513unlock:
41a96212 2514 hci_dev_unlock(hdev);
a9de9248
MH		 2515}
2516
2517static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2518{
b6a0dc82
MH		 2519 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
2520 struct hci_conn *conn;
2521
2522 BT_DBG("%s status %d", hdev->name, ev->status);
2523
2524 hci_dev_lock(hdev);
2525
2526 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
9dc0a3af
MH		 2527 if (!conn) {
2528 if (ev->link_type == ESCO_LINK)
2529 goto unlock;
2530
2531 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
2532 if (!conn)
2533 goto unlock;
2534
2535 conn->type = SCO_LINK;
2536 }
b6a0dc82 2537
732547f9
MH		 2538 switch (ev->status) {
2539 case 0x00:
b6a0dc82
MH		 2540 conn->handle = __le16_to_cpu(ev->handle);
2541 conn->state = BT_CONNECTED;
7d0db0a3 2542
9eba32b8 2543 hci_conn_hold_device(conn);
7d0db0a3 2544 hci_conn_add_sysfs(conn);
732547f9
MH		 2545 break;
2546
705e5711 2547 case 0x11: /* Unsupported Feature or Parameter Value */
732547f9 2548 case 0x1c: /* SCO interval rejected */
1038a00b 2549 case 0x1a: /* Unsupported Remote Feature */
732547f9
MH		 2550 case 0x1f: /* Unspecified error */
2551 if (conn->out && conn->attempt < 2) {
2552 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
2553 (hdev->esco_type & EDR_ESCO_MASK);
2554 hci_setup_sync(conn, conn->link->handle);
2555 goto unlock;
2556 }
2557 /* fall through */
2558
2559 default:
b6a0dc82 2560 conn->state = BT_CLOSED;
732547f9
MH		 2561 break;
2562 }
b6a0dc82
MH		 2563
2564 hci_proto_connect_cfm(conn, ev->status);
2565 if (ev->status)
2566 hci_conn_del(conn);
2567
2568unlock:
2569 hci_dev_unlock(hdev);
a9de9248
MH		 2570}
2571
2572static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
2573{
2574 BT_DBG("%s", hdev->name);
2575}
2576
04837f64
MH		 2577static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
2578{
a9de9248 2579 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
04837f64
MH		 2580
2581 BT_DBG("%s status %d", hdev->name, ev->status);
04837f64
MH		 2582}
2583
a9de9248 2584static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1da177e4 2585{
a9de9248
MH		 2586 struct inquiry_data data;
2587 struct extended_inquiry_info *info = (void *) (skb->data + 1);
2588 int num_rsp = *((__u8 *) skb->data);
1da177e4 2589
a9de9248 2590 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1da177e4 2591
a9de9248
MH		 2592 if (!num_rsp)
2593 return;
1da177e4 2594
a9de9248
MH		 2595 hci_dev_lock(hdev);
2596
e17acd40 2597 for (; num_rsp; num_rsp--, info++) {
a9de9248 2598 bacpy(&data.bdaddr, &info->bdaddr);
138d22ef
SJ		 2599 data.pscan_rep_mode = info->pscan_rep_mode;
2600 data.pscan_period_mode = info->pscan_period_mode;
2601 data.pscan_mode = 0x00;
a9de9248 2602 memcpy(data.dev_class, info->dev_class, 3);
138d22ef
SJ		 2603 data.clock_offset = info->clock_offset;
2604 data.rssi = info->rssi;
41a96212 2605 data.ssp_mode = 0x01;
a9de9248 2606 hci_inquiry_cache_update(hdev, &data);
744cf19e 2607 mgmt_device_found(hdev, &info->bdaddr, ACL_LINK,
4c659c39 2608 info->dev_class, info->rssi, info->data);
a9de9248
MH		 2609 }
2610
2611 hci_dev_unlock(hdev);
2612}
1da177e4 2613
17fa4b9d
JH		 2614static inline u8 hci_get_auth_req(struct hci_conn *conn)
2615{
2616 /* If remote requests dedicated bonding follow that lead */
2617 if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
2618 /* If both remote and local IO capabilities allow MITM
2619 * protection then require it, otherwise don't */
2620 if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
2621 return 0x02;
2622 else
2623 return 0x03;
2624 }
2625
2626 /* If remote requests no-bonding follow that lead */
2627 if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
58797bf7 2628 return conn->remote_auth | (conn->auth_type & 0x01);
17fa4b9d
JH		 2629
2630 return conn->auth_type;
2631}
2632
0493684e
MH		 2633static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2634{
2635 struct hci_ev_io_capa_request *ev = (void *) skb->data;
2636 struct hci_conn *conn;
2637
2638 BT_DBG("%s", hdev->name);
2639
2640 hci_dev_lock(hdev);
2641
2642 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
03b555e1
JH		 2643 if (!conn)
2644 goto unlock;
2645
2646 hci_conn_hold(conn);
2647
2648 if (!test_bit(HCI_MGMT, &hdev->flags))
2649 goto unlock;
2650
2651 if (test_bit(HCI_PAIRABLE, &hdev->flags) ||
2652 (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
17fa4b9d
JH		 2653 struct hci_cp_io_capability_reply cp;
2654
2655 bacpy(&cp.bdaddr, &ev->bdaddr);
2656 cp.capability = conn->io_capability;
7cbc9bd9
JH		 2657 conn->auth_type = hci_get_auth_req(conn);
2658 cp.authentication = conn->auth_type;
17fa4b9d 2659
ce85ee13
SJ		 2660 if ((conn->out == 0x01 || conn->remote_oob == 0x01) &&
2661 hci_find_remote_oob_data(hdev, &conn->dst))
2662 cp.oob_data = 0x01;
2663 else
2664 cp.oob_data = 0x00;
2665
17fa4b9d
JH		 2666 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
2667 sizeof(cp), &cp);
03b555e1
JH		 2668 } else {
2669 struct hci_cp_io_capability_neg_reply cp;
2670
2671 bacpy(&cp.bdaddr, &ev->bdaddr);
9f5a0d7b 2672 cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
0493684e 2673
03b555e1
JH		 2674 hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
2675 sizeof(cp), &cp);
2676 }
2677
2678unlock:
2679 hci_dev_unlock(hdev);
2680}
2681
2682static inline void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
2683{
2684 struct hci_ev_io_capa_reply *ev = (void *) skb->data;
2685 struct hci_conn *conn;
2686
2687 BT_DBG("%s", hdev->name);
2688
2689 hci_dev_lock(hdev);
2690
2691 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2692 if (!conn)
2693 goto unlock;
2694
03b555e1
JH		 2695 conn->remote_cap = ev->capability;
2696 conn->remote_oob = ev->oob_data;
2697 conn->remote_auth = ev->authentication;
2698
2699unlock:
0493684e
MH		 2700 hci_dev_unlock(hdev);
2701}
2702
a5c29683
JH		 2703static inline void hci_user_confirm_request_evt(struct hci_dev *hdev,
2704 struct sk_buff *skb)
2705{
2706 struct hci_ev_user_confirm_req *ev = (void *) skb->data;
55bc1a37 2707 int loc_mitm, rem_mitm, confirm_hint = 0;
7a828908 2708 struct hci_conn *conn;
a5c29683
JH		 2709
2710 BT_DBG("%s", hdev->name);
2711
2712 hci_dev_lock(hdev);
2713
7a828908
JH		 2714 if (!test_bit(HCI_MGMT, &hdev->flags))
2715 goto unlock;
a5c29683 2716
7a828908
JH		 2717 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2718 if (!conn)
2719 goto unlock;
2720
2721 loc_mitm = (conn->auth_type & 0x01);
2722 rem_mitm = (conn->remote_auth & 0x01);
2723
2724 /* If we require MITM but the remote device can't provide that
2725 * (it has NoInputNoOutput) then reject the confirmation
2726 * request. The only exception is when we're dedicated bonding
2727 * initiators (connect_cfm_cb set) since then we always have the MITM
2728 * bit set. */
2729 if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
2730 BT_DBG("Rejecting request: remote device can't provide MITM");
2731 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
2732 sizeof(ev->bdaddr), &ev->bdaddr);
2733 goto unlock;
2734 }
2735
2736 /* If no side requires MITM protection; auto-accept */
2737 if ((!loc_mitm || conn->remote_cap == 0x03) &&
2738 (!rem_mitm || conn->io_capability == 0x03)) {
55bc1a37
JH		 2739
2740 /* If we're not the initiators request authorization to
2741 * proceed from user space (mgmt_user_confirm with
2742 * confirm_hint set to 1). */
2743 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend)) {
2744 BT_DBG("Confirming auto-accept as acceptor");
2745 confirm_hint = 1;
2746 goto confirm;
2747 }
2748
9f61656a
JH		 2749 BT_DBG("Auto-accept of user confirmation with %ums delay",
2750 hdev->auto_accept_delay);
2751
2752 if (hdev->auto_accept_delay > 0) {
2753 int delay = msecs_to_jiffies(hdev->auto_accept_delay);
2754 mod_timer(&conn->auto_accept_timer, jiffies + delay);
2755 goto unlock;
2756 }
2757
7a828908
JH		 2758 hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
2759 sizeof(ev->bdaddr), &ev->bdaddr);
2760 goto unlock;
2761 }
2762
55bc1a37 2763confirm:
744cf19e 2764 mgmt_user_confirm_request(hdev, &ev->bdaddr, ev->passkey,
55bc1a37 2765 confirm_hint);
7a828908
JH		 2766
2767unlock:
a5c29683
JH		 2768 hci_dev_unlock(hdev);
2769}
2770
0493684e
MH		 2771static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2772{
2773 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
2774 struct hci_conn *conn;
2775
2776 BT_DBG("%s", hdev->name);
2777
2778 hci_dev_lock(hdev);
2779
2780 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2a611692
JH		 2781 if (!conn)
2782 goto unlock;
2783
2784 /* To avoid duplicate auth_failed events to user space we check
2785 * the HCI_CONN_AUTH_PEND flag which will be set if we
2786 * initiated the authentication. A traditional auth_complete
2787 * event gets always produced as initiator and is also mapped to
2788 * the mgmt_auth_failed event */
2789 if (!test_bit(HCI_CONN_AUTH_PEND, &conn->pend) && ev->status != 0)
744cf19e 2790 mgmt_auth_failed(hdev, &conn->dst, ev->status);
0493684e 2791
2a611692
JH		 2792 hci_conn_put(conn);
2793
2794unlock:
0493684e
MH		 2795 hci_dev_unlock(hdev);
2796}
2797
41a96212
MH		 2798static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
2799{
2800 struct hci_ev_remote_host_features *ev = (void *) skb->data;
2801 struct inquiry_entry *ie;
2802
2803 BT_DBG("%s", hdev->name);
2804
2805 hci_dev_lock(hdev);
2806
cc11b9c1
AE		 2807 ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
2808 if (ie)
41a96212
MH		 2809 ie->data.ssp_mode = (ev->features[0] & 0x01);
2810
2811 hci_dev_unlock(hdev);
2812}
2813
2763eda6
SJ		 2814static inline void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
2815 struct sk_buff *skb)
2816{
2817 struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
2818 struct oob_data *data;
2819
2820 BT_DBG("%s", hdev->name);
2821
2822 hci_dev_lock(hdev);
2823
e1ba1f15
SJ		 2824 if (!test_bit(HCI_MGMT, &hdev->flags))
2825 goto unlock;
2826
2763eda6
SJ		 2827 data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
2828 if (data) {
2829 struct hci_cp_remote_oob_data_reply cp;
2830
2831 bacpy(&cp.bdaddr, &ev->bdaddr);
2832 memcpy(cp.hash, data->hash, sizeof(cp.hash));
2833 memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));
2834
2835 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
2836 &cp);
2837 } else {
2838 struct hci_cp_remote_oob_data_neg_reply cp;
2839
2840 bacpy(&cp.bdaddr, &ev->bdaddr);
2841 hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
2842 &cp);
2843 }
2844
e1ba1f15 2845unlock:
2763eda6
SJ		 2846 hci_dev_unlock(hdev);
2847}
2848
fcd89c09
VT		 2849static inline void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2850{
2851 struct hci_ev_le_conn_complete *ev = (void *) skb->data;
2852 struct hci_conn *conn;
2853
2854 BT_DBG("%s status %d", hdev->name, ev->status);
2855
2856 hci_dev_lock(hdev);
2857
2858 conn = hci_conn_hash_lookup_ba(hdev, LE_LINK, &ev->bdaddr);
b62f328b
VT		 2859 if (!conn) {
2860 conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
2861 if (!conn) {
2862 BT_ERR("No memory for new connection");
2863 hci_dev_unlock(hdev);
2864 return;
2865 }
29b7988a
AG		 2866
2867 conn->dst_type = ev->bdaddr_type;
b62f328b 2868 }
fcd89c09
VT		 2869
2870 if (ev->status) {
744cf19e 2871 mgmt_connect_failed(hdev, &ev->bdaddr, conn->type, ev->status);
fcd89c09
VT		 2872 hci_proto_connect_cfm(conn, ev->status);
2873 conn->state = BT_CLOSED;
2874 hci_conn_del(conn);
2875 goto unlock;
2876 }
2877
744cf19e 2878 mgmt_connected(hdev, &ev->bdaddr, conn->type);
83bc71b4 2879
7b5c0d52 2880 conn->sec_level = BT_SECURITY_LOW;
fcd89c09
VT		 2881 conn->handle = __le16_to_cpu(ev->handle);
2882 conn->state = BT_CONNECTED;
2883
2884 hci_conn_hold_device(conn);
2885 hci_conn_add_sysfs(conn);
2886
2887 hci_proto_connect_cfm(conn, ev->status);
2888
2889unlock:
2890 hci_dev_unlock(hdev);
2891}
2892
9aa04c91
AG		 2893static inline void hci_le_adv_report_evt(struct hci_dev *hdev,
2894 struct sk_buff *skb)
2895{
e95beb41
AG		 2896 u8 num_reports = skb->data[0];
2897 void *ptr = &skb->data[1];
9aa04c91
AG		 2898
2899 hci_dev_lock(hdev);
2900
e95beb41
AG		 2901 while (num_reports--) {
2902 struct hci_ev_le_advertising_info *ev = ptr;
9aa04c91 2903
9aa04c91 2904 hci_add_adv_entry(hdev, ev);
e95beb41
AG		 2905
2906 ptr += sizeof(*ev) + ev->length + 1;
9aa04c91
AG		 2907 }
2908
2909 hci_dev_unlock(hdev);
2910}
2911
a7a595f6
VCG		 2912static inline void hci_le_ltk_request_evt(struct hci_dev *hdev,
2913 struct sk_buff *skb)
2914{
2915 struct hci_ev_le_ltk_req *ev = (void *) skb->data;
2916 struct hci_cp_le_ltk_reply cp;
bea710fe 2917 struct hci_cp_le_ltk_neg_reply neg;
a7a595f6 2918 struct hci_conn *conn;
bea710fe 2919 struct link_key *ltk;
a7a595f6
VCG		 2920
2921 BT_DBG("%s handle %d", hdev->name, cpu_to_le16(ev->handle));
2922
2923 hci_dev_lock(hdev);
2924
2925 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
bea710fe
VCG		 2926 if (conn == NULL)
2927 goto not_found;
a7a595f6 2928
bea710fe
VCG		 2929 ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
2930 if (ltk == NULL)
2931 goto not_found;
2932
2933 memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
a7a595f6 2934 cp.handle = cpu_to_le16(conn->handle);
726b4ffc 2935 conn->pin_length = ltk->pin_len;
a7a595f6
VCG		 2936
2937 hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);
2938
2939 hci_dev_unlock(hdev);
bea710fe
VCG		 2940
2941 return;
2942
2943not_found:
2944 neg.handle = ev->handle;
2945 hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
2946 hci_dev_unlock(hdev);
a7a595f6
VCG		 2947}
2948
fcd89c09
VT		 2949static inline void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
2950{
2951 struct hci_ev_le_meta *le_ev = (void *) skb->data;
2952
2953 skb_pull(skb, sizeof(*le_ev));
2954
2955 switch (le_ev->subevent) {
2956 case HCI_EV_LE_CONN_COMPLETE:
2957 hci_le_conn_complete_evt(hdev, skb);
2958 break;
2959
9aa04c91
AG		 2960 case HCI_EV_LE_ADVERTISING_REPORT:
2961 hci_le_adv_report_evt(hdev, skb);
2962 break;
2963
a7a595f6
VCG		 2964 case HCI_EV_LE_LTK_REQ:
2965 hci_le_ltk_request_evt(hdev, skb);
2966 break;
2967
fcd89c09
VT		 2968 default:
2969 break;
2970 }
2971}
2972
a9de9248
MH		 2973void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
2974{
2975 struct hci_event_hdr *hdr = (void *) skb->data;
2976 __u8 event = hdr->evt;
2977
2978 skb_pull(skb, HCI_EVENT_HDR_SIZE);
2979
2980 switch (event) {
1da177e4
LT		 2981 case HCI_EV_INQUIRY_COMPLETE:
2982 hci_inquiry_complete_evt(hdev, skb);
2983 break;
2984
2985 case HCI_EV_INQUIRY_RESULT:
2986 hci_inquiry_result_evt(hdev, skb);
2987 break;
2988
a9de9248
MH		 2989 case HCI_EV_CONN_COMPLETE:
2990 hci_conn_complete_evt(hdev, skb);
21d9e30e
MH		 2991 break;
2992
1da177e4
LT		 2993 case HCI_EV_CONN_REQUEST:
2994 hci_conn_request_evt(hdev, skb);
2995 break;
2996
1da177e4
LT		 2997 case HCI_EV_DISCONN_COMPLETE:
2998 hci_disconn_complete_evt(hdev, skb);
2999 break;
3000
1da177e4
LT		 3001 case HCI_EV_AUTH_COMPLETE:
3002 hci_auth_complete_evt(hdev, skb);
3003 break;
3004
a9de9248
MH		 3005 case HCI_EV_REMOTE_NAME:
3006 hci_remote_name_evt(hdev, skb);
3007 break;
3008
1da177e4
LT		 3009 case HCI_EV_ENCRYPT_CHANGE:
3010 hci_encrypt_change_evt(hdev, skb);
3011 break;
3012
a9de9248
MH		 3013 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
3014 hci_change_link_key_complete_evt(hdev, skb);
3015 break;
3016
3017 case HCI_EV_REMOTE_FEATURES:
3018 hci_remote_features_evt(hdev, skb);
3019 break;
3020
3021 case HCI_EV_REMOTE_VERSION:
3022 hci_remote_version_evt(hdev, skb);
3023 break;
3024
3025 case HCI_EV_QOS_SETUP_COMPLETE:
3026 hci_qos_setup_complete_evt(hdev, skb);
3027 break;
3028
3029 case HCI_EV_CMD_COMPLETE:
3030 hci_cmd_complete_evt(hdev, skb);
3031 break;
3032
3033 case HCI_EV_CMD_STATUS:
3034 hci_cmd_status_evt(hdev, skb);
3035 break;
3036
3037 case HCI_EV_ROLE_CHANGE:
3038 hci_role_change_evt(hdev, skb);
3039 break;
3040
3041 case HCI_EV_NUM_COMP_PKTS:
3042 hci_num_comp_pkts_evt(hdev, skb);
3043 break;
3044
3045 case HCI_EV_MODE_CHANGE:
3046 hci_mode_change_evt(hdev, skb);
1da177e4
LT		 3047 break;
3048
3049 case HCI_EV_PIN_CODE_REQ:
3050 hci_pin_code_request_evt(hdev, skb);
3051 break;
3052
3053 case HCI_EV_LINK_KEY_REQ:
3054 hci_link_key_request_evt(hdev, skb);
3055 break;
3056
3057 case HCI_EV_LINK_KEY_NOTIFY:
3058 hci_link_key_notify_evt(hdev, skb);
3059 break;
3060
3061 case HCI_EV_CLOCK_OFFSET:
3062 hci_clock_offset_evt(hdev, skb);
3063 break;
3064
a8746417
MH		 3065 case HCI_EV_PKT_TYPE_CHANGE:
3066 hci_pkt_type_change_evt(hdev, skb);
3067 break;
3068
85a1e930
MH		 3069 case HCI_EV_PSCAN_REP_MODE:
3070 hci_pscan_rep_mode_evt(hdev, skb);
3071 break;
3072
a9de9248
MH		 3073 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
3074 hci_inquiry_result_with_rssi_evt(hdev, skb);
04837f64
MH		 3075 break;
3076
a9de9248
MH		 3077 case HCI_EV_REMOTE_EXT_FEATURES:
3078 hci_remote_ext_features_evt(hdev, skb);
1da177e4
LT		 3079 break;
3080
a9de9248
MH		 3081 case HCI_EV_SYNC_CONN_COMPLETE:
3082 hci_sync_conn_complete_evt(hdev, skb);
3083 break;
1da177e4 3084
a9de9248
MH		 3085 case HCI_EV_SYNC_CONN_CHANGED:
3086 hci_sync_conn_changed_evt(hdev, skb);
3087 break;
1da177e4 3088
a9de9248
MH		 3089 case HCI_EV_SNIFF_SUBRATE:
3090 hci_sniff_subrate_evt(hdev, skb);
3091 break;
1da177e4 3092
a9de9248
MH		 3093 case HCI_EV_EXTENDED_INQUIRY_RESULT:
3094 hci_extended_inquiry_result_evt(hdev, skb);
3095 break;
1da177e4 3096
0493684e
MH		 3097 case HCI_EV_IO_CAPA_REQUEST:
3098 hci_io_capa_request_evt(hdev, skb);
3099 break;
3100
03b555e1
JH		 3101 case HCI_EV_IO_CAPA_REPLY:
3102 hci_io_capa_reply_evt(hdev, skb);
3103 break;
3104
a5c29683
JH		 3105 case HCI_EV_USER_CONFIRM_REQUEST:
3106 hci_user_confirm_request_evt(hdev, skb);
3107 break;
3108
0493684e
MH		 3109 case HCI_EV_SIMPLE_PAIR_COMPLETE:
3110 hci_simple_pair_complete_evt(hdev, skb);
3111 break;
3112
41a96212
MH		 3113 case HCI_EV_REMOTE_HOST_FEATURES:
3114 hci_remote_host_features_evt(hdev, skb);
3115 break;
3116
fcd89c09
VT		 3117 case HCI_EV_LE_META:
3118 hci_le_meta_evt(hdev, skb);
3119 break;
3120
2763eda6
SJ		 3121 case HCI_EV_REMOTE_OOB_DATA_REQUEST:
3122 hci_remote_oob_data_request_evt(hdev, skb);
3123 break;
3124
a9de9248
MH		 3125 default:
3126 BT_DBG("%s event 0x%x", hdev->name, event);
1da177e4
LT		 3127 break;
3128 }
3129
3130 kfree_skb(skb);
3131 hdev->stat.evt_rx++;
3132}
3133
3134/* Generate internal stack event */
3135void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
3136{
3137 struct hci_event_hdr *hdr;
3138 struct hci_ev_stack_internal *ev;
3139 struct sk_buff *skb;
3140
3141 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
3142 if (!skb)
3143 return;
3144
3145 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
3146 hdr->evt = HCI_EV_STACK_INTERNAL;
3147 hdr->plen = sizeof(*ev) + dlen;
3148
3149 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
3150 ev->type = type;
3151 memcpy(ev->data, data, dlen);
3152
576c7d85 3153 bt_cb(skb)->incoming = 1;
a61bbcf2 3154 __net_timestamp(skb);
576c7d85 3155
0d48d939 3156 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
1da177e4 3157 skb->dev = (void *) hdev;
eec8d2bc 3158 hci_send_to_sock(hdev, skb, NULL);
1da177e4
LT		 3159 kfree_skb(skb);
3160}
e6100a25 3161
669bb396 3162module_param(enable_le, bool, 0644);
e6100a25 3163MODULE_PARM_DESC(enable_le, "Enable LE support");
kernel source for telekom puls (alcatel/mediatek)