hci_event.c 147.6 KB
Newer Older
1
/*
L
Linus Torvalds 已提交
2
   BlueZ - Bluetooth protocol stack for Linux
3
   Copyright (c) 2000-2001, 2010, Code Aurora Forum. All rights reserved.
L
Linus Torvalds 已提交
4 5 6 7 8 9 10 11 12 13 14

   Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>

   This program is free software; you can redistribute it and/or modify
   it under the terms of the GNU General Public License version 2 as
   published by the Free Software Foundation;

   THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
   OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
   FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
   IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
15 16 17
   CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
   WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
   ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
L
Linus Torvalds 已提交
18 19
   OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.

20 21
   ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
   COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
L
Linus Torvalds 已提交
22 23 24 25 26 27 28 29 30
   SOFTWARE IS DISCLAIMED.
*/

/* Bluetooth HCI event handling. */

#include <asm/unaligned.h>

#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>
31
#include <net/bluetooth/mgmt.h>
32

33
#include "hci_request.h"
34
#include "hci_debugfs.h"
35
#include "a2mp.h"
36
#include "amp.h"
37
#include "smp.h"
38
#include "msft.h"
L
Linus Torvalds 已提交
39

40 41 42
#define ZERO_KEY "\x00\x00\x00\x00\x00\x00\x00\x00" \
		 "\x00\x00\x00\x00\x00\x00\x00\x00"

L
Linus Torvalds 已提交
43 44
/* Handle HCI Event packets */

45
static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
46
{
47
	__u8 status = *((__u8 *) skb->data);
L
Linus Torvalds 已提交
48

49
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
L
Linus Torvalds 已提交
50

51
	if (status)
52
		return;
L
Linus Torvalds 已提交
53

54
	clear_bit(HCI_INQUIRY, &hdev->flags);
55
	smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
56
	wake_up_bit(&hdev->flags, HCI_INQUIRY);
57

58
	hci_dev_lock(hdev);
59 60 61 62 63 64
	/* Set discovery state to stopped if we're not doing LE active
	 * scanning.
	 */
	if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
	    hdev->le_scan_type != LE_SCAN_ACTIVE)
		hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
65 66
	hci_dev_unlock(hdev);

67 68
	hci_conn_check_pending(hdev);
}
69

70 71 72 73
static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

74
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
75 76 77 78

	if (status)
		return;

79
	hci_dev_set_flag(hdev, HCI_PERIODIC_INQ);
80 81
}

82 83 84
static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
85

86
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
87

88 89
	if (status)
		return;
L
Linus Torvalds 已提交
90

91
	hci_dev_clear_flag(hdev, HCI_PERIODIC_INQ);
92

93 94 95
	hci_conn_check_pending(hdev);
}

96 97
static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
					  struct sk_buff *skb)
98 99 100 101 102 103 104 105 106
{
	BT_DBG("%s", hdev->name);
}

static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_role_discovery *rp = (void *) skb->data;
	struct hci_conn *conn;

107
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
108 109 110 111 112 113 114

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
115 116
	if (conn)
		conn->role = rp->role;
117 118

	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
119 120
}

121 122 123 124 125
static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_link_policy *rp = (void *) skb->data;
	struct hci_conn *conn;

126
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
127 128 129 130 131 132 133 134 135 136 137 138 139

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
	if (conn)
		conn->link_policy = __le16_to_cpu(rp->policy);

	hci_dev_unlock(hdev);
}

140
static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
141
{
142
	struct hci_rp_write_link_policy *rp = (void *) skb->data;
L
Linus Torvalds 已提交
143
	struct hci_conn *conn;
144
	void *sent;
L
Linus Torvalds 已提交
145

146
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
L
Linus Torvalds 已提交
147

148 149
	if (rp->status)
		return;
L
Linus Torvalds 已提交
150

151 152 153
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
	if (!sent)
		return;
L
Linus Torvalds 已提交
154

155
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
156

157
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
158
	if (conn)
159
		conn->link_policy = get_unaligned_le16(sent + 2);
L
Linus Torvalds 已提交
160

161 162
	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
163

164 165
static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
					struct sk_buff *skb)
166 167 168
{
	struct hci_rp_read_def_link_policy *rp = (void *) skb->data;

169
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
170 171 172 173 174 175 176

	if (rp->status)
		return;

	hdev->link_policy = __le16_to_cpu(rp->policy);
}

177 178
static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
					 struct sk_buff *skb)
179 180 181 182
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;

183
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
184

185 186 187
	if (status)
		return;

188 189 190 191
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
	if (!sent)
		return;

192
	hdev->link_policy = get_unaligned_le16(sent);
193 194
}

195 196 197
static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
198

199
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
200

201 202
	clear_bit(HCI_RESET, &hdev->flags);

203 204 205
	if (status)
		return;

206
	/* Reset all non-persistent flags */
207
	hci_dev_clear_volatile_flags(hdev);
208

209 210
	hci_discovery_set_state(hdev, DISCOVERY_STOPPED);

211 212
	hdev->inq_tx_power = HCI_TX_POWER_INVALID;
	hdev->adv_tx_power = HCI_TX_POWER_INVALID;
213 214 215

	memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
	hdev->adv_data_len = 0;
216 217 218

	memset(hdev->scan_rsp_data, 0, sizeof(hdev->scan_rsp_data));
	hdev->scan_rsp_data_len = 0;
219

220 221
	hdev->le_scan_type = LE_SCAN_PASSIVE;

222
	hdev->ssp_debug_mode = 0;
223 224

	hci_bdaddr_list_clear(&hdev->le_white_list);
A
Ankit Navik 已提交
225
	hci_bdaddr_list_clear(&hdev->le_resolv_list);
226
}
227

228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245
static void hci_cc_read_stored_link_key(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	struct hci_rp_read_stored_link_key *rp = (void *)skb->data;
	struct hci_cp_read_stored_link_key *sent;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	sent = hci_sent_cmd_data(hdev, HCI_OP_READ_STORED_LINK_KEY);
	if (!sent)
		return;

	if (!rp->status && sent->read_all == 0x01) {
		hdev->stored_max_keys = rp->max_keys;
		hdev->stored_num_keys = rp->num_keys;
	}
}

246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261
static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
					  struct sk_buff *skb)
{
	struct hci_rp_delete_stored_link_key *rp = (void *)skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	if (rp->num_keys <= hdev->stored_num_keys)
		hdev->stored_num_keys -= rp->num_keys;
	else
		hdev->stored_num_keys = 0;
}

262 263 264 265
static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;
266

267
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
268

269 270 271
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
	if (!sent)
		return;
272

273 274
	hci_dev_lock(hdev);

275
	if (hci_dev_test_flag(hdev, HCI_MGMT))
276
		mgmt_set_local_name_complete(hdev, sent, status);
277 278
	else if (!status)
		memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
279

280
	hci_dev_unlock(hdev);
281 282 283 284 285 286
}

static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_local_name *rp = (void *) skb->data;

287
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
288 289 290 291

	if (rp->status)
		return;

292 293
	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG))
294
		memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
295 296 297 298 299 300 301
}

static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;

302
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
303 304 305 306 307

	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
	if (!sent)
		return;

308 309
	hci_dev_lock(hdev);

310 311 312 313 314 315 316
	if (!status) {
		__u8 param = *((__u8 *) sent);

		if (param == AUTH_ENABLED)
			set_bit(HCI_AUTH, &hdev->flags);
		else
			clear_bit(HCI_AUTH, &hdev->flags);
L
Linus Torvalds 已提交
317
	}
318

319
	if (hci_dev_test_flag(hdev, HCI_MGMT))
320
		mgmt_auth_enable_complete(hdev, status);
321 322

	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
323 324
}

325
static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
326
{
327
	__u8 status = *((__u8 *) skb->data);
328
	__u8 param;
L
Linus Torvalds 已提交
329 330
	void *sent;

331
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
L
Linus Torvalds 已提交
332

333 334 335
	if (status)
		return;

336 337 338
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
	if (!sent)
		return;
L
Linus Torvalds 已提交
339

340
	param = *((__u8 *) sent);
341

342 343 344 345
	if (param)
		set_bit(HCI_ENCRYPT, &hdev->flags);
	else
		clear_bit(HCI_ENCRYPT, &hdev->flags);
346
}
L
Linus Torvalds 已提交
347

348 349
static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
{
350 351
	__u8 status = *((__u8 *) skb->data);
	__u8 param;
352
	void *sent;
L
Linus Torvalds 已提交
353

354
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
L
Linus Torvalds 已提交
355

356 357 358
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
	if (!sent)
		return;
L
Linus Torvalds 已提交
359

360 361
	param = *((__u8 *) sent);

362 363
	hci_dev_lock(hdev);

364
	if (status) {
365 366 367 368
		hdev->discov_timeout = 0;
		goto done;
	}

369
	if (param & SCAN_INQUIRY)
370
		set_bit(HCI_ISCAN, &hdev->flags);
371 372
	else
		clear_bit(HCI_ISCAN, &hdev->flags);
373

374
	if (param & SCAN_PAGE)
375
		set_bit(HCI_PSCAN, &hdev->flags);
376
	else
377
		clear_bit(HCI_PSCAN, &hdev->flags);
L
Linus Torvalds 已提交
378

379
done:
380
	hci_dev_unlock(hdev);
381
}
L
Linus Torvalds 已提交
382

383 384 385
static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
L
Linus Torvalds 已提交
386

387
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
L
Linus Torvalds 已提交
388

389 390
	if (rp->status)
		return;
L
Linus Torvalds 已提交
391

392
	memcpy(hdev->dev_class, rp->dev_class, 3);
L
Linus Torvalds 已提交
393

394
	BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
395
	       hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
396
}
L
Linus Torvalds 已提交
397

398 399 400 401
static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;
L
Linus Torvalds 已提交
402

403
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
L
Linus Torvalds 已提交
404

405 406 407
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
	if (!sent)
		return;
L
Linus Torvalds 已提交
408

409 410 411 412 413
	hci_dev_lock(hdev);

	if (status == 0)
		memcpy(hdev->dev_class, sent, 3);

414
	if (hci_dev_test_flag(hdev, HCI_MGMT))
415 416 417
		mgmt_set_class_of_dev_complete(hdev, sent, status);

	hci_dev_unlock(hdev);
418
}
L
Linus Torvalds 已提交
419

420 421 422 423 424
static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_voice_setting *rp = (void *) skb->data;
	__u16 setting;

425
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
426 427 428 429 430 431

	if (rp->status)
		return;

	setting = __le16_to_cpu(rp->voice_setting);

432
	if (hdev->voice_setting == setting)
433 434 435 436
		return;

	hdev->voice_setting = setting;

437
	BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
438

439
	if (hdev->notify)
440 441 442
		hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
}

443 444
static void hci_cc_write_voice_setting(struct hci_dev *hdev,
				       struct sk_buff *skb)
445 446
{
	__u8 status = *((__u8 *) skb->data);
447
	__u16 setting;
448 449
	void *sent;

450
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
L
Linus Torvalds 已提交
451

452 453 454
	if (status)
		return;

455 456 457
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
	if (!sent)
		return;
L
Linus Torvalds 已提交
458

459
	setting = get_unaligned_le16(sent);
L
Linus Torvalds 已提交
460

461 462 463 464
	if (hdev->voice_setting == setting)
		return;

	hdev->voice_setting = setting;
L
Linus Torvalds 已提交
465

466
	BT_DBG("%s voice setting 0x%4.4x", hdev->name, setting);
L
Linus Torvalds 已提交
467

468
	if (hdev->notify)
469
		hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
L
Linus Torvalds 已提交
470 471
}

472 473 474 475 476 477 478 479 480 481 482 483 484 485 486
static void hci_cc_read_num_supported_iac(struct hci_dev *hdev,
					  struct sk_buff *skb)
{
	struct hci_rp_read_num_supported_iac *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	hdev->num_iac = rp->num_iac;

	BT_DBG("%s num iac %d", hdev->name, hdev->num_iac);
}

487 488 489
static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
490
	struct hci_cp_write_ssp_mode *sent;
491

492
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
493 494 495 496 497

	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
	if (!sent)
		return;

498 499
	hci_dev_lock(hdev);

500 501
	if (!status) {
		if (sent->mode)
502
			hdev->features[1][0] |= LMP_HOST_SSP;
503
		else
504
			hdev->features[1][0] &= ~LMP_HOST_SSP;
505 506
	}

507
	if (hci_dev_test_flag(hdev, HCI_MGMT))
508
		mgmt_ssp_enable_complete(hdev, sent->mode, status);
509
	else if (!status) {
510
		if (sent->mode)
511
			hci_dev_set_flag(hdev, HCI_SSP_ENABLED);
512
		else
513
			hci_dev_clear_flag(hdev, HCI_SSP_ENABLED);
514
	}
515 516

	hci_dev_unlock(hdev);
517 518
}

519 520 521 522 523 524 525 526 527 528 529
static void hci_cc_write_sc_support(struct hci_dev *hdev, struct sk_buff *skb)
{
	u8 status = *((u8 *) skb->data);
	struct hci_cp_write_sc_support *sent;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SC_SUPPORT);
	if (!sent)
		return;

530 531
	hci_dev_lock(hdev);

532 533 534 535 536 537 538
	if (!status) {
		if (sent->support)
			hdev->features[1][0] |= LMP_HOST_SC;
		else
			hdev->features[1][0] &= ~LMP_HOST_SC;
	}

539
	if (!hci_dev_test_flag(hdev, HCI_MGMT) && !status) {
540
		if (sent->support)
541
			hci_dev_set_flag(hdev, HCI_SC_ENABLED);
542
		else
543
			hci_dev_clear_flag(hdev, HCI_SC_ENABLED);
544
	}
545 546

	hci_dev_unlock(hdev);
547 548
}

549 550 551
static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_local_version *rp = (void *) skb->data;
552

553
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
554

555
	if (rp->status)
556
		return;
557

558 559
	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG)) {
560 561 562 563 564 565
		hdev->hci_ver = rp->hci_ver;
		hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
		hdev->lmp_ver = rp->lmp_ver;
		hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
		hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
	}
566 567
}

568 569
static void hci_cc_read_local_commands(struct hci_dev *hdev,
				       struct sk_buff *skb)
570 571
{
	struct hci_rp_read_local_commands *rp = (void *) skb->data;
L
Linus Torvalds 已提交
572

573
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
L
Linus Torvalds 已提交
574

575 576 577
	if (rp->status)
		return;

578 579
	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG))
580
		memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
581
}
L
Linus Torvalds 已提交
582

583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627
static void hci_cc_read_auth_payload_timeout(struct hci_dev *hdev,
					     struct sk_buff *skb)
{
	struct hci_rp_read_auth_payload_to *rp = (void *)skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
	if (conn)
		conn->auth_payload_timeout = __le16_to_cpu(rp->timeout);

	hci_dev_unlock(hdev);
}

static void hci_cc_write_auth_payload_timeout(struct hci_dev *hdev,
					      struct sk_buff *skb)
{
	struct hci_rp_write_auth_payload_to *rp = (void *)skb->data;
	struct hci_conn *conn;
	void *sent;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_PAYLOAD_TO);
	if (!sent)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
	if (conn)
		conn->auth_payload_timeout = get_unaligned_le16(sent + 2);

	hci_dev_unlock(hdev);
}

628 629
static void hci_cc_read_local_features(struct hci_dev *hdev,
				       struct sk_buff *skb)
630 631
{
	struct hci_rp_read_local_features *rp = (void *) skb->data;
632

633
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
L
Linus Torvalds 已提交
634

635 636
	if (rp->status)
		return;
637

638
	memcpy(hdev->features, rp->features, 8);
639

640 641
	/* Adjust default settings according to features
	 * supported by device. */
L
Linus Torvalds 已提交
642

643
	if (hdev->features[0][0] & LMP_3SLOT)
644
		hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
L
Linus Torvalds 已提交
645

646
	if (hdev->features[0][0] & LMP_5SLOT)
647
		hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
L
Linus Torvalds 已提交
648

649
	if (hdev->features[0][1] & LMP_HV2) {
650 651 652
		hdev->pkt_type  |= (HCI_HV2);
		hdev->esco_type |= (ESCO_HV2);
	}
L
Linus Torvalds 已提交
653

654
	if (hdev->features[0][1] & LMP_HV3) {
655 656 657
		hdev->pkt_type  |= (HCI_HV3);
		hdev->esco_type |= (ESCO_HV3);
	}
L
Linus Torvalds 已提交
658

659
	if (lmp_esco_capable(hdev))
660
		hdev->esco_type |= (ESCO_EV3);
661

662
	if (hdev->features[0][4] & LMP_EV4)
663
		hdev->esco_type |= (ESCO_EV4);
664

665
	if (hdev->features[0][4] & LMP_EV5)
666
		hdev->esco_type |= (ESCO_EV5);
L
Linus Torvalds 已提交
667

668
	if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
669 670
		hdev->esco_type |= (ESCO_2EV3);

671
	if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
672 673
		hdev->esco_type |= (ESCO_3EV3);

674
	if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
675
		hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
676
}
L
Linus Torvalds 已提交
677

678
static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
679
					   struct sk_buff *skb)
680 681 682
{
	struct hci_rp_read_local_ext_features *rp = (void *) skb->data;

683
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
684 685

	if (rp->status)
686
		return;
687

688 689
	if (hdev->max_page < rp->max_page)
		hdev->max_page = rp->max_page;
690

691 692
	if (rp->page < HCI_MAX_PAGES)
		memcpy(hdev->features[rp->page], rp->features, 8);
693 694
}

695
static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
696
					  struct sk_buff *skb)
697 698 699
{
	struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;

700
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
701

702 703 704 705
	if (rp->status)
		return;

	hdev->flow_ctl_mode = rp->mode;
706 707
}

708 709 710
static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_buffer_size *rp = (void *) skb->data;
L
Linus Torvalds 已提交
711

712
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
L
Linus Torvalds 已提交
713

714 715
	if (rp->status)
		return;
L
Linus Torvalds 已提交
716

717 718 719 720 721 722 723 724
	hdev->acl_mtu  = __le16_to_cpu(rp->acl_mtu);
	hdev->sco_mtu  = rp->sco_mtu;
	hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
	hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);

	if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
		hdev->sco_mtu  = 64;
		hdev->sco_pkts = 8;
L
Linus Torvalds 已提交
725
	}
726 727 728 729

	hdev->acl_cnt = hdev->acl_pkts;
	hdev->sco_cnt = hdev->sco_pkts;

730 731
	BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name, hdev->acl_mtu,
	       hdev->acl_pkts, hdev->sco_mtu, hdev->sco_pkts);
732 733 734 735 736 737
}

static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_bd_addr *rp = (void *) skb->data;

738
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
739

740 741 742 743
	if (rp->status)
		return;

	if (test_bit(HCI_INIT, &hdev->flags))
744
		bacpy(&hdev->bdaddr, &rp->bdaddr);
745

746
	if (hci_dev_test_flag(hdev, HCI_SETUP))
747
		bacpy(&hdev->setup_addr, &rp->bdaddr);
748 749
}

750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766
static void hci_cc_read_local_pairing_opts(struct hci_dev *hdev,
					   struct sk_buff *skb)
{
	struct hci_rp_read_local_pairing_opts *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG)) {
		hdev->pairing_opts = rp->pairing_opts;
		hdev->max_enc_key_size = rp->max_key_size;
	}
}

767 768 769 770 771 772 773
static void hci_cc_read_page_scan_activity(struct hci_dev *hdev,
					   struct sk_buff *skb)
{
	struct hci_rp_read_page_scan_activity *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

774 775 776 777
	if (rp->status)
		return;

	if (test_bit(HCI_INIT, &hdev->flags)) {
778 779 780 781 782
		hdev->page_scan_interval = __le16_to_cpu(rp->interval);
		hdev->page_scan_window = __le16_to_cpu(rp->window);
	}
}

783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801
static void hci_cc_write_page_scan_activity(struct hci_dev *hdev,
					    struct sk_buff *skb)
{
	u8 status = *((u8 *) skb->data);
	struct hci_cp_write_page_scan_activity *sent;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_ACTIVITY);
	if (!sent)
		return;

	hdev->page_scan_interval = __le16_to_cpu(sent->interval);
	hdev->page_scan_window = __le16_to_cpu(sent->window);
}

802 803 804 805 806 807 808
static void hci_cc_read_page_scan_type(struct hci_dev *hdev,
					   struct sk_buff *skb)
{
	struct hci_rp_read_page_scan_type *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

809 810 811 812
	if (rp->status)
		return;

	if (test_bit(HCI_INIT, &hdev->flags))
813 814 815
		hdev->page_scan_type = rp->type;
}

816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831
static void hci_cc_write_page_scan_type(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	u8 status = *((u8 *) skb->data);
	u8 *type;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	type = hci_sent_cmd_data(hdev, HCI_OP_WRITE_PAGE_SCAN_TYPE);
	if (type)
		hdev->page_scan_type = *type;
}

832
static void hci_cc_read_data_block_size(struct hci_dev *hdev,
833
					struct sk_buff *skb)
834 835 836
{
	struct hci_rp_read_data_block_size *rp = (void *) skb->data;

837
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
838 839 840 841 842 843 844 845 846 847 848

	if (rp->status)
		return;

	hdev->block_mtu = __le16_to_cpu(rp->max_acl_len);
	hdev->block_len = __le16_to_cpu(rp->block_len);
	hdev->num_blocks = __le16_to_cpu(rp->num_blocks);

	hdev->block_cnt = hdev->num_blocks;

	BT_DBG("%s blk mtu %d cnt %d len %d", hdev->name, hdev->block_mtu,
849
	       hdev->block_cnt, hdev->block_len);
850 851
}

852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886
static void hci_cc_read_clock(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_clock *rp = (void *) skb->data;
	struct hci_cp_read_clock *cp;
	struct hci_conn *conn;

	BT_DBG("%s", hdev->name);

	if (skb->len < sizeof(*rp))
		return;

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	cp = hci_sent_cmd_data(hdev, HCI_OP_READ_CLOCK);
	if (!cp)
		goto unlock;

	if (cp->which == 0x00) {
		hdev->clock = le32_to_cpu(rp->clock);
		goto unlock;
	}

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
	if (conn) {
		conn->clock = le32_to_cpu(rp->clock);
		conn->clock_accuracy = le16_to_cpu(rp->accuracy);
	}

unlock:
	hci_dev_unlock(hdev);
}

887
static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
888
				       struct sk_buff *skb)
889 890 891
{
	struct hci_rp_read_local_amp_info *rp = (void *) skb->data;

892
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
893 894

	if (rp->status)
895
		return;
896 897 898 899 900 901 902 903 904 905 906 907 908

	hdev->amp_status = rp->amp_status;
	hdev->amp_total_bw = __le32_to_cpu(rp->total_bw);
	hdev->amp_max_bw = __le32_to_cpu(rp->max_bw);
	hdev->amp_min_latency = __le32_to_cpu(rp->min_latency);
	hdev->amp_max_pdu = __le32_to_cpu(rp->max_pdu);
	hdev->amp_type = rp->amp_type;
	hdev->amp_pal_cap = __le16_to_cpu(rp->pal_cap);
	hdev->amp_assoc_size = __le16_to_cpu(rp->max_assoc_size);
	hdev->amp_be_flush_to = __le32_to_cpu(rp->be_flush_to);
	hdev->amp_max_flush_to = __le32_to_cpu(rp->max_flush_to);
}

909
static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
910
					 struct sk_buff *skb)
911
{
912
	struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
913

914
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
915

916 917 918 919
	if (rp->status)
		return;

	hdev->inq_tx_power = rp->tx_power;
920 921
}

922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952
static void hci_cc_read_def_err_data_reporting(struct hci_dev *hdev,
					       struct sk_buff *skb)
{
	struct hci_rp_read_def_err_data_reporting *rp = (void *)skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	hdev->err_data_reporting = rp->err_data_reporting;
}

static void hci_cc_write_def_err_data_reporting(struct hci_dev *hdev,
						struct sk_buff *skb)
{
	__u8 status = *((__u8 *)skb->data);
	struct hci_cp_write_def_err_data_reporting *cp;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_ERR_DATA_REPORTING);
	if (!cp)
		return;

	hdev->err_data_reporting = cp->err_data_reporting;
}

953 954 955 956 957 958
static void hci_cc_pin_code_reply(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_pin_code_reply *rp = (void *) skb->data;
	struct hci_cp_pin_code_reply *cp;
	struct hci_conn *conn;

959
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
960

961 962
	hci_dev_lock(hdev);

963
	if (hci_dev_test_flag(hdev, HCI_MGMT))
964
		mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
965

966
	if (rp->status)
967
		goto unlock;
968 969 970

	cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
	if (!cp)
971
		goto unlock;
972 973 974 975

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
	if (conn)
		conn->pin_length = cp->pin_len;
976 977 978

unlock:
	hci_dev_unlock(hdev);
979 980 981 982 983 984
}

static void hci_cc_pin_code_neg_reply(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_pin_code_neg_reply *rp = (void *) skb->data;

985
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
986

987 988
	hci_dev_lock(hdev);

989
	if (hci_dev_test_flag(hdev, HCI_MGMT))
990
		mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
991
						 rp->status);
992 993

	hci_dev_unlock(hdev);
994
}
995

996 997 998 999 1000
static void hci_cc_le_read_buffer_size(struct hci_dev *hdev,
				       struct sk_buff *skb)
{
	struct hci_rp_le_read_buffer_size *rp = (void *) skb->data;

1001
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012

	if (rp->status)
		return;

	hdev->le_mtu = __le16_to_cpu(rp->le_mtu);
	hdev->le_pkts = rp->le_max_pkt;

	hdev->le_cnt = hdev->le_pkts;

	BT_DBG("%s le mtu %d:%d", hdev->name, hdev->le_mtu, hdev->le_pkts);
}
1013

1014 1015 1016 1017 1018 1019 1020
static void hci_cc_le_read_local_features(struct hci_dev *hdev,
					  struct sk_buff *skb)
{
	struct hci_rp_le_read_local_features *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

1021 1022 1023 1024
	if (rp->status)
		return;

	memcpy(hdev->le_features, rp->features, 8);
1025 1026
}

1027 1028 1029 1030 1031 1032 1033
static void hci_cc_le_read_adv_tx_power(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	struct hci_rp_le_read_adv_tx_power *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

1034 1035 1036 1037
	if (rp->status)
		return;

	hdev->adv_tx_power = rp->tx_power;
1038 1039
}

1040 1041 1042 1043
static void hci_cc_user_confirm_reply(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

1044
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1045

1046 1047
	hci_dev_lock(hdev);

1048
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1049 1050
		mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
						 rp->status);
1051 1052

	hci_dev_unlock(hdev);
1053 1054 1055
}

static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
1056
					  struct sk_buff *skb)
1057 1058 1059
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

1060
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1061

1062 1063
	hci_dev_lock(hdev);

1064
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1065
		mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
1066
						     ACL_LINK, 0, rp->status);
1067 1068

	hci_dev_unlock(hdev);
1069 1070
}

1071 1072 1073 1074
static void hci_cc_user_passkey_reply(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

1075
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1076 1077 1078

	hci_dev_lock(hdev);

1079
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1080
		mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
1081
						 0, rp->status);
1082 1083 1084 1085 1086

	hci_dev_unlock(hdev);
}

static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
1087
					  struct sk_buff *skb)
1088 1089 1090
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

1091
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1092 1093 1094

	hci_dev_lock(hdev);

1095
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1096
		mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
1097
						     ACL_LINK, 0, rp->status);
1098 1099 1100 1101

	hci_dev_unlock(hdev);
}

1102 1103
static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
				       struct sk_buff *skb)
1104 1105 1106
{
	struct hci_rp_read_local_oob_data *rp = (void *) skb->data;

1107
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1108 1109 1110 1111 1112 1113 1114 1115
}

static void hci_cc_read_local_oob_ext_data(struct hci_dev *hdev,
					   struct sk_buff *skb)
{
	struct hci_rp_read_local_oob_ext_data *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1116 1117
}

1118 1119 1120 1121 1122 1123 1124
static void hci_cc_le_set_random_addr(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	bdaddr_t *sent;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

1125 1126 1127
	if (status)
		return;

1128 1129 1130 1131 1132 1133
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
	if (!sent)
		return;

	hci_dev_lock(hdev);

1134
	bacpy(&hdev->random_addr, sent);
1135 1136 1137 1138

	hci_dev_unlock(hdev);
}

1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160
static void hci_cc_le_set_default_phy(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	struct hci_cp_le_set_default_phy *cp;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_DEFAULT_PHY);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	hdev->le_tx_def_phys = cp->tx_phys;
	hdev->le_rx_def_phys = cp->rx_phys;

	hci_dev_unlock(hdev);
}

1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189
static void hci_cc_le_set_adv_set_random_addr(struct hci_dev *hdev,
                                              struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	struct hci_cp_le_set_adv_set_rand_addr *cp;
	struct adv_info *adv_instance;

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_SET_RAND_ADDR);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	if (!hdev->cur_adv_instance) {
		/* Store in hdev for instance 0 (Set adv and Directed advs) */
		bacpy(&hdev->random_addr, &cp->bdaddr);
	} else {
		adv_instance = hci_find_adv_instance(hdev,
						     hdev->cur_adv_instance);
		if (adv_instance)
			bacpy(&adv_instance->random_addr, &cp->bdaddr);
	}

	hci_dev_unlock(hdev);
}

1190 1191 1192 1193 1194 1195
static void hci_cc_le_set_adv_enable(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 *sent, status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

1196
	if (status)
1197 1198
		return;

1199 1200
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
	if (!sent)
1201 1202
		return;

1203 1204
	hci_dev_lock(hdev);

S
Stephen Hemminger 已提交
1205
	/* If we're doing connection initiation as peripheral. Set a
1206 1207 1208 1209 1210
	 * timeout in case something goes wrong.
	 */
	if (*sent) {
		struct hci_conn *conn;

1211
		hci_dev_set_flag(hdev, HCI_LE_ADV);
1212

1213
		conn = hci_lookup_le_connect(hdev);
1214 1215 1216
		if (conn)
			queue_delayed_work(hdev->workqueue,
					   &conn->le_conn_timeout,
1217
					   conn->conn_timeout);
1218
	} else {
1219
		hci_dev_clear_flag(hdev, HCI_LE_ADV);
1220 1221
	}

1222
	hci_dev_unlock(hdev);
1223 1224
}

1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251
static void hci_cc_le_set_ext_adv_enable(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	struct hci_cp_le_set_ext_adv_enable *cp;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_EXT_ADV_ENABLE);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	if (cp->enable) {
		struct hci_conn *conn;

		hci_dev_set_flag(hdev, HCI_LE_ADV);

		conn = hci_lookup_le_connect(hdev);
		if (conn)
			queue_delayed_work(hdev->workqueue,
					   &conn->le_conn_timeout,
					   conn->conn_timeout);
1252 1253
	} else {
		hci_dev_clear_flag(hdev, HCI_LE_ADV);
1254 1255 1256 1257 1258
	}

	hci_dev_unlock(hdev);
}

1259 1260 1261 1262 1263 1264 1265
static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_cp_le_set_scan_param *cp;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

1266 1267 1268
	if (status)
		return;

1269 1270 1271 1272 1273 1274
	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
	if (!cp)
		return;

	hci_dev_lock(hdev);

1275
	hdev->le_scan_type = cp->type;
1276 1277 1278 1279

	hci_dev_unlock(hdev);
}

1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304
static void hci_cc_le_set_ext_scan_param(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	struct hci_cp_le_set_ext_scan_params *cp;
	__u8 status = *((__u8 *) skb->data);
	struct hci_cp_le_scan_phy_params *phy_param;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_EXT_SCAN_PARAMS);
	if (!cp)
		return;

	phy_param = (void *)cp->data;

	hci_dev_lock(hdev);

	hdev->le_scan_type = phy_param->type;

	hci_dev_unlock(hdev);
}

1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320
static bool has_pending_adv_report(struct hci_dev *hdev)
{
	struct discovery_state *d = &hdev->discovery;

	return bacmp(&d->last_adv_addr, BDADDR_ANY);
}

static void clear_pending_adv_report(struct hci_dev *hdev)
{
	struct discovery_state *d = &hdev->discovery;

	bacpy(&d->last_adv_addr, BDADDR_ANY);
	d->last_adv_data_len = 0;
}

static void store_pending_adv_report(struct hci_dev *hdev, bdaddr_t *bdaddr,
1321 1322
				     u8 bdaddr_type, s8 rssi, u32 flags,
				     u8 *data, u8 len)
1323 1324 1325 1326 1327
{
	struct discovery_state *d = &hdev->discovery;

	bacpy(&d->last_adv_addr, bdaddr);
	d->last_adv_addr_type = bdaddr_type;
1328
	d->last_adv_rssi = rssi;
1329
	d->last_adv_flags = flags;
1330 1331 1332 1333
	memcpy(d->last_adv_data, data, len);
	d->last_adv_data_len = len;
}

1334
static void le_set_scan_enable_complete(struct hci_dev *hdev, u8 enable)
1335
{
1336 1337
	hci_dev_lock(hdev);

1338
	switch (enable) {
1339
	case LE_SCAN_ENABLE:
1340
		hci_dev_set_flag(hdev, HCI_LE_SCAN);
1341 1342
		if (hdev->le_scan_type == LE_SCAN_ACTIVE)
			clear_pending_adv_report(hdev);
1343 1344
		break;

1345
	case LE_SCAN_DISABLE:
1346 1347 1348 1349 1350 1351 1352 1353
		/* We do this here instead of when setting DISCOVERY_STOPPED
		 * since the latter would potentially require waiting for
		 * inquiry to stop too.
		 */
		if (has_pending_adv_report(hdev)) {
			struct discovery_state *d = &hdev->discovery;

			mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
1354
					  d->last_adv_addr_type, NULL,
1355
					  d->last_adv_rssi, d->last_adv_flags,
1356
					  d->last_adv_data,
1357 1358 1359
					  d->last_adv_data_len, NULL, 0);
		}

1360 1361 1362 1363 1364
		/* Cancel this timer so that we don't try to disable scanning
		 * when it's already disabled.
		 */
		cancel_delayed_work(&hdev->le_scan_disable);

1365
		hci_dev_clear_flag(hdev, HCI_LE_SCAN);
1366

1367 1368
		/* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
		 * interrupted scanning due to a connect request. Mark
1369 1370 1371 1372
		 * therefore discovery as stopped. If this was not
		 * because of a connect request advertising might have
		 * been disabled because of active scanning, so
		 * re-enable it again if necessary.
1373
		 */
1374
		if (hci_dev_test_and_clear_flag(hdev, HCI_LE_SCAN_INTERRUPTED))
1375
			hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1376
		else if (!hci_dev_test_flag(hdev, HCI_LE_ADV) &&
1377
			 hdev->discovery.state == DISCOVERY_FINDING)
1378
			hci_req_reenable_advertising(hdev);
1379

1380 1381 1382
		break;

	default:
1383
		bt_dev_err(hdev, "use of reserved LE_Scan_Enable param %d",
1384
			   enable);
1385
		break;
1386
	}
1387 1388

	hci_dev_unlock(hdev);
1389 1390
}

1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408
static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
				      struct sk_buff *skb)
{
	struct hci_cp_le_set_scan_enable *cp;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_ENABLE);
	if (!cp)
		return;

	le_set_scan_enable_complete(hdev, cp->enable);
}

1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426
static void hci_cc_le_set_ext_scan_enable(struct hci_dev *hdev,
				      struct sk_buff *skb)
{
	struct hci_cp_le_set_ext_scan_enable *cp;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_EXT_SCAN_ENABLE);
	if (!cp)
		return;

	le_set_scan_enable_complete(hdev, cp->enable);
}

1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440
static void hci_cc_le_read_num_adv_sets(struct hci_dev *hdev,
				      struct sk_buff *skb)
{
	struct hci_rp_le_read_num_supported_adv_sets *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x No of Adv sets %u", hdev->name, rp->status,
	       rp->num_of_sets);

	if (rp->status)
		return;

	hdev->le_num_of_adv_sets = rp->num_of_sets;
}

1441 1442 1443 1444 1445 1446 1447
static void hci_cc_le_read_white_list_size(struct hci_dev *hdev,
					   struct sk_buff *skb)
{
	struct hci_rp_le_read_white_list_size *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);

1448 1449 1450 1451
	if (rp->status)
		return;

	hdev->le_white_list_size = rp->size;
1452 1453
}

1454 1455 1456 1457 1458 1459 1460
static void hci_cc_le_clear_white_list(struct hci_dev *hdev,
				       struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

1461 1462 1463
	if (status)
		return;

1464
	hci_bdaddr_list_clear(&hdev->le_white_list);
1465 1466 1467 1468 1469 1470 1471 1472 1473 1474
}

static void hci_cc_le_add_to_white_list(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	struct hci_cp_le_add_to_white_list *sent;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

1475 1476 1477
	if (status)
		return;

1478 1479 1480 1481
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_WHITE_LIST);
	if (!sent)
		return;

1482 1483
	hci_bdaddr_list_add(&hdev->le_white_list, &sent->bdaddr,
			   sent->bdaddr_type);
1484 1485 1486 1487 1488 1489 1490 1491 1492 1493
}

static void hci_cc_le_del_from_white_list(struct hci_dev *hdev,
					  struct sk_buff *skb)
{
	struct hci_cp_le_del_from_white_list *sent;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

1494 1495 1496
	if (status)
		return;

1497 1498 1499 1500
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_WHITE_LIST);
	if (!sent)
		return;

1501 1502
	hci_bdaddr_list_del(&hdev->le_white_list, &sent->bdaddr,
			    sent->bdaddr_type);
1503 1504
}

1505 1506 1507 1508 1509 1510 1511
static void hci_cc_le_read_supported_states(struct hci_dev *hdev,
					    struct sk_buff *skb)
{
	struct hci_rp_le_read_supported_states *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

1512 1513 1514 1515
	if (rp->status)
		return;

	memcpy(hdev->le_states, rp->le_states, 8);
1516 1517
}

1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550
static void hci_cc_le_read_def_data_len(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	struct hci_rp_le_read_def_data_len *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	hdev->le_def_tx_len = le16_to_cpu(rp->tx_len);
	hdev->le_def_tx_time = le16_to_cpu(rp->tx_time);
}

static void hci_cc_le_write_def_data_len(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	struct hci_cp_le_write_def_data_len *sent;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_WRITE_DEF_DATA_LEN);
	if (!sent)
		return;

	hdev->le_def_tx_len = le16_to_cpu(sent->tx_len);
	hdev->le_def_tx_time = le16_to_cpu(sent->tx_time);
}

1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589
static void hci_cc_le_add_to_resolv_list(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	struct hci_cp_le_add_to_resolv_list *sent;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_RESOLV_LIST);
	if (!sent)
		return;

	hci_bdaddr_list_add_with_irk(&hdev->le_resolv_list, &sent->bdaddr,
				sent->bdaddr_type, sent->peer_irk,
				sent->local_irk);
}

static void hci_cc_le_del_from_resolv_list(struct hci_dev *hdev,
					  struct sk_buff *skb)
{
	struct hci_cp_le_del_from_resolv_list *sent;
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_RESOLV_LIST);
	if (!sent)
		return;

	hci_bdaddr_list_del_with_irk(&hdev->le_resolv_list, &sent->bdaddr,
			    sent->bdaddr_type);
}

1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602
static void hci_cc_le_clear_resolv_list(struct hci_dev *hdev,
				       struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	hci_bdaddr_list_clear(&hdev->le_resolv_list);
}

A
Ankit Navik 已提交
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615
static void hci_cc_le_read_resolv_list_size(struct hci_dev *hdev,
					   struct sk_buff *skb)
{
	struct hci_rp_le_read_resolv_list_size *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x size %u", hdev->name, rp->status, rp->size);

	if (rp->status)
		return;

	hdev->le_resolv_list_size = rp->size;
}

1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639
static void hci_cc_le_set_addr_resolution_enable(struct hci_dev *hdev,
						struct sk_buff *skb)
{
	__u8 *sent, status = *((__u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADDR_RESOLV_ENABLE);
	if (!sent)
		return;

	hci_dev_lock(hdev);

	if (*sent)
		hci_dev_set_flag(hdev, HCI_LL_RPA_RESOLUTION);
	else
		hci_dev_clear_flag(hdev, HCI_LL_RPA_RESOLUTION);

	hci_dev_unlock(hdev);
}

1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655
static void hci_cc_le_read_max_data_len(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	struct hci_rp_le_read_max_data_len *rp = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	hdev->le_max_tx_len = le16_to_cpu(rp->tx_len);
	hdev->le_max_tx_time = le16_to_cpu(rp->tx_time);
	hdev->le_max_rx_len = le16_to_cpu(rp->rx_len);
	hdev->le_max_rx_time = le16_to_cpu(rp->rx_time);
}

1656 1657
static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
					   struct sk_buff *skb)
1658
{
1659
	struct hci_cp_write_le_host_supported *sent;
1660 1661
	__u8 status = *((__u8 *) skb->data);

1662
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1663

1664 1665 1666
	if (status)
		return;

1667
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
1668
	if (!sent)
1669 1670
		return;

1671 1672
	hci_dev_lock(hdev);

1673 1674
	if (sent->le) {
		hdev->features[1][0] |= LMP_HOST_LE;
1675
		hci_dev_set_flag(hdev, HCI_LE_ENABLED);
1676 1677
	} else {
		hdev->features[1][0] &= ~LMP_HOST_LE;
1678 1679
		hci_dev_clear_flag(hdev, HCI_LE_ENABLED);
		hci_dev_clear_flag(hdev, HCI_ADVERTISING);
1680
	}
1681 1682 1683 1684 1685

	if (sent->simul)
		hdev->features[1][0] |= LMP_HOST_LE_BREDR;
	else
		hdev->features[1][0] &= ~LMP_HOST_LE_BREDR;
1686 1687

	hci_dev_unlock(hdev);
1688 1689
}

1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708
static void hci_cc_set_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_cp_le_set_adv_param *cp;
	u8 status = *((u8 *) skb->data);

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_PARAM);
	if (!cp)
		return;

	hci_dev_lock(hdev);
	hdev->adv_addr_type = cp->own_address_type;
	hci_dev_unlock(hdev);
}

1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734
static void hci_cc_set_ext_adv_param(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_le_set_ext_adv_params *rp = (void *) skb->data;
	struct hci_cp_le_set_ext_adv_params *cp;
	struct adv_info *adv_instance;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_EXT_ADV_PARAMS);
	if (!cp)
		return;

	hci_dev_lock(hdev);
	hdev->adv_addr_type = cp->own_addr_type;
	if (!hdev->cur_adv_instance) {
		/* Store in hdev for instance 0 */
		hdev->adv_tx_power = rp->tx_power;
	} else {
		adv_instance = hci_find_adv_instance(hdev,
						     hdev->cur_adv_instance);
		if (adv_instance)
			adv_instance->tx_power = rp->tx_power;
	}
1735 1736
	/* Update adv data as tx power is known now */
	hci_req_update_adv_data(hdev, hdev->cur_adv_instance);
1737 1738 1739
	hci_dev_unlock(hdev);
}

1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758
static void hci_cc_read_rssi(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_read_rssi *rp = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
	if (conn)
		conn->rssi = rp->rssi;

	hci_dev_unlock(hdev);
}

1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776
static void hci_cc_read_tx_power(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_cp_read_tx_power *sent;
	struct hci_rp_read_tx_power *rp = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);

	if (rp->status)
		return;

	sent = hci_sent_cmd_data(hdev, HCI_OP_READ_TX_POWER);
	if (!sent)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
1777 1778 1779 1780 1781
	if (!conn)
		goto unlock;

	switch (sent->type) {
	case 0x00:
1782
		conn->tx_power = rp->tx_power;
1783 1784 1785 1786 1787
		break;
	case 0x01:
		conn->max_tx_power = rp->tx_power;
		break;
	}
1788

1789
unlock:
1790 1791 1792
	hci_dev_unlock(hdev);
}

1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807
static void hci_cc_write_ssp_debug_mode(struct hci_dev *hdev, struct sk_buff *skb)
{
	u8 status = *((u8 *) skb->data);
	u8 *mode;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (status)
		return;

	mode = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_DEBUG_MODE);
	if (mode)
		hdev->ssp_debug_mode = *mode;
}

1808
static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
1809
{
1810
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1811 1812 1813

	if (status) {
		hci_conn_check_pending(hdev);
1814 1815 1816
		return;
	}

1817
	set_bit(HCI_INQUIRY, &hdev->flags);
L
Linus Torvalds 已提交
1818 1819
}

1820
static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1821
{
1822
	struct hci_cp_create_conn *cp;
L
Linus Torvalds 已提交
1823 1824
	struct hci_conn *conn;

1825
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1826 1827

	cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
L
Linus Torvalds 已提交
1828 1829 1830 1831 1832 1833 1834
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);

1835
	BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
L
Linus Torvalds 已提交
1836 1837 1838

	if (status) {
		if (conn && conn->state == BT_CONNECT) {
1839 1840
			if (status != 0x0c || conn->attempt > 2) {
				conn->state = BT_CLOSED;
1841
				hci_connect_cfm(conn, status);
1842 1843 1844
				hci_conn_del(conn);
			} else
				conn->state = BT_CONNECT2;
L
Linus Torvalds 已提交
1845 1846 1847
		}
	} else {
		if (!conn) {
1848 1849 1850
			conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr,
					    HCI_ROLE_MASTER);
			if (!conn)
1851
				bt_dev_err(hdev, "no memory for new connection");
L
Linus Torvalds 已提交
1852 1853 1854 1855 1856 1857
		}
	}

	hci_dev_unlock(hdev);
}

1858
static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1859
{
1860 1861 1862
	struct hci_cp_add_sco *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;
L
Linus Torvalds 已提交
1863

1864
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1865

1866 1867
	if (!status)
		return;
L
Linus Torvalds 已提交
1868

1869 1870 1871
	cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
	if (!cp)
		return;
L
Linus Torvalds 已提交
1872

1873
	handle = __le16_to_cpu(cp->handle);
L
Linus Torvalds 已提交
1874

1875
	BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
L
Linus Torvalds 已提交
1876

1877
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
1878

1879
	acl = hci_conn_hash_lookup_handle(hdev, handle);
1880 1881 1882 1883
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;
L
Linus Torvalds 已提交
1884

1885
			hci_connect_cfm(sco, status);
1886 1887
			hci_conn_del(sco);
		}
1888
	}
L
Linus Torvalds 已提交
1889

1890 1891
	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
1892

1893 1894 1895 1896 1897
static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_auth_requested *cp;
	struct hci_conn *conn;

1898
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
	if (conn) {
		if (conn->state == BT_CONFIG) {
1912
			hci_connect_cfm(conn, status);
1913
			hci_conn_drop(conn);
1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924
		}
	}

	hci_dev_unlock(hdev);
}

static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_set_conn_encrypt *cp;
	struct hci_conn *conn;

1925
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
	if (conn) {
		if (conn->state == BT_CONFIG) {
1939
			hci_connect_cfm(conn, status);
1940
			hci_conn_drop(conn);
1941 1942 1943 1944 1945 1946
		}
	}

	hci_dev_unlock(hdev);
}

1947
static int hci_outgoing_auth_needed(struct hci_dev *hdev,
1948
				    struct hci_conn *conn)
1949 1950 1951 1952
{
	if (conn->state != BT_CONFIG || !conn->out)
		return 0;

1953
	if (conn->pending_sec_level == BT_SECURITY_SDP)
1954 1955 1956
		return 0;

	/* Only request authentication for SSP connections or non-SSP
1957 1958 1959
	 * devices with sec_level MEDIUM or HIGH or if MITM protection
	 * is requested.
	 */
1960
	if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
1961
	    conn->pending_sec_level != BT_SECURITY_FIPS &&
1962 1963
	    conn->pending_sec_level != BT_SECURITY_HIGH &&
	    conn->pending_sec_level != BT_SECURITY_MEDIUM)
1964 1965 1966 1967 1968
		return 0;

	return 1;
}

1969
static int hci_resolve_name(struct hci_dev *hdev,
1970
				   struct inquiry_entry *e)
1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983
{
	struct hci_cp_remote_name_req cp;

	memset(&cp, 0, sizeof(cp));

	bacpy(&cp.bdaddr, &e->data.bdaddr);
	cp.pscan_rep_mode = e->data.pscan_rep_mode;
	cp.pscan_mode = e->data.pscan_mode;
	cp.clock_offset = e->data.clock_offset;

	return hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
}

1984
static bool hci_resolve_next_name(struct hci_dev *hdev)
1985 1986 1987 1988
{
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;

1989 1990 1991 1992
	if (list_empty(&discov->resolve))
		return false;

	e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1993 1994 1995
	if (!e)
		return false;

1996 1997 1998 1999 2000 2001 2002 2003 2004
	if (hci_resolve_name(hdev, e) == 0) {
		e->name_state = NAME_PENDING;
		return true;
	}

	return false;
}

static void hci_check_pending_name(struct hci_dev *hdev, struct hci_conn *conn,
2005
				   bdaddr_t *bdaddr, u8 *name, u8 name_len)
2006 2007 2008 2009
{
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;

2010 2011 2012 2013 2014 2015 2016
	/* Update the mgmt connected state if necessary. Be careful with
	 * conn objects that exist but are not (yet) connected however.
	 * Only those in BT_CONFIG or BT_CONNECTED states can be
	 * considered connected.
	 */
	if (conn &&
	    (conn->state == BT_CONFIG || conn->state == BT_CONNECTED) &&
2017
	    !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2018
		mgmt_device_connected(hdev, conn, 0, name, name_len);
2019 2020 2021 2022

	if (discov->state == DISCOVERY_STOPPED)
		return;

2023 2024 2025 2026 2027 2028 2029
	if (discov->state == DISCOVERY_STOPPING)
		goto discov_complete;

	if (discov->state != DISCOVERY_RESOLVING)
		return;

	e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
2030 2031 2032 2033 2034 2035 2036 2037 2038
	/* If the device was not found in a list of found devices names of which
	 * are pending. there is no need to continue resolving a next name as it
	 * will be done upon receiving another Remote Name Request Complete
	 * Event */
	if (!e)
		return;

	list_del(&e->list);
	if (name) {
2039
		e->name_state = NAME_KNOWN;
2040 2041
		mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
				 e->data.rssi, name, name_len);
2042 2043
	} else {
		e->name_state = NAME_NOT_KNOWN;
2044 2045
	}

2046
	if (hci_resolve_next_name(hdev))
2047 2048 2049 2050 2051 2052
		return;

discov_complete:
	hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
}

2053 2054
static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
{
2055 2056 2057
	struct hci_cp_remote_name_req *cp;
	struct hci_conn *conn;

2058
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070

	/* If successful wait for the name req complete event before
	 * checking for the need to do authentication */
	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_REMOTE_NAME_REQ);
	if (!cp)
		return;

	hci_dev_lock(hdev);

2071 2072
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);

2073
	if (hci_dev_test_flag(hdev, HCI_MGMT))
2074
		hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
2075

2076 2077 2078 2079 2080 2081
	if (!conn)
		goto unlock;

	if (!hci_outgoing_auth_needed(hdev, conn))
		goto unlock;

2082
	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
2083 2084
		struct hci_cp_auth_requested auth_cp;

2085 2086
		set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);

2087 2088 2089
		auth_cp.handle = __cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
			     sizeof(auth_cp), &auth_cp);
2090 2091
	}

2092
unlock:
2093
	hci_dev_unlock(hdev);
2094
}
L
Linus Torvalds 已提交
2095

2096 2097 2098 2099 2100
static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_read_remote_features *cp;
	struct hci_conn *conn;

2101
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
	if (conn) {
		if (conn->state == BT_CONFIG) {
2115
			hci_connect_cfm(conn, status);
2116
			hci_conn_drop(conn);
2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127
		}
	}

	hci_dev_unlock(hdev);
}

static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_read_remote_ext_features *cp;
	struct hci_conn *conn;

2128
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
	if (conn) {
		if (conn->state == BT_CONFIG) {
2142
			hci_connect_cfm(conn, status);
2143
			hci_conn_drop(conn);
2144 2145 2146 2147 2148 2149
		}
	}

	hci_dev_unlock(hdev);
}

2150 2151
static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
{
2152 2153 2154 2155
	struct hci_cp_setup_sync_conn *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;

2156
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2157 2158 2159 2160 2161 2162 2163 2164 2165 2166

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
	if (!cp)
		return;

	handle = __le16_to_cpu(cp->handle);

2167
	BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
2168 2169 2170 2171

	hci_dev_lock(hdev);

	acl = hci_conn_hash_lookup_handle(hdev, handle);
2172 2173 2174 2175
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;
2176

2177
			hci_connect_cfm(sco, status);
2178 2179
			hci_conn_del(sco);
		}
2180 2181 2182
	}

	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2183 2184
}

2185
static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
2186
{
2187 2188
	struct hci_cp_sniff_mode *cp;
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2189

2190
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2191

2192 2193
	if (!status)
		return;
2194

2195 2196 2197
	cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
	if (!cp)
		return;
2198

2199
	hci_dev_lock(hdev);
2200

2201
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2202
	if (conn) {
2203
		clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
2204

2205
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
2206 2207 2208
			hci_sco_setup(conn, status);
	}

2209 2210
	hci_dev_unlock(hdev);
}
2211

2212 2213 2214 2215
static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_exit_sniff_mode *cp;
	struct hci_conn *conn;
2216

2217
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2218

2219 2220
	if (!status)
		return;
2221

2222 2223 2224
	cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
	if (!cp)
		return;
2225

2226
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
2227

2228
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2229
	if (conn) {
2230
		clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
L
Linus Torvalds 已提交
2231

2232
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
2233 2234 2235
			hci_sco_setup(conn, status);
	}

2236
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2237 2238
}

2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253
static void hci_cs_disconnect(struct hci_dev *hdev, u8 status)
{
	struct hci_cp_disconnect *cp;
	struct hci_conn *conn;

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_DISCONNECT);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2254 2255 2256
	if (conn) {
		u8 type = conn->type;

2257
		mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2258
				       conn->dst_type, status);
2259

2260 2261 2262 2263 2264 2265 2266 2267 2268 2269
		/* If the disconnection failed for any reason, the upper layer
		 * does not retry to disconnect in current implementation.
		 * Hence, we need to do some basic cleanup here and re-enable
		 * advertising if necessary.
		 */
		hci_conn_del(conn);
		if (type == LE_LINK)
			hci_req_reenable_advertising(hdev);
	}

2270 2271 2272
	hci_dev_unlock(hdev);
}

2273 2274 2275
static void cs_le_create_conn(struct hci_dev *hdev, bdaddr_t *peer_addr,
			      u8 peer_addr_type, u8 own_address_type,
			      u8 filter_policy)
2276 2277 2278
{
	struct hci_conn *conn;

2279 2280
	conn = hci_conn_hash_lookup_le(hdev, peer_addr,
				       peer_addr_type);
2281
	if (!conn)
2282
		return;
2283 2284 2285 2286 2287

	/* Store the initiator and responder address information which
	 * is needed for SMP. These values will not change during the
	 * lifetime of the connection.
	 */
2288 2289
	conn->init_addr_type = own_address_type;
	if (own_address_type == ADDR_LE_DEV_RANDOM)
2290 2291 2292 2293
		bacpy(&conn->init_addr, &hdev->random_addr);
	else
		bacpy(&conn->init_addr, &hdev->bdaddr);

2294 2295
	conn->resp_addr_type = peer_addr_type;
	bacpy(&conn->resp_addr, peer_addr);
2296

2297 2298 2299 2300 2301
	/* We don't want the connection attempt to stick around
	 * indefinitely since LE doesn't have a page timeout concept
	 * like BR/EDR. Set a timer for any connection that doesn't use
	 * the white list for connecting.
	 */
2302
	if (filter_policy == HCI_LE_USE_PEER_ADDR)
2303 2304
		queue_delayed_work(conn->hdev->workqueue,
				   &conn->le_conn_timeout,
2305
				   conn->conn_timeout);
2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328
}

static void hci_cs_le_create_conn(struct hci_dev *hdev, u8 status)
{
	struct hci_cp_le_create_conn *cp;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	/* All connection failure handling is taken care of by the
	 * hci_le_conn_failed function which is triggered by the HCI
	 * request completion callbacks used for connecting.
	 */
	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_CREATE_CONN);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	cs_le_create_conn(hdev, &cp->peer_addr, cp->peer_addr_type,
			  cp->own_address_type, cp->filter_policy);
2329

2330 2331 2332
	hci_dev_unlock(hdev);
}

2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357
static void hci_cs_le_ext_create_conn(struct hci_dev *hdev, u8 status)
{
	struct hci_cp_le_ext_create_conn *cp;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	/* All connection failure handling is taken care of by the
	 * hci_le_conn_failed function which is triggered by the HCI
	 * request completion callbacks used for connecting.
	 */
	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_EXT_CREATE_CONN);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	cs_le_create_conn(hdev, &cp->peer_addr, cp->peer_addr_type,
			  cp->own_addr_type, cp->filter_policy);

	hci_dev_unlock(hdev);
}

2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384
static void hci_cs_le_read_remote_features(struct hci_dev *hdev, u8 status)
{
	struct hci_cp_le_read_remote_features *cp;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_READ_REMOTE_FEATURES);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
	if (conn) {
		if (conn->state == BT_CONFIG) {
			hci_connect_cfm(conn, status);
			hci_conn_drop(conn);
		}
	}

	hci_dev_unlock(hdev);
}

2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414
static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
{
	struct hci_cp_le_start_enc *cp;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (!status)
		return;

	hci_dev_lock(hdev);

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_START_ENC);
	if (!cp)
		goto unlock;

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
	if (!conn)
		goto unlock;

	if (conn->state != BT_CONNECTED)
		goto unlock;

	hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
	hci_conn_drop(conn);

unlock:
	hci_dev_unlock(hdev);
}

2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437
static void hci_cs_switch_role(struct hci_dev *hdev, u8 status)
{
	struct hci_cp_switch_role *cp;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, status);

	if (!status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_SWITCH_ROLE);
	if (!cp)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
	if (conn)
		clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);

	hci_dev_unlock(hdev);
}

2438
static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2439 2440
{
	__u8 status = *((__u8 *) skb->data);
2441 2442
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;
L
Linus Torvalds 已提交
2443

2444
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
L
Linus Torvalds 已提交
2445

2446
	hci_conn_check_pending(hdev);
2447 2448 2449 2450

	if (!test_and_clear_bit(HCI_INQUIRY, &hdev->flags))
		return;

2451
	smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
2452 2453
	wake_up_bit(&hdev->flags, HCI_INQUIRY);

2454
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
2455 2456
		return;

2457
	hci_dev_lock(hdev);
2458

2459
	if (discov->state != DISCOVERY_FINDING)
2460 2461 2462
		goto unlock;

	if (list_empty(&discov->resolve)) {
2463 2464 2465 2466 2467 2468 2469 2470 2471 2472
		/* When BR/EDR inquiry is active and no LE scanning is in
		 * progress, then change discovery state to indicate completion.
		 *
		 * When running LE scanning and BR/EDR inquiry simultaneously
		 * and the LE scan already finished, then change the discovery
		 * state to indicate completion.
		 */
		if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
		    !test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks))
			hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
2473 2474 2475 2476 2477 2478 2479 2480
		goto unlock;
	}

	e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
	if (e && hci_resolve_name(hdev, e) == 0) {
		e->name_state = NAME_PENDING;
		hci_discovery_set_state(hdev, DISCOVERY_RESOLVING);
	} else {
2481 2482 2483 2484 2485 2486 2487 2488 2489 2490
		/* When BR/EDR inquiry is active and no LE scanning is in
		 * progress, then change discovery state to indicate completion.
		 *
		 * When running LE scanning and BR/EDR inquiry simultaneously
		 * and the LE scan already finished, then change the discovery
		 * state to indicate completion.
		 */
		if (!hci_dev_test_flag(hdev, HCI_LE_SCAN) ||
		    !test_bit(HCI_QUIRK_SIMULTANEOUS_DISCOVERY, &hdev->quirks))
			hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
2491 2492 2493
	}

unlock:
2494
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2495 2496
}

2497
static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2498
{
2499
	struct inquiry_data data;
2500
	struct inquiry_info *info = (void *) (skb->data + 1);
L
Linus Torvalds 已提交
2501 2502 2503 2504
	int num_rsp = *((__u8 *) skb->data);

	BT_DBG("%s num_rsp %d", hdev->name, num_rsp);

2505 2506 2507
	if (!num_rsp)
		return;

2508
	if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
2509 2510
		return;

L
Linus Torvalds 已提交
2511
	hci_dev_lock(hdev);
2512

2513
	for (; num_rsp; num_rsp--, info++) {
2514
		u32 flags;
2515

L
Linus Torvalds 已提交
2516 2517 2518 2519 2520 2521
		bacpy(&data.bdaddr, &info->bdaddr);
		data.pscan_rep_mode	= info->pscan_rep_mode;
		data.pscan_period_mode	= info->pscan_period_mode;
		data.pscan_mode		= info->pscan_mode;
		memcpy(data.dev_class, info->dev_class, 3);
		data.clock_offset	= info->clock_offset;
2522
		data.rssi		= HCI_RSSI_INVALID;
2523
		data.ssp_mode		= 0x00;
2524

2525 2526
		flags = hci_inquiry_cache_update(hdev, &data, false);

2527
		mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
2528 2529
				  info->dev_class, HCI_RSSI_INVALID,
				  flags, NULL, 0, NULL, 0);
L
Linus Torvalds 已提交
2530
	}
2531

L
Linus Torvalds 已提交
2532 2533 2534
	hci_dev_unlock(hdev);
}

2535
static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2536
{
2537
	struct hci_ev_conn_complete *ev = (void *) skb->data;
2538
	struct inquiry_entry *ie;
2539
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2540 2541 2542 2543 2544 2545

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
2546
	if (!conn) {
2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559
		/* Connection may not exist if auto-connected. Check the inquiry
		 * cache to see if we've already discovered this bdaddr before.
		 * If found and link is an ACL type, create a connection class
		 * automatically.
		 */
		ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
		if (ie && ev->link_type == ACL_LINK) {
			conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr,
					    HCI_ROLE_SLAVE);
			if (!conn) {
				bt_dev_err(hdev, "no memory for new conn");
				goto unlock;
			}
2560 2561 2562
		} else {
			if (ev->link_type != SCO_LINK)
				goto unlock;
2563

2564 2565 2566 2567
			conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK,
						       &ev->bdaddr);
			if (!conn)
				goto unlock;
2568

2569 2570
			conn->type = SCO_LINK;
		}
2571
	}
L
Linus Torvalds 已提交
2572 2573 2574

	if (!ev->status) {
		conn->handle = __le16_to_cpu(ev->handle);
2575 2576 2577 2578

		if (conn->type == ACL_LINK) {
			conn->state = BT_CONFIG;
			hci_conn_hold(conn);
2579 2580 2581 2582 2583 2584

			if (!conn->out && !hci_conn_ssp_enabled(conn) &&
			    !hci_find_link_key(hdev, &ev->bdaddr))
				conn->disc_timeout = HCI_PAIRING_TIMEOUT;
			else
				conn->disc_timeout = HCI_DISCONN_TIMEOUT;
2585 2586
		} else
			conn->state = BT_CONNECTED;
L
Linus Torvalds 已提交
2587

2588
		hci_debugfs_create_conn(conn);
2589 2590
		hci_conn_add_sysfs(conn);

L
Linus Torvalds 已提交
2591
		if (test_bit(HCI_AUTH, &hdev->flags))
2592
			set_bit(HCI_CONN_AUTH, &conn->flags);
L
Linus Torvalds 已提交
2593 2594

		if (test_bit(HCI_ENCRYPT, &hdev->flags))
2595
			set_bit(HCI_CONN_ENCRYPT, &conn->flags);
L
Linus Torvalds 已提交
2596

2597 2598 2599 2600
		/* Get remote features */
		if (conn->type == ACL_LINK) {
			struct hci_cp_read_remote_features cp;
			cp.handle = ev->handle;
2601
			hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
2602
				     sizeof(cp), &cp);
2603

2604
			hci_req_update_scan(hdev);
2605 2606
		}

L
Linus Torvalds 已提交
2607
		/* Set packet type for incoming connection */
2608
		if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
L
Linus Torvalds 已提交
2609 2610
			struct hci_cp_change_conn_ptype cp;
			cp.handle = ev->handle;
2611
			cp.pkt_type = cpu_to_le16(conn->pkt_type);
2612 2613
			hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
				     &cp);
L
Linus Torvalds 已提交
2614
		}
2615
	} else {
L
Linus Torvalds 已提交
2616
		conn->state = BT_CLOSED;
2617
		if (conn->type == ACL_LINK)
2618
			mgmt_connect_failed(hdev, &conn->dst, conn->type,
2619
					    conn->dst_type, ev->status);
2620
	}
L
Linus Torvalds 已提交
2621

2622 2623
	if (conn->type == ACL_LINK)
		hci_sco_setup(conn, ev->status);
L
Linus Torvalds 已提交
2624

2625
	if (ev->status) {
2626
		hci_connect_cfm(conn, ev->status);
L
Linus Torvalds 已提交
2627
		hci_conn_del(conn);
2628 2629 2630 2631 2632 2633 2634 2635
	} else if (ev->link_type == SCO_LINK) {
		switch (conn->setting & SCO_AIRMODE_MASK) {
		case SCO_AIRMODE_CVSD:
			if (hdev->notify)
				hdev->notify(hdev, HCI_NOTIFY_ENABLE_SCO_CVSD);
			break;
		}

2636
		hci_connect_cfm(conn, ev->status);
2637
	}
L
Linus Torvalds 已提交
2638

2639
unlock:
L
Linus Torvalds 已提交
2640 2641
	hci_dev_unlock(hdev);

2642
	hci_conn_check_pending(hdev);
L
Linus Torvalds 已提交
2643 2644
}

2645 2646 2647 2648 2649 2650 2651 2652 2653
static void hci_reject_conn(struct hci_dev *hdev, bdaddr_t *bdaddr)
{
	struct hci_cp_reject_conn_req cp;

	bacpy(&cp.bdaddr, bdaddr);
	cp.reason = HCI_ERROR_REJ_BAD_ADDR;
	hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
}

2654
static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2655
{
2656 2657
	struct hci_ev_conn_request *ev = (void *) skb->data;
	int mask = hdev->link_mode;
2658 2659
	struct inquiry_entry *ie;
	struct hci_conn *conn;
2660
	__u8 flags = 0;
L
Linus Torvalds 已提交
2661

2662
	BT_DBG("%s bdaddr %pMR type 0x%x", hdev->name, &ev->bdaddr,
2663
	       ev->link_type);
L
Linus Torvalds 已提交
2664

2665 2666
	mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
				      &flags);
L
Linus Torvalds 已提交
2667

2668 2669 2670 2671 2672
	if (!(mask & HCI_LM_ACCEPT)) {
		hci_reject_conn(hdev, &ev->bdaddr);
		return;
	}

2673 2674 2675 2676 2677 2678
	if (hci_bdaddr_list_lookup(&hdev->blacklist, &ev->bdaddr,
				   BDADDR_BREDR)) {
		hci_reject_conn(hdev, &ev->bdaddr);
		return;
	}

2679 2680 2681 2682
	/* Require HCI_CONNECTABLE or a whitelist entry to accept the
	 * connection. These features are only touched through mgmt so
	 * only do the checks if HCI_MGMT is set.
	 */
2683 2684
	if (hci_dev_test_flag(hdev, HCI_MGMT) &&
	    !hci_dev_test_flag(hdev, HCI_CONNECTABLE) &&
2685 2686 2687 2688
	    !hci_bdaddr_list_lookup(&hdev->whitelist, &ev->bdaddr,
				    BDADDR_BREDR)) {
		    hci_reject_conn(hdev, &ev->bdaddr);
		    return;
2689
	}
L
Linus Torvalds 已提交
2690

2691
	/* Connection accepted */
2692

2693 2694 2695 2696 2697
	hci_dev_lock(hdev);

	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie)
		memcpy(ie->data.dev_class, ev->dev_class, 3);
2698

2699 2700 2701
	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
			&ev->bdaddr);
	if (!conn) {
2702 2703
		conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr,
				    HCI_ROLE_SLAVE);
2704
		if (!conn) {
2705
			bt_dev_err(hdev, "no memory for new connection");
2706 2707
			hci_dev_unlock(hdev);
			return;
L
Linus Torvalds 已提交
2708
		}
2709
	}
2710

2711
	memcpy(conn->dev_class, ev->dev_class, 3);
2712

2713
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2714

2715 2716 2717 2718
	if (ev->link_type == ACL_LINK ||
	    (!(flags & HCI_PROTO_DEFER) && !lmp_esco_capable(hdev))) {
		struct hci_cp_accept_conn_req cp;
		conn->state = BT_CONNECT;
L
Linus Torvalds 已提交
2719

2720
		bacpy(&cp.bdaddr, &ev->bdaddr);
2721

2722 2723 2724 2725
		if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
			cp.role = 0x00; /* Become master */
		else
			cp.role = 0x01; /* Remain slave */
2726

2727 2728 2729 2730
		hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp), &cp);
	} else if (!(flags & HCI_PROTO_DEFER)) {
		struct hci_cp_accept_sync_conn_req cp;
		conn->state = BT_CONNECT;
2731

2732 2733
		bacpy(&cp.bdaddr, &ev->bdaddr);
		cp.pkt_type = cpu_to_le16(conn->pkt_type);
2734

2735 2736 2737 2738 2739
		cp.tx_bandwidth   = cpu_to_le32(0x00001f40);
		cp.rx_bandwidth   = cpu_to_le32(0x00001f40);
		cp.max_latency    = cpu_to_le16(0xffff);
		cp.content_format = cpu_to_le16(hdev->voice_setting);
		cp.retrans_effort = 0xff;
L
Linus Torvalds 已提交
2740

2741 2742
		hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ, sizeof(cp),
			     &cp);
2743
	} else {
2744
		conn->state = BT_CONNECT2;
2745
		hci_connect_cfm(conn, 0);
L
Linus Torvalds 已提交
2746 2747 2748
	}
}

2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764
static u8 hci_to_mgmt_reason(u8 err)
{
	switch (err) {
	case HCI_ERROR_CONNECTION_TIMEOUT:
		return MGMT_DEV_DISCONN_TIMEOUT;
	case HCI_ERROR_REMOTE_USER_TERM:
	case HCI_ERROR_REMOTE_LOW_RESOURCES:
	case HCI_ERROR_REMOTE_POWER_OFF:
		return MGMT_DEV_DISCONN_REMOTE;
	case HCI_ERROR_LOCAL_HOST_TERM:
		return MGMT_DEV_DISCONN_LOCAL_HOST;
	default:
		return MGMT_DEV_DISCONN_UNKNOWN;
	}
}

2765
static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2766
{
2767
	struct hci_ev_disconn_complete *ev = (void *) skb->data;
2768
	u8 reason;
2769
	struct hci_conn_params *params;
2770
	struct hci_conn *conn;
2771
	bool mgmt_connected;
2772
	u8 type;
2773

2774
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2775 2776 2777 2778

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2779 2780
	if (!conn)
		goto unlock;
2781

2782 2783 2784 2785
	if (ev->status) {
		mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
				       conn->dst_type, ev->status);
		goto unlock;
2786
	}
2787

2788 2789
	conn->state = BT_CLOSED;

2790
	mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2791 2792 2793 2794 2795 2796

	if (test_bit(HCI_CONN_AUTH_FAILURE, &conn->flags))
		reason = MGMT_DEV_DISCONN_AUTH_FAILURE;
	else
		reason = hci_to_mgmt_reason(ev->reason);

2797 2798
	mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
				reason, mgmt_connected);
2799

2800 2801 2802 2803
	if (conn->type == ACL_LINK) {
		if (test_bit(HCI_CONN_FLUSH_KEY, &conn->flags))
			hci_remove_link_key(hdev, &conn->dst);

2804
		hci_req_update_scan(hdev);
2805
	}
2806

2807 2808 2809 2810 2811 2812 2813 2814
	params = hci_conn_params_lookup(hdev, &conn->dst, conn->dst_type);
	if (params) {
		switch (params->auto_connect) {
		case HCI_AUTO_CONN_LINK_LOSS:
			if (ev->reason != HCI_ERROR_CONNECTION_TIMEOUT)
				break;
			/* Fall through */

2815
		case HCI_AUTO_CONN_DIRECT:
2816
		case HCI_AUTO_CONN_ALWAYS:
2817 2818 2819
			list_del_init(&params->action);
			list_add(&params->action, &hdev->pend_le_conns);
			hci_update_background_scan(hdev);
2820 2821 2822 2823 2824 2825 2826
			break;

		default:
			break;
		}
	}

2827
	type = conn->type;
2828

2829
	hci_disconn_cfm(conn, ev->reason);
2830 2831
	hci_conn_del(conn);

2832 2833 2834 2835 2836 2837 2838 2839
	/* The suspend notifier is waiting for all devices to disconnect so
	 * clear the bit from pending tasks and inform the wait queue.
	 */
	if (list_empty(&hdev->conn_hash.list) &&
	    test_and_clear_bit(SUSPEND_DISCONNECTING, hdev->suspend_tasks)) {
		wake_up(&hdev->suspend_wait_q);
	}

2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850
	/* Re-enable advertising if necessary, since it might
	 * have been disabled by the connection. From the
	 * HCI_LE_Set_Advertise_Enable command description in
	 * the core specification (v4.0):
	 * "The Controller shall continue advertising until the Host
	 * issues an LE_Set_Advertise_Enable command with
	 * Advertising_Enable set to 0x00 (Advertising is disabled)
	 * or until a connection is created or until the Advertising
	 * is timed out due to Directed Advertising."
	 */
	if (type == LE_LINK)
2851
		hci_req_reenable_advertising(hdev);
2852 2853

unlock:
2854 2855 2856
	hci_dev_unlock(hdev);
}

2857
static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2858
{
2859
	struct hci_ev_auth_complete *ev = (void *) skb->data;
2860
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2861

2862
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
2863 2864 2865

	hci_dev_lock(hdev);

2866
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2867 2868 2869 2870
	if (!conn)
		goto unlock;

	if (!ev->status) {
2871 2872
		clear_bit(HCI_CONN_AUTH_FAILURE, &conn->flags);

2873
		if (!hci_conn_ssp_enabled(conn) &&
2874
		    test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
2875
			bt_dev_info(hdev, "re-auth of legacy device is not possible.");
2876
		} else {
2877
			set_bit(HCI_CONN_AUTH, &conn->flags);
2878
			conn->sec_level = conn->pending_sec_level;
2879
		}
2880
	} else {
2881 2882 2883
		if (ev->status == HCI_ERROR_PIN_OR_KEY_MISSING)
			set_bit(HCI_CONN_AUTH_FAILURE, &conn->flags);

2884
		mgmt_auth_failed(conn, ev->status);
2885
	}
L
Linus Torvalds 已提交
2886

2887 2888
	clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
	clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
L
Linus Torvalds 已提交
2889

2890
	if (conn->state == BT_CONFIG) {
2891
		if (!ev->status && hci_conn_ssp_enabled(conn)) {
2892 2893 2894 2895
			struct hci_cp_set_conn_encrypt cp;
			cp.handle  = ev->handle;
			cp.encrypt = 0x01;
			hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
2896
				     &cp);
2897
		} else {
2898
			conn->state = BT_CONNECTED;
2899
			hci_connect_cfm(conn, ev->status);
2900
			hci_conn_drop(conn);
2901
		}
2902 2903
	} else {
		hci_auth_cfm(conn, ev->status);
2904

2905 2906
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
2907
		hci_conn_drop(conn);
2908 2909
	}

2910
	if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
2911 2912 2913 2914 2915
		if (!ev->status) {
			struct hci_cp_set_conn_encrypt cp;
			cp.handle  = ev->handle;
			cp.encrypt = 0x01;
			hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT, sizeof(cp),
2916
				     &cp);
2917
		} else {
2918
			clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2919
			hci_encrypt_cfm(conn, ev->status, 0x00);
L
Linus Torvalds 已提交
2920 2921 2922
		}
	}

2923
unlock:
L
Linus Torvalds 已提交
2924 2925 2926
	hci_dev_unlock(hdev);
}

2927
static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2928
{
2929 2930 2931
	struct hci_ev_remote_name *ev = (void *) skb->data;
	struct hci_conn *conn;

2932
	BT_DBG("%s", hdev->name);
L
Linus Torvalds 已提交
2933

2934
	hci_conn_check_pending(hdev);
2935 2936 2937

	hci_dev_lock(hdev);

2938
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2939

2940
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
2941
		goto check_auth;
2942

2943 2944
	if (ev->status == 0)
		hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
2945
				       strnlen(ev->name, HCI_MAX_NAME_LENGTH));
2946 2947 2948 2949
	else
		hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);

check_auth:
2950 2951 2952 2953 2954 2955
	if (!conn)
		goto unlock;

	if (!hci_outgoing_auth_needed(hdev, conn))
		goto unlock;

2956
	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
2957
		struct hci_cp_auth_requested cp;
2958 2959 2960

		set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);

2961 2962 2963 2964
		cp.handle = __cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
	}

2965
unlock:
2966
	hci_dev_unlock(hdev);
2967 2968
}

2969 2970 2971 2972 2973 2974 2975 2976 2977 2978
static void read_enc_key_size_complete(struct hci_dev *hdev, u8 status,
				       u16 opcode, struct sk_buff *skb)
{
	const struct hci_rp_read_enc_key_size *rp;
	struct hci_conn *conn;
	u16 handle;

	BT_DBG("%s status 0x%02x", hdev->name, status);

	if (!skb || skb->len < sizeof(*rp)) {
2979
		bt_dev_err(hdev, "invalid read key size response");
2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991
		return;
	}

	rp = (void *)skb->data;
	handle = le16_to_cpu(rp->handle);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, handle);
	if (!conn)
		goto unlock;

2992 2993 2994
	/* While unexpected, the read_enc_key_size command may fail. The most
	 * secure approach is to then assume the key size is 0 to force a
	 * disconnection.
2995 2996
	 */
	if (rp->status) {
2997 2998
		bt_dev_err(hdev, "failed to read key size for handle %u",
			   handle);
2999
		conn->enc_key_size = 0;
3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012
	} else {
		conn->enc_key_size = rp->key_size;
	}

	if (conn->state == BT_CONFIG) {
		conn->state = BT_CONNECTED;
		hci_connect_cfm(conn, 0);
		hci_conn_drop(conn);
	} else {
		u8 encrypt;

		if (!test_bit(HCI_CONN_ENCRYPT, &conn->flags))
			encrypt = 0x00;
3013
		else if (test_bit(HCI_CONN_AES_CCM, &conn->flags))
3014 3015 3016 3017 3018 3019 3020 3021 3022 3023 3024
			encrypt = 0x02;
		else
			encrypt = 0x01;

		hci_encrypt_cfm(conn, 0, encrypt);
	}

unlock:
	hci_dev_unlock(hdev);
}

3025
static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
3026 3027 3028 3029
{
	struct hci_ev_encrypt_change *ev = (void *) skb->data;
	struct hci_conn *conn;

3030
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
3031 3032 3033

	hci_dev_lock(hdev);

3034
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3035 3036
	if (!conn)
		goto unlock;
L
Linus Torvalds 已提交
3037

3038 3039 3040
	if (!ev->status) {
		if (ev->encrypt) {
			/* Encryption implies authentication */
3041 3042
			set_bit(HCI_CONN_AUTH, &conn->flags);
			set_bit(HCI_CONN_ENCRYPT, &conn->flags);
3043
			conn->sec_level = conn->pending_sec_level;
3044

3045 3046
			/* P-256 authentication key implies FIPS */
			if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
3047
				set_bit(HCI_CONN_FIPS, &conn->flags);
3048

3049 3050 3051 3052
			if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
			    conn->type == LE_LINK)
				set_bit(HCI_CONN_AES_CCM, &conn->flags);
		} else {
3053
			clear_bit(HCI_CONN_ENCRYPT, &conn->flags);
3054 3055
			clear_bit(HCI_CONN_AES_CCM, &conn->flags);
		}
3056
	}
3057

3058 3059 3060
	/* We should disregard the current RPA and generate a new one
	 * whenever the encryption procedure fails.
	 */
3061
	if (ev->status && conn->type == LE_LINK) {
3062
		hci_dev_set_flag(hdev, HCI_RPA_EXPIRED);
3063 3064
		hci_adv_instances_set_rpa_expired(hdev, true);
	}
3065

3066
	clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3067

3068
	if (ev->status && conn->state == BT_CONNECTED) {
3069 3070 3071
		if (ev->status == HCI_ERROR_PIN_OR_KEY_MISSING)
			set_bit(HCI_CONN_AUTH_FAILURE, &conn->flags);

3072 3073 3074
		hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
		hci_conn_drop(conn);
		goto unlock;
L
Linus Torvalds 已提交
3075 3076
	}

3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088
	/* In Secure Connections Only mode, do not allow any connections
	 * that are not encrypted with AES-CCM using a P-256 authenticated
	 * combination key.
	 */
	if (hci_dev_test_flag(hdev, HCI_SC_ONLY) &&
	    (!test_bit(HCI_CONN_AES_CCM, &conn->flags) ||
	     conn->key_type != HCI_LK_AUTH_COMBINATION_P256)) {
		hci_connect_cfm(conn, HCI_ERROR_AUTH_FAILURE);
		hci_conn_drop(conn);
		goto unlock;
	}

3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108
	/* Try reading the encryption key size for encrypted ACL links */
	if (!ev->status && ev->encrypt && conn->type == ACL_LINK) {
		struct hci_cp_read_enc_key_size cp;
		struct hci_request req;

		/* Only send HCI_Read_Encryption_Key_Size if the
		 * controller really supports it. If it doesn't, assume
		 * the default size (16).
		 */
		if (!(hdev->commands[20] & 0x10)) {
			conn->enc_key_size = HCI_LINK_KEY_SIZE;
			goto notify;
		}

		hci_req_init(&req, hdev);

		cp.handle = cpu_to_le16(conn->handle);
		hci_req_add(&req, HCI_OP_READ_ENC_KEY_SIZE, sizeof(cp), &cp);

		if (hci_req_run_skb(&req, read_enc_key_size_complete)) {
3109
			bt_dev_err(hdev, "sending read key size failed");
3110 3111 3112 3113 3114 3115 3116
			conn->enc_key_size = HCI_LINK_KEY_SIZE;
			goto notify;
		}

		goto unlock;
	}

3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135
	/* Set the default Authenticated Payload Timeout after
	 * an LE Link is established. As per Core Spec v5.0, Vol 2, Part B
	 * Section 3.3, the HCI command WRITE_AUTH_PAYLOAD_TIMEOUT should be
	 * sent when the link is active and Encryption is enabled, the conn
	 * type can be either LE or ACL and controller must support LMP Ping.
	 * Ensure for AES-CCM encryption as well.
	 */
	if (test_bit(HCI_CONN_ENCRYPT, &conn->flags) &&
	    test_bit(HCI_CONN_AES_CCM, &conn->flags) &&
	    ((conn->type == ACL_LINK && lmp_ping_capable(hdev)) ||
	     (conn->type == LE_LINK && (hdev->le_features[0] & HCI_LE_PING)))) {
		struct hci_cp_write_auth_payload_to cp;

		cp.handle = cpu_to_le16(conn->handle);
		cp.timeout = cpu_to_le16(hdev->auth_payload_timeout);
		hci_send_cmd(conn->hdev, HCI_OP_WRITE_AUTH_PAYLOAD_TO,
			     sizeof(cp), &cp);
	}

3136
notify:
3137 3138 3139 3140
	if (conn->state == BT_CONFIG) {
		if (!ev->status)
			conn->state = BT_CONNECTED;

3141
		hci_connect_cfm(conn, ev->status);
3142 3143 3144 3145
		hci_conn_drop(conn);
	} else
		hci_encrypt_cfm(conn, ev->status, ev->encrypt);

3146
unlock:
L
Linus Torvalds 已提交
3147 3148 3149
	hci_dev_unlock(hdev);
}

3150 3151
static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
L
Linus Torvalds 已提交
3152
{
3153
	struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
3154
	struct hci_conn *conn;
L
Linus Torvalds 已提交
3155

3156
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
3157 3158 3159

	hci_dev_lock(hdev);

3160
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
3161 3162
	if (conn) {
		if (!ev->status)
3163
			set_bit(HCI_CONN_SECURE, &conn->flags);
L
Linus Torvalds 已提交
3164

3165
		clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
L
Linus Torvalds 已提交
3166 3167 3168 3169 3170 3171 3172

		hci_key_change_cfm(conn, ev->status);
	}

	hci_dev_unlock(hdev);
}

3173 3174
static void hci_remote_features_evt(struct hci_dev *hdev,
				    struct sk_buff *skb)
L
Linus Torvalds 已提交
3175
{
3176 3177 3178
	struct hci_ev_remote_features *ev = (void *) skb->data;
	struct hci_conn *conn;

3179
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3180 3181 3182 3183

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3184 3185
	if (!conn)
		goto unlock;
3186

3187
	if (!ev->status)
3188
		memcpy(conn->features[0], ev->features, 8);
3189 3190 3191 3192

	if (conn->state != BT_CONFIG)
		goto unlock;

3193 3194
	if (!ev->status && lmp_ext_feat_capable(hdev) &&
	    lmp_ext_feat_capable(conn)) {
3195 3196 3197 3198
		struct hci_cp_read_remote_ext_features cp;
		cp.handle = ev->handle;
		cp.page = 0x01;
		hci_send_cmd(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES,
3199
			     sizeof(cp), &cp);
3200 3201 3202
		goto unlock;
	}

3203
	if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
3204 3205 3206 3207 3208
		struct hci_cp_remote_name_req cp;
		memset(&cp, 0, sizeof(cp));
		bacpy(&cp.bdaddr, &conn->dst);
		cp.pscan_rep_mode = 0x02;
		hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
3209
	} else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3210
		mgmt_device_connected(hdev, conn, 0, NULL, 0);
3211

3212
	if (!hci_outgoing_auth_needed(hdev, conn)) {
3213
		conn->state = BT_CONNECTED;
3214
		hci_connect_cfm(conn, ev->status);
3215
		hci_conn_drop(conn);
3216
	}
3217

3218
unlock:
3219
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
3220 3221
}

3222 3223 3224 3225
static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb,
				 u16 *opcode, u8 *status,
				 hci_req_complete_t *req_complete,
				 hci_req_complete_skb_t *req_complete_skb)
3226 3227 3228
{
	struct hci_ev_cmd_complete *ev = (void *) skb->data;

3229 3230
	*opcode = __le16_to_cpu(ev->opcode);
	*status = skb->data[sizeof(*ev)];
3231

3232
	skb_pull(skb, sizeof(*ev));
3233

3234
	switch (*opcode) {
3235 3236 3237 3238
	case HCI_OP_INQUIRY_CANCEL:
		hci_cc_inquiry_cancel(hdev, skb);
		break;

3239 3240 3241 3242
	case HCI_OP_PERIODIC_INQ:
		hci_cc_periodic_inq(hdev, skb);
		break;

3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254
	case HCI_OP_EXIT_PERIODIC_INQ:
		hci_cc_exit_periodic_inq(hdev, skb);
		break;

	case HCI_OP_REMOTE_NAME_REQ_CANCEL:
		hci_cc_remote_name_req_cancel(hdev, skb);
		break;

	case HCI_OP_ROLE_DISCOVERY:
		hci_cc_role_discovery(hdev, skb);
		break;

3255 3256 3257 3258
	case HCI_OP_READ_LINK_POLICY:
		hci_cc_read_link_policy(hdev, skb);
		break;

3259 3260 3261 3262
	case HCI_OP_WRITE_LINK_POLICY:
		hci_cc_write_link_policy(hdev, skb);
		break;

3263 3264 3265 3266 3267 3268 3269 3270
	case HCI_OP_READ_DEF_LINK_POLICY:
		hci_cc_read_def_link_policy(hdev, skb);
		break;

	case HCI_OP_WRITE_DEF_LINK_POLICY:
		hci_cc_write_def_link_policy(hdev, skb);
		break;

3271 3272 3273 3274
	case HCI_OP_RESET:
		hci_cc_reset(hdev, skb);
		break;

3275 3276 3277 3278
	case HCI_OP_READ_STORED_LINK_KEY:
		hci_cc_read_stored_link_key(hdev, skb);
		break;

3279 3280 3281 3282
	case HCI_OP_DELETE_STORED_LINK_KEY:
		hci_cc_delete_stored_link_key(hdev, skb);
		break;

3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318
	case HCI_OP_WRITE_LOCAL_NAME:
		hci_cc_write_local_name(hdev, skb);
		break;

	case HCI_OP_READ_LOCAL_NAME:
		hci_cc_read_local_name(hdev, skb);
		break;

	case HCI_OP_WRITE_AUTH_ENABLE:
		hci_cc_write_auth_enable(hdev, skb);
		break;

	case HCI_OP_WRITE_ENCRYPT_MODE:
		hci_cc_write_encrypt_mode(hdev, skb);
		break;

	case HCI_OP_WRITE_SCAN_ENABLE:
		hci_cc_write_scan_enable(hdev, skb);
		break;

	case HCI_OP_READ_CLASS_OF_DEV:
		hci_cc_read_class_of_dev(hdev, skb);
		break;

	case HCI_OP_WRITE_CLASS_OF_DEV:
		hci_cc_write_class_of_dev(hdev, skb);
		break;

	case HCI_OP_READ_VOICE_SETTING:
		hci_cc_read_voice_setting(hdev, skb);
		break;

	case HCI_OP_WRITE_VOICE_SETTING:
		hci_cc_write_voice_setting(hdev, skb);
		break;

3319 3320 3321 3322
	case HCI_OP_READ_NUM_SUPPORTED_IAC:
		hci_cc_read_num_supported_iac(hdev, skb);
		break;

3323 3324 3325 3326
	case HCI_OP_WRITE_SSP_MODE:
		hci_cc_write_ssp_mode(hdev, skb);
		break;

3327 3328 3329 3330
	case HCI_OP_WRITE_SC_SUPPORT:
		hci_cc_write_sc_support(hdev, skb);
		break;

3331 3332 3333 3334 3335 3336 3337 3338
	case HCI_OP_READ_AUTH_PAYLOAD_TO:
		hci_cc_read_auth_payload_timeout(hdev, skb);
		break;

	case HCI_OP_WRITE_AUTH_PAYLOAD_TO:
		hci_cc_write_auth_payload_timeout(hdev, skb);
		break;

3339 3340 3341 3342 3343 3344 3345 3346 3347 3348 3349 3350
	case HCI_OP_READ_LOCAL_VERSION:
		hci_cc_read_local_version(hdev, skb);
		break;

	case HCI_OP_READ_LOCAL_COMMANDS:
		hci_cc_read_local_commands(hdev, skb);
		break;

	case HCI_OP_READ_LOCAL_FEATURES:
		hci_cc_read_local_features(hdev, skb);
		break;

3351 3352 3353 3354
	case HCI_OP_READ_LOCAL_EXT_FEATURES:
		hci_cc_read_local_ext_features(hdev, skb);
		break;

3355 3356 3357 3358 3359 3360 3361 3362
	case HCI_OP_READ_BUFFER_SIZE:
		hci_cc_read_buffer_size(hdev, skb);
		break;

	case HCI_OP_READ_BD_ADDR:
		hci_cc_read_bd_addr(hdev, skb);
		break;

3363 3364 3365 3366
	case HCI_OP_READ_LOCAL_PAIRING_OPTS:
		hci_cc_read_local_pairing_opts(hdev, skb);
		break;

3367 3368 3369 3370
	case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
		hci_cc_read_page_scan_activity(hdev, skb);
		break;

3371 3372 3373 3374
	case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
		hci_cc_write_page_scan_activity(hdev, skb);
		break;

3375 3376 3377 3378
	case HCI_OP_READ_PAGE_SCAN_TYPE:
		hci_cc_read_page_scan_type(hdev, skb);
		break;

3379 3380 3381 3382
	case HCI_OP_WRITE_PAGE_SCAN_TYPE:
		hci_cc_write_page_scan_type(hdev, skb);
		break;

3383 3384 3385 3386
	case HCI_OP_READ_DATA_BLOCK_SIZE:
		hci_cc_read_data_block_size(hdev, skb);
		break;

3387 3388 3389 3390
	case HCI_OP_READ_FLOW_CONTROL_MODE:
		hci_cc_read_flow_control_mode(hdev, skb);
		break;

3391 3392 3393 3394
	case HCI_OP_READ_LOCAL_AMP_INFO:
		hci_cc_read_local_amp_info(hdev, skb);
		break;

3395 3396 3397 3398
	case HCI_OP_READ_CLOCK:
		hci_cc_read_clock(hdev, skb);
		break;

3399 3400 3401 3402
	case HCI_OP_READ_INQ_RSP_TX_POWER:
		hci_cc_read_inq_rsp_tx_power(hdev, skb);
		break;

3403 3404 3405 3406 3407 3408 3409 3410
	case HCI_OP_READ_DEF_ERR_DATA_REPORTING:
		hci_cc_read_def_err_data_reporting(hdev, skb);
		break;

	case HCI_OP_WRITE_DEF_ERR_DATA_REPORTING:
		hci_cc_write_def_err_data_reporting(hdev, skb);
		break;

3411 3412 3413 3414 3415 3416 3417 3418
	case HCI_OP_PIN_CODE_REPLY:
		hci_cc_pin_code_reply(hdev, skb);
		break;

	case HCI_OP_PIN_CODE_NEG_REPLY:
		hci_cc_pin_code_neg_reply(hdev, skb);
		break;

3419
	case HCI_OP_READ_LOCAL_OOB_DATA:
3420 3421 3422 3423 3424
		hci_cc_read_local_oob_data(hdev, skb);
		break;

	case HCI_OP_READ_LOCAL_OOB_EXT_DATA:
		hci_cc_read_local_oob_ext_data(hdev, skb);
3425 3426
		break;

3427 3428 3429 3430
	case HCI_OP_LE_READ_BUFFER_SIZE:
		hci_cc_le_read_buffer_size(hdev, skb);
		break;

3431 3432 3433 3434
	case HCI_OP_LE_READ_LOCAL_FEATURES:
		hci_cc_le_read_local_features(hdev, skb);
		break;

3435 3436 3437 3438
	case HCI_OP_LE_READ_ADV_TX_POWER:
		hci_cc_le_read_adv_tx_power(hdev, skb);
		break;

3439 3440 3441 3442 3443 3444 3445 3446
	case HCI_OP_USER_CONFIRM_REPLY:
		hci_cc_user_confirm_reply(hdev, skb);
		break;

	case HCI_OP_USER_CONFIRM_NEG_REPLY:
		hci_cc_user_confirm_neg_reply(hdev, skb);
		break;

3447 3448 3449 3450 3451 3452
	case HCI_OP_USER_PASSKEY_REPLY:
		hci_cc_user_passkey_reply(hdev, skb);
		break;

	case HCI_OP_USER_PASSKEY_NEG_REPLY:
		hci_cc_user_passkey_neg_reply(hdev, skb);
3453
		break;
3454

3455 3456 3457 3458
	case HCI_OP_LE_SET_RANDOM_ADDR:
		hci_cc_le_set_random_addr(hdev, skb);
		break;

3459 3460 3461 3462
	case HCI_OP_LE_SET_ADV_ENABLE:
		hci_cc_le_set_adv_enable(hdev, skb);
		break;

3463 3464 3465 3466
	case HCI_OP_LE_SET_SCAN_PARAM:
		hci_cc_le_set_scan_param(hdev, skb);
		break;

3467 3468 3469 3470
	case HCI_OP_LE_SET_SCAN_ENABLE:
		hci_cc_le_set_scan_enable(hdev, skb);
		break;

3471 3472 3473 3474
	case HCI_OP_LE_READ_WHITE_LIST_SIZE:
		hci_cc_le_read_white_list_size(hdev, skb);
		break;

3475 3476 3477 3478 3479 3480 3481 3482 3483 3484 3485 3486
	case HCI_OP_LE_CLEAR_WHITE_LIST:
		hci_cc_le_clear_white_list(hdev, skb);
		break;

	case HCI_OP_LE_ADD_TO_WHITE_LIST:
		hci_cc_le_add_to_white_list(hdev, skb);
		break;

	case HCI_OP_LE_DEL_FROM_WHITE_LIST:
		hci_cc_le_del_from_white_list(hdev, skb);
		break;

3487 3488 3489 3490
	case HCI_OP_LE_READ_SUPPORTED_STATES:
		hci_cc_le_read_supported_states(hdev, skb);
		break;

3491 3492 3493 3494 3495 3496 3497 3498
	case HCI_OP_LE_READ_DEF_DATA_LEN:
		hci_cc_le_read_def_data_len(hdev, skb);
		break;

	case HCI_OP_LE_WRITE_DEF_DATA_LEN:
		hci_cc_le_write_def_data_len(hdev, skb);
		break;

3499 3500 3501 3502 3503 3504 3505 3506
	case HCI_OP_LE_ADD_TO_RESOLV_LIST:
		hci_cc_le_add_to_resolv_list(hdev, skb);
		break;

	case HCI_OP_LE_DEL_FROM_RESOLV_LIST:
		hci_cc_le_del_from_resolv_list(hdev, skb);
		break;

3507 3508 3509 3510
	case HCI_OP_LE_CLEAR_RESOLV_LIST:
		hci_cc_le_clear_resolv_list(hdev, skb);
		break;

A
Ankit Navik 已提交
3511 3512 3513 3514
	case HCI_OP_LE_READ_RESOLV_LIST_SIZE:
		hci_cc_le_read_resolv_list_size(hdev, skb);
		break;

3515 3516 3517 3518
	case HCI_OP_LE_SET_ADDR_RESOLV_ENABLE:
		hci_cc_le_set_addr_resolution_enable(hdev, skb);
		break;

3519 3520 3521 3522
	case HCI_OP_LE_READ_MAX_DATA_LEN:
		hci_cc_le_read_max_data_len(hdev, skb);
		break;

3523 3524 3525 3526
	case HCI_OP_WRITE_LE_HOST_SUPPORTED:
		hci_cc_write_le_host_supported(hdev, skb);
		break;

3527 3528 3529 3530
	case HCI_OP_LE_SET_ADV_PARAM:
		hci_cc_set_adv_param(hdev, skb);
		break;

3531 3532 3533 3534
	case HCI_OP_READ_RSSI:
		hci_cc_read_rssi(hdev, skb);
		break;

3535 3536 3537 3538
	case HCI_OP_READ_TX_POWER:
		hci_cc_read_tx_power(hdev, skb);
		break;

3539 3540 3541 3542
	case HCI_OP_WRITE_SSP_DEBUG_MODE:
		hci_cc_write_ssp_debug_mode(hdev, skb);
		break;

3543 3544 3545 3546 3547 3548 3549 3550
	case HCI_OP_LE_SET_EXT_SCAN_PARAMS:
		hci_cc_le_set_ext_scan_param(hdev, skb);
		break;

	case HCI_OP_LE_SET_EXT_SCAN_ENABLE:
		hci_cc_le_set_ext_scan_enable(hdev, skb);
		break;

3551 3552 3553 3554
	case HCI_OP_LE_SET_DEFAULT_PHY:
		hci_cc_le_set_default_phy(hdev, skb);
		break;

3555 3556 3557 3558
	case HCI_OP_LE_READ_NUM_SUPPORTED_ADV_SETS:
		hci_cc_le_read_num_adv_sets(hdev, skb);
		break;

3559 3560 3561 3562 3563 3564 3565 3566
	case HCI_OP_LE_SET_EXT_ADV_PARAMS:
		hci_cc_set_ext_adv_param(hdev, skb);
		break;

	case HCI_OP_LE_SET_EXT_ADV_ENABLE:
		hci_cc_le_set_ext_adv_enable(hdev, skb);
		break;

3567 3568 3569 3570
	case HCI_OP_LE_SET_ADV_SET_RAND_ADDR:
		hci_cc_le_set_adv_set_random_addr(hdev, skb);
		break;

3571
	default:
3572
		BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
3573 3574 3575
		break;
	}

3576
	if (*opcode != HCI_OP_NOP)
3577
		cancel_delayed_work(&hdev->cmd_timer);
3578

3579 3580 3581
	if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags))
		atomic_set(&hdev->cmd_cnt, 1);

3582 3583
	hci_req_cmd_complete(hdev, *opcode, *status, req_complete,
			     req_complete_skb);
3584

3585 3586 3587 3588 3589 3590
	if (hci_dev_test_flag(hdev, HCI_CMD_PENDING)) {
		bt_dev_err(hdev,
			   "unexpected event for opcode 0x%4.4x", *opcode);
		return;
	}

3591 3592
	if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
		queue_work(hdev->workqueue, &hdev->cmd_work);
3593 3594
}

3595 3596 3597 3598
static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb,
			       u16 *opcode, u8 *status,
			       hci_req_complete_t *req_complete,
			       hci_req_complete_skb_t *req_complete_skb)
3599 3600 3601 3602 3603
{
	struct hci_ev_cmd_status *ev = (void *) skb->data;

	skb_pull(skb, sizeof(*ev));

3604 3605
	*opcode = __le16_to_cpu(ev->opcode);
	*status = ev->status;
3606

3607
	switch (*opcode) {
3608 3609 3610 3611 3612 3613 3614 3615
	case HCI_OP_INQUIRY:
		hci_cs_inquiry(hdev, ev->status);
		break;

	case HCI_OP_CREATE_CONN:
		hci_cs_create_conn(hdev, ev->status);
		break;

3616 3617 3618 3619
	case HCI_OP_DISCONNECT:
		hci_cs_disconnect(hdev, ev->status);
		break;

3620 3621 3622 3623
	case HCI_OP_ADD_SCO:
		hci_cs_add_sco(hdev, ev->status);
		break;

3624 3625 3626 3627 3628 3629 3630 3631
	case HCI_OP_AUTH_REQUESTED:
		hci_cs_auth_requested(hdev, ev->status);
		break;

	case HCI_OP_SET_CONN_ENCRYPT:
		hci_cs_set_conn_encrypt(hdev, ev->status);
		break;

3632 3633 3634 3635
	case HCI_OP_REMOTE_NAME_REQ:
		hci_cs_remote_name_req(hdev, ev->status);
		break;

3636 3637 3638 3639 3640 3641 3642 3643
	case HCI_OP_READ_REMOTE_FEATURES:
		hci_cs_read_remote_features(hdev, ev->status);
		break;

	case HCI_OP_READ_REMOTE_EXT_FEATURES:
		hci_cs_read_remote_ext_features(hdev, ev->status);
		break;

3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655
	case HCI_OP_SETUP_SYNC_CONN:
		hci_cs_setup_sync_conn(hdev, ev->status);
		break;

	case HCI_OP_SNIFF_MODE:
		hci_cs_sniff_mode(hdev, ev->status);
		break;

	case HCI_OP_EXIT_SNIFF_MODE:
		hci_cs_exit_sniff_mode(hdev, ev->status);
		break;

3656 3657 3658 3659
	case HCI_OP_SWITCH_ROLE:
		hci_cs_switch_role(hdev, ev->status);
		break;

3660 3661 3662 3663
	case HCI_OP_LE_CREATE_CONN:
		hci_cs_le_create_conn(hdev, ev->status);
		break;

3664 3665 3666 3667
	case HCI_OP_LE_READ_REMOTE_FEATURES:
		hci_cs_le_read_remote_features(hdev, ev->status);
		break;

3668 3669 3670 3671
	case HCI_OP_LE_START_ENC:
		hci_cs_le_start_enc(hdev, ev->status);
		break;

3672 3673 3674 3675
	case HCI_OP_LE_EXT_CREATE_CONN:
		hci_cs_le_ext_create_conn(hdev, ev->status);
		break;

3676
	default:
3677
		BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
3678 3679 3680
		break;
	}

3681
	if (*opcode != HCI_OP_NOP)
3682
		cancel_delayed_work(&hdev->cmd_timer);
3683

3684 3685 3686
	if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags))
		atomic_set(&hdev->cmd_cnt, 1);

3687 3688 3689 3690 3691 3692
	/* Indicate request completion if the command failed. Also, if
	 * we're not waiting for a special event and we get a success
	 * command status we should try to flag the request as completed
	 * (since for this kind of commands there will not be a command
	 * complete event).
	 */
3693
	if (ev->status ||
3694
	    (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->hci.req_event))
3695 3696
		hci_req_cmd_complete(hdev, *opcode, ev->status, req_complete,
				     req_complete_skb);
3697

3698 3699 3700 3701 3702 3703
	if (hci_dev_test_flag(hdev, HCI_CMD_PENDING)) {
		bt_dev_err(hdev,
			   "unexpected event for opcode 0x%4.4x", *opcode);
		return;
	}

3704 3705
	if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
		queue_work(hdev->workqueue, &hdev->cmd_work);
3706 3707
}

3708 3709 3710 3711
static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_hardware_error *ev = (void *) skb->data;

3712 3713 3714
	hdev->hw_error_code = ev->code;

	queue_work(hdev->req_workqueue, &hdev->error_reset);
3715 3716
}

3717
static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
3718 3719 3720 3721
{
	struct hci_ev_role_change *ev = (void *) skb->data;
	struct hci_conn *conn;

3722
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3723 3724 3725 3726 3727

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (conn) {
3728 3729
		if (!ev->status)
			conn->role = ev->role;
3730

3731
		clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
3732 3733 3734 3735 3736 3737 3738

		hci_role_switch_cfm(conn, ev->status, ev->role);
	}

	hci_dev_unlock(hdev);
}

3739
static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
3740 3741 3742 3743
{
	struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
	int i;

3744
	if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
3745
		bt_dev_err(hdev, "wrong event for mode %d", hdev->flow_ctl_mode);
3746 3747 3748
		return;
	}

3749 3750
	if (skb->len < sizeof(*ev) ||
	    skb->len < struct_size(ev, handles, ev->num_hndl)) {
3751 3752 3753 3754
		BT_DBG("%s bad parameters", hdev->name);
		return;
	}

3755 3756
	BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);

3757 3758
	for (i = 0; i < ev->num_hndl; i++) {
		struct hci_comp_pkts_info *info = &ev->handles[i];
3759 3760 3761
		struct hci_conn *conn;
		__u16  handle, count;

3762 3763
		handle = __le16_to_cpu(info->handle);
		count  = __le16_to_cpu(info->count);
3764 3765

		conn = hci_conn_hash_lookup_handle(hdev, handle);
3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779 3780 3781 3782 3783
		if (!conn)
			continue;

		conn->sent -= count;

		switch (conn->type) {
		case ACL_LINK:
			hdev->acl_cnt += count;
			if (hdev->acl_cnt > hdev->acl_pkts)
				hdev->acl_cnt = hdev->acl_pkts;
			break;

		case LE_LINK:
			if (hdev->le_pkts) {
				hdev->le_cnt += count;
				if (hdev->le_cnt > hdev->le_pkts)
					hdev->le_cnt = hdev->le_pkts;
			} else {
A
Andrei Emeltchenko 已提交
3784 3785
				hdev->acl_cnt += count;
				if (hdev->acl_cnt > hdev->acl_pkts)
3786 3787
					hdev->acl_cnt = hdev->acl_pkts;
			}
3788 3789 3790 3791 3792 3793 3794 3795 3796
			break;

		case SCO_LINK:
			hdev->sco_cnt += count;
			if (hdev->sco_cnt > hdev->sco_pkts)
				hdev->sco_cnt = hdev->sco_pkts;
			break;

		default:
3797 3798
			bt_dev_err(hdev, "unknown type %d conn %p",
				   conn->type, conn);
3799
			break;
3800 3801 3802
		}
	}

3803
	queue_work(hdev->workqueue, &hdev->tx_work);
3804 3805
}

3806 3807 3808 3809 3810 3811
static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
						 __u16 handle)
{
	struct hci_chan *chan;

	switch (hdev->dev_type) {
3812
	case HCI_PRIMARY:
3813 3814 3815 3816 3817 3818 3819
		return hci_conn_hash_lookup_handle(hdev, handle);
	case HCI_AMP:
		chan = hci_chan_lookup_handle(hdev, handle);
		if (chan)
			return chan->conn;
		break;
	default:
3820
		bt_dev_err(hdev, "unknown dev_type %d", hdev->dev_type);
3821 3822 3823 3824 3825 3826
		break;
	}

	return NULL;
}

3827
static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
3828 3829 3830 3831 3832
{
	struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
	int i;

	if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
3833
		bt_dev_err(hdev, "wrong event for mode %d", hdev->flow_ctl_mode);
3834 3835 3836
		return;
	}

3837 3838
	if (skb->len < sizeof(*ev) ||
	    skb->len < struct_size(ev, handles, ev->num_hndl)) {
3839 3840 3841 3842 3843
		BT_DBG("%s bad parameters", hdev->name);
		return;
	}

	BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
3844
	       ev->num_hndl);
3845 3846 3847

	for (i = 0; i < ev->num_hndl; i++) {
		struct hci_comp_blocks_info *info = &ev->handles[i];
3848
		struct hci_conn *conn = NULL;
3849 3850 3851 3852 3853
		__u16  handle, block_count;

		handle = __le16_to_cpu(info->handle);
		block_count = __le16_to_cpu(info->blocks);

3854
		conn = __hci_conn_lookup_handle(hdev, handle);
3855 3856 3857 3858 3859 3860 3861
		if (!conn)
			continue;

		conn->sent -= block_count;

		switch (conn->type) {
		case ACL_LINK:
3862
		case AMP_LINK:
3863 3864 3865 3866 3867 3868
			hdev->block_cnt += block_count;
			if (hdev->block_cnt > hdev->num_blocks)
				hdev->block_cnt = hdev->num_blocks;
			break;

		default:
3869 3870
			bt_dev_err(hdev, "unknown type %d conn %p",
				   conn->type, conn);
3871 3872 3873 3874 3875 3876 3877
			break;
		}
	}

	queue_work(hdev->workqueue, &hdev->tx_work);
}

3878
static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
3879
{
3880
	struct hci_ev_mode_change *ev = (void *) skb->data;
3881 3882
	struct hci_conn *conn;

3883
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3884 3885 3886 3887

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3888 3889 3890
	if (conn) {
		conn->mode = ev->mode;

3891 3892
		if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
					&conn->flags)) {
3893
			if (conn->mode == HCI_CM_ACTIVE)
3894
				set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
3895
			else
3896
				clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
3897
		}
3898

3899
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
3900
			hci_sco_setup(conn, ev->status);
3901 3902 3903 3904 3905
	}

	hci_dev_unlock(hdev);
}

3906
static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
3907
{
3908 3909 3910
	struct hci_ev_pin_code_req *ev = (void *) skb->data;
	struct hci_conn *conn;

3911
	BT_DBG("%s", hdev->name);
3912 3913 3914 3915

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3916 3917 3918 3919
	if (!conn)
		goto unlock;

	if (conn->state == BT_CONNECTED) {
3920 3921
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_PAIRING_TIMEOUT;
3922
		hci_conn_drop(conn);
3923 3924
	}

3925
	if (!hci_dev_test_flag(hdev, HCI_BONDABLE) &&
3926
	    !test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags)) {
3927
		hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
3928
			     sizeof(ev->bdaddr), &ev->bdaddr);
3929
	} else if (hci_dev_test_flag(hdev, HCI_MGMT)) {
3930 3931 3932 3933 3934 3935 3936
		u8 secure;

		if (conn->pending_sec_level == BT_SECURITY_HIGH)
			secure = 1;
		else
			secure = 0;

3937
		mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
3938
	}
3939

3940
unlock:
3941
	hci_dev_unlock(hdev);
3942 3943
}

3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972 3973 3974 3975
static void conn_set_key(struct hci_conn *conn, u8 key_type, u8 pin_len)
{
	if (key_type == HCI_LK_CHANGED_COMBINATION)
		return;

	conn->pin_length = pin_len;
	conn->key_type = key_type;

	switch (key_type) {
	case HCI_LK_LOCAL_UNIT:
	case HCI_LK_REMOTE_UNIT:
	case HCI_LK_DEBUG_COMBINATION:
		return;
	case HCI_LK_COMBINATION:
		if (pin_len == 16)
			conn->pending_sec_level = BT_SECURITY_HIGH;
		else
			conn->pending_sec_level = BT_SECURITY_MEDIUM;
		break;
	case HCI_LK_UNAUTH_COMBINATION_P192:
	case HCI_LK_UNAUTH_COMBINATION_P256:
		conn->pending_sec_level = BT_SECURITY_MEDIUM;
		break;
	case HCI_LK_AUTH_COMBINATION_P192:
		conn->pending_sec_level = BT_SECURITY_HIGH;
		break;
	case HCI_LK_AUTH_COMBINATION_P256:
		conn->pending_sec_level = BT_SECURITY_FIPS;
		break;
	}
}

3976
static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
3977
{
3978 3979 3980 3981 3982
	struct hci_ev_link_key_req *ev = (void *) skb->data;
	struct hci_cp_link_key_reply cp;
	struct hci_conn *conn;
	struct link_key *key;

3983
	BT_DBG("%s", hdev->name);
3984

3985
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
3986 3987 3988 3989 3990 3991
		return;

	hci_dev_lock(hdev);

	key = hci_find_link_key(hdev, &ev->bdaddr);
	if (!key) {
3992 3993
		BT_DBG("%s link key not found for %pMR", hdev->name,
		       &ev->bdaddr);
3994 3995 3996
		goto not_found;
	}

3997 3998
	BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
	       &ev->bdaddr);
3999 4000

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4001
	if (conn) {
4002 4003
		clear_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);

4004 4005
		if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
		     key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
4006
		    conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
4007 4008 4009
			BT_DBG("%s ignoring unauthenticated key", hdev->name);
			goto not_found;
		}
4010

4011
		if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
4012 4013
		    (conn->pending_sec_level == BT_SECURITY_HIGH ||
		     conn->pending_sec_level == BT_SECURITY_FIPS)) {
4014 4015
			BT_DBG("%s ignoring key unauthenticated for high security",
			       hdev->name);
4016 4017 4018
			goto not_found;
		}

4019
		conn_set_key(conn, key->type, key->pin_len);
4020 4021 4022
	}

	bacpy(&cp.bdaddr, &ev->bdaddr);
4023
	memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
4024 4025 4026 4027 4028 4029 4030 4031 4032 4033

	hci_send_cmd(hdev, HCI_OP_LINK_KEY_REPLY, sizeof(cp), &cp);

	hci_dev_unlock(hdev);

	return;

not_found:
	hci_send_cmd(hdev, HCI_OP_LINK_KEY_NEG_REPLY, 6, &ev->bdaddr);
	hci_dev_unlock(hdev);
4034 4035
}

4036
static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
4037
{
4038 4039
	struct hci_ev_link_key_notify *ev = (void *) skb->data;
	struct hci_conn *conn;
4040 4041
	struct link_key *key;
	bool persistent;
4042
	u8 pin_len = 0;
4043

4044
	BT_DBG("%s", hdev->name);
4045 4046 4047 4048

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4049 4050 4051 4052 4053 4054 4055
	if (!conn)
		goto unlock;

	hci_conn_hold(conn);
	conn->disc_timeout = HCI_DISCONN_TIMEOUT;
	hci_conn_drop(conn);

4056
	set_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);
4057
	conn_set_key(conn, ev->key_type, conn->pin_length);
4058

4059
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4060 4061 4062 4063 4064 4065 4066
		goto unlock;

	key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
			        ev->key_type, pin_len, &persistent);
	if (!key)
		goto unlock;

4067 4068 4069 4070 4071 4072
	/* Update connection information since adding the key will have
	 * fixed up the type in the case of changed combination keys.
	 */
	if (ev->key_type == HCI_LK_CHANGED_COMBINATION)
		conn_set_key(conn, key->type, key->pin_len);

4073
	mgmt_new_link_key(hdev, key, persistent);
4074

4075 4076 4077 4078 4079 4080
	/* Keep debug keys around only if the HCI_KEEP_DEBUG_KEYS flag
	 * is set. If it's not set simply remove the key from the kernel
	 * list (we've still notified user space about it but with
	 * store_hint being 0).
	 */
	if (key->type == HCI_LK_DEBUG_COMBINATION &&
4081
	    !hci_dev_test_flag(hdev, HCI_KEEP_DEBUG_KEYS)) {
4082 4083
		list_del_rcu(&key->list);
		kfree_rcu(key, rcu);
4084
		goto unlock;
4085
	}
4086

4087 4088 4089 4090 4091
	if (persistent)
		clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
	else
		set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);

4092
unlock:
4093
	hci_dev_unlock(hdev);
4094 4095
}

4096
static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
4097
{
4098
	struct hci_ev_clock_offset *ev = (void *) skb->data;
4099
	struct hci_conn *conn;
L
Linus Torvalds 已提交
4100

4101
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
4102 4103 4104

	hci_dev_lock(hdev);

4105
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
4106 4107 4108
	if (conn && !ev->status) {
		struct inquiry_entry *ie;

4109 4110
		ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
		if (ie) {
L
Linus Torvalds 已提交
4111 4112 4113 4114 4115 4116 4117 4118
			ie->data.clock_offset = ev->clock_offset;
			ie->timestamp = jiffies;
		}
	}

	hci_dev_unlock(hdev);
}

4119
static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
4120 4121 4122 4123
{
	struct hci_ev_pkt_type_change *ev = (void *) skb->data;
	struct hci_conn *conn;

4124
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4125 4126 4127 4128 4129 4130 4131 4132 4133 4134

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
	if (conn && !ev->status)
		conn->pkt_type = __le16_to_cpu(ev->pkt_type);

	hci_dev_unlock(hdev);
}

4135
static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
4136
{
4137
	struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
4138 4139 4140 4141 4142 4143
	struct inquiry_entry *ie;

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

4144 4145
	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie) {
4146 4147 4148 4149 4150 4151 4152
		ie->data.pscan_rep_mode = ev->pscan_rep_mode;
		ie->timestamp = jiffies;
	}

	hci_dev_unlock(hdev);
}

4153 4154
static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
4155 4156 4157 4158 4159 4160 4161 4162 4163
{
	struct inquiry_data data;
	int num_rsp = *((__u8 *) skb->data);

	BT_DBG("%s num_rsp %d", hdev->name, num_rsp);

	if (!num_rsp)
		return;

4164
	if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
4165 4166
		return;

4167 4168 4169
	hci_dev_lock(hdev);

	if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
4170 4171
		struct inquiry_info_with_rssi_and_pscan_mode *info;
		info = (void *) (skb->data + 1);
4172

4173
		for (; num_rsp; num_rsp--, info++) {
4174 4175
			u32 flags;

4176 4177 4178 4179 4180 4181 4182
			bacpy(&data.bdaddr, &info->bdaddr);
			data.pscan_rep_mode	= info->pscan_rep_mode;
			data.pscan_period_mode	= info->pscan_period_mode;
			data.pscan_mode		= info->pscan_mode;
			memcpy(data.dev_class, info->dev_class, 3);
			data.clock_offset	= info->clock_offset;
			data.rssi		= info->rssi;
4183
			data.ssp_mode		= 0x00;
4184

4185 4186
			flags = hci_inquiry_cache_update(hdev, &data, false);

4187
			mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
4188
					  info->dev_class, info->rssi,
4189
					  flags, NULL, 0, NULL, 0);
4190 4191 4192 4193
		}
	} else {
		struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);

4194
		for (; num_rsp; num_rsp--, info++) {
4195 4196
			u32 flags;

4197 4198 4199 4200 4201 4202 4203
			bacpy(&data.bdaddr, &info->bdaddr);
			data.pscan_rep_mode	= info->pscan_rep_mode;
			data.pscan_period_mode	= info->pscan_period_mode;
			data.pscan_mode		= 0x00;
			memcpy(data.dev_class, info->dev_class, 3);
			data.clock_offset	= info->clock_offset;
			data.rssi		= info->rssi;
4204
			data.ssp_mode		= 0x00;
4205 4206 4207

			flags = hci_inquiry_cache_update(hdev, &data, false);

4208
			mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
4209
					  info->dev_class, info->rssi,
4210
					  flags, NULL, 0, NULL, 0);
4211 4212 4213 4214 4215 4216
		}
	}

	hci_dev_unlock(hdev);
}

4217 4218
static void hci_remote_ext_features_evt(struct hci_dev *hdev,
					struct sk_buff *skb)
4219
{
4220 4221 4222
	struct hci_ev_remote_ext_features *ev = (void *) skb->data;
	struct hci_conn *conn;

4223
	BT_DBG("%s", hdev->name);
4224 4225 4226 4227

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4228 4229
	if (!conn)
		goto unlock;
4230

4231 4232 4233
	if (ev->page < HCI_MAX_PAGES)
		memcpy(conn->features[ev->page], ev->features, 8);

4234 4235
	if (!ev->status && ev->page == 0x01) {
		struct inquiry_entry *ie;
4236

4237 4238
		ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
		if (ie)
4239
			ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
4240

4241
		if (ev->features[0] & LMP_HOST_SSP) {
4242
			set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
4243 4244 4245 4246 4247 4248 4249 4250 4251 4252 4253
		} else {
			/* It is mandatory by the Bluetooth specification that
			 * Extended Inquiry Results are only used when Secure
			 * Simple Pairing is enabled, but some devices violate
			 * this.
			 *
			 * To make these devices work, the internal SSP
			 * enabled flag needs to be cleared if the remote host
			 * features do not indicate SSP support */
			clear_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
		}
4254 4255 4256

		if (ev->features[0] & LMP_HOST_SC)
			set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
4257 4258 4259 4260 4261
	}

	if (conn->state != BT_CONFIG)
		goto unlock;

4262
	if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
4263 4264 4265 4266 4267
		struct hci_cp_remote_name_req cp;
		memset(&cp, 0, sizeof(cp));
		bacpy(&cp.bdaddr, &conn->dst);
		cp.pscan_rep_mode = 0x02;
		hci_send_cmd(hdev, HCI_OP_REMOTE_NAME_REQ, sizeof(cp), &cp);
4268
	} else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
4269
		mgmt_device_connected(hdev, conn, 0, NULL, 0);
4270

4271
	if (!hci_outgoing_auth_needed(hdev, conn)) {
4272
		conn->state = BT_CONNECTED;
4273
		hci_connect_cfm(conn, ev->status);
4274
		hci_conn_drop(conn);
4275 4276
	}

4277
unlock:
4278
	hci_dev_unlock(hdev);
4279 4280
}

4281 4282
static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
				       struct sk_buff *skb)
4283
{
4284 4285 4286
	struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

4287
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4288 4289 4290 4291

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
4292 4293 4294 4295
	if (!conn) {
		if (ev->link_type == ESCO_LINK)
			goto unlock;

4296 4297 4298 4299 4300 4301 4302 4303 4304
		/* When the link type in the event indicates SCO connection
		 * and lookup of the connection object fails, then check
		 * if an eSCO connection object exists.
		 *
		 * The core limits the synchronous connections to either
		 * SCO or eSCO. The eSCO connection is preferred and tried
		 * to be setup first and until successfully established,
		 * the link type will be hinted as eSCO.
		 */
4305 4306 4307 4308
		conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
		if (!conn)
			goto unlock;
	}
4309

4310 4311
	switch (ev->status) {
	case 0x00:
4312 4313
		conn->handle = __le16_to_cpu(ev->handle);
		conn->state  = BT_CONNECTED;
4314
		conn->type   = ev->link_type;
4315

4316
		hci_debugfs_create_conn(conn);
4317
		hci_conn_add_sysfs(conn);
4318 4319
		break;

4320
	case 0x10:	/* Connection Accept Timeout */
4321
	case 0x0d:	/* Connection Rejected due to Limited Resources */
4322
	case 0x11:	/* Unsupported Feature or Parameter Value */
4323
	case 0x1c:	/* SCO interval rejected */
4324
	case 0x1a:	/* Unsupported Remote Feature */
4325
	case 0x1f:	/* Unspecified error */
4326
	case 0x20:	/* Unsupported LMP Parameter value */
4327
		if (conn->out) {
4328 4329
			conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
					(hdev->esco_type & EDR_ESCO_MASK);
4330 4331
			if (hci_setup_sync(conn, conn->link->handle))
				goto unlock;
4332 4333 4334 4335
		}
		/* fall through */

	default:
4336
		conn->state = BT_CLOSED;
4337 4338
		break;
	}
4339

4340 4341 4342 4343 4344 4345 4346 4347 4348 4349 4350 4351 4352
	bt_dev_dbg(hdev, "SCO connected with air mode: %02x", ev->air_mode);

	switch (conn->setting & SCO_AIRMODE_MASK) {
	case SCO_AIRMODE_CVSD:
		if (hdev->notify)
			hdev->notify(hdev, HCI_NOTIFY_ENABLE_SCO_CVSD);
		break;
	case SCO_AIRMODE_TRANSP:
		if (hdev->notify)
			hdev->notify(hdev, HCI_NOTIFY_ENABLE_SCO_TRANSP);
		break;
	}

4353
	hci_connect_cfm(conn, ev->status);
4354 4355 4356 4357 4358
	if (ev->status)
		hci_conn_del(conn);

unlock:
	hci_dev_unlock(hdev);
4359 4360
}

4361 4362 4363 4364 4365 4366 4367 4368 4369 4370 4371 4372 4373 4374 4375 4376 4377
static inline size_t eir_get_length(u8 *eir, size_t eir_len)
{
	size_t parsed = 0;

	while (parsed < eir_len) {
		u8 field_len = eir[0];

		if (field_len == 0)
			return parsed;

		parsed += field_len + 1;
		eir += field_len + 1;
	}

	return eir_len;
}

4378 4379
static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
L
Linus Torvalds 已提交
4380
{
4381 4382 4383
	struct inquiry_data data;
	struct extended_inquiry_info *info = (void *) (skb->data + 1);
	int num_rsp = *((__u8 *) skb->data);
4384
	size_t eir_len;
L
Linus Torvalds 已提交
4385

4386
	BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
L
Linus Torvalds 已提交
4387

4388 4389
	if (!num_rsp)
		return;
L
Linus Torvalds 已提交
4390

4391
	if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
4392 4393
		return;

4394 4395
	hci_dev_lock(hdev);

4396
	for (; num_rsp; num_rsp--, info++) {
4397 4398
		u32 flags;
		bool name_known;
4399

4400
		bacpy(&data.bdaddr, &info->bdaddr);
4401 4402 4403
		data.pscan_rep_mode	= info->pscan_rep_mode;
		data.pscan_period_mode	= info->pscan_period_mode;
		data.pscan_mode		= 0x00;
4404
		memcpy(data.dev_class, info->dev_class, 3);
4405 4406
		data.clock_offset	= info->clock_offset;
		data.rssi		= info->rssi;
4407
		data.ssp_mode		= 0x01;
4408

4409
		if (hci_dev_test_flag(hdev, HCI_MGMT))
4410 4411 4412
			name_known = eir_get_data(info->data,
						  sizeof(info->data),
						  EIR_NAME_COMPLETE, NULL);
4413 4414 4415
		else
			name_known = true;

4416 4417
		flags = hci_inquiry_cache_update(hdev, &data, name_known);

4418
		eir_len = eir_get_length(info->data, sizeof(info->data));
4419

4420
		mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
4421 4422
				  info->dev_class, info->rssi,
				  flags, info->data, eir_len, NULL, 0);
4423 4424 4425 4426
	}

	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
4427

4428 4429 4430 4431 4432 4433
static void hci_key_refresh_complete_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	struct hci_ev_key_refresh_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

4434
	BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
4435 4436 4437 4438 4439 4440 4441 4442
	       __le16_to_cpu(ev->handle));

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
	if (!conn)
		goto unlock;

4443 4444 4445 4446 4447 4448
	/* For BR/EDR the necessary steps are taken through the
	 * auth_complete event.
	 */
	if (conn->type != LE_LINK)
		goto unlock;

4449 4450 4451 4452 4453 4454
	if (!ev->status)
		conn->sec_level = conn->pending_sec_level;

	clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);

	if (ev->status && conn->state == BT_CONNECTED) {
A
Andre Guedes 已提交
4455
		hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
4456
		hci_conn_drop(conn);
4457 4458 4459 4460 4461 4462 4463
		goto unlock;
	}

	if (conn->state == BT_CONFIG) {
		if (!ev->status)
			conn->state = BT_CONNECTED;

4464
		hci_connect_cfm(conn, ev->status);
4465
		hci_conn_drop(conn);
4466 4467 4468 4469 4470
	} else {
		hci_auth_cfm(conn, ev->status);

		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
4471
		hci_conn_drop(conn);
4472 4473 4474 4475 4476 4477
	}

unlock:
	hci_dev_unlock(hdev);
}

4478
static u8 hci_get_auth_req(struct hci_conn *conn)
4479 4480
{
	/* If remote requests no-bonding follow that lead */
4481 4482
	if (conn->remote_auth == HCI_AT_NO_BONDING ||
	    conn->remote_auth == HCI_AT_NO_BONDING_MITM)
4483
		return conn->remote_auth | (conn->auth_type & 0x01);
4484

4485 4486 4487 4488 4489 4490 4491
	/* If both remote and local have enough IO capabilities, require
	 * MITM protection
	 */
	if (conn->remote_cap != HCI_IO_NO_INPUT_OUTPUT &&
	    conn->io_capability != HCI_IO_NO_INPUT_OUTPUT)
		return conn->remote_auth | 0x01;

4492 4493
	/* No MITM protection possible so ignore remote requirement */
	return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
4494 4495
}

4496 4497 4498 4499 4500 4501 4502 4503 4504
static u8 bredr_oob_data_present(struct hci_conn *conn)
{
	struct hci_dev *hdev = conn->hdev;
	struct oob_data *data;

	data = hci_find_remote_oob_data(hdev, &conn->dst, BDADDR_BREDR);
	if (!data)
		return 0x00;

4505 4506 4507 4508 4509 4510 4511 4512 4513
	if (bredr_sc_enabled(hdev)) {
		/* When Secure Connections is enabled, then just
		 * return the present value stored with the OOB
		 * data. The stored value contains the right present
		 * information. However it can only be trusted when
		 * not in Secure Connection Only mode.
		 */
		if (!hci_dev_test_flag(hdev, HCI_SC_ONLY))
			return data->present;
4514

4515 4516 4517 4518
		/* When Secure Connections Only mode is enabled, then
		 * the P-256 values are required. If they are not
		 * available, then do not declare that OOB data is
		 * present.
4519
		 */
4520 4521
		if (!memcmp(data->rand256, ZERO_KEY, 16) ||
		    !memcmp(data->hash256, ZERO_KEY, 16))
4522 4523
			return 0x00;

4524
		return 0x02;
4525
	}
4526

4527 4528 4529 4530 4531 4532 4533 4534 4535
	/* When Secure Connections is not enabled or actually
	 * not supported by the hardware, then check that if
	 * P-192 data values are present.
	 */
	if (!memcmp(data->rand192, ZERO_KEY, 16) ||
	    !memcmp(data->hash192, ZERO_KEY, 16))
		return 0x00;

	return 0x01;
4536 4537
}

4538
static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
4539 4540 4541 4542 4543 4544 4545 4546 4547
{
	struct hci_ev_io_capa_request *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4548 4549 4550 4551 4552
	if (!conn)
		goto unlock;

	hci_conn_hold(conn);

4553
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4554 4555
		goto unlock;

4556 4557 4558
	/* Allow pairing if we're pairable, the initiators of the
	 * pairing or if the remote is not requesting bonding.
	 */
4559
	if (hci_dev_test_flag(hdev, HCI_BONDABLE) ||
4560
	    test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags) ||
4561
	    (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
4562 4563 4564
		struct hci_cp_io_capability_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
4565 4566 4567
		/* Change the IO capability from KeyboardDisplay
		 * to DisplayYesNo as it is not supported by BT spec. */
		cp.capability = (conn->io_capability == 0x04) ?
4568
				HCI_IO_DISPLAY_YESNO : conn->io_capability;
4569 4570 4571

		/* If we are initiators, there is no remote information yet */
		if (conn->remote_auth == 0xff) {
4572
			/* Request MITM protection if our IO caps allow it
4573
			 * except for the no-bonding case.
4574
			 */
4575
			if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
4576
			    conn->auth_type != HCI_AT_NO_BONDING)
4577
				conn->auth_type |= 0x01;
4578 4579 4580
		} else {
			conn->auth_type = hci_get_auth_req(conn);
		}
4581

4582 4583 4584
		/* If we're not bondable, force one of the non-bondable
		 * authentication requirement values.
		 */
4585
		if (!hci_dev_test_flag(hdev, HCI_BONDABLE))
4586 4587 4588
			conn->auth_type &= HCI_AT_NO_BONDING_MITM;

		cp.authentication = conn->auth_type;
4589
		cp.oob_data = bredr_oob_data_present(conn);
4590

4591
		hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
4592
			     sizeof(cp), &cp);
4593 4594 4595 4596
	} else {
		struct hci_cp_io_capability_neg_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
4597
		cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
4598

4599
		hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
4600
			     sizeof(cp), &cp);
4601 4602 4603 4604 4605 4606
	}

unlock:
	hci_dev_unlock(hdev);
}

4607
static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
4608 4609 4610 4611 4612 4613 4614 4615 4616 4617 4618 4619 4620 4621 4622 4623
{
	struct hci_ev_io_capa_reply *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (!conn)
		goto unlock;

	conn->remote_cap = ev->capability;
	conn->remote_auth = ev->authentication;

unlock:
4624 4625 4626
	hci_dev_unlock(hdev);
}

4627 4628
static void hci_user_confirm_request_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4629 4630
{
	struct hci_ev_user_confirm_req *ev = (void *) skb->data;
4631
	int loc_mitm, rem_mitm, confirm_hint = 0;
4632
	struct hci_conn *conn;
4633 4634 4635 4636 4637

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

4638
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4639
		goto unlock;
4640

4641 4642 4643 4644 4645 4646 4647 4648
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (!conn)
		goto unlock;

	loc_mitm = (conn->auth_type & 0x01);
	rem_mitm = (conn->remote_auth & 0x01);

	/* If we require MITM but the remote device can't provide that
4649 4650 4651
	 * (it has NoInputNoOutput) then reject the confirmation
	 * request. We check the security level here since it doesn't
	 * necessarily match conn->auth_type.
4652
	 */
4653 4654
	if (conn->pending_sec_level > BT_SECURITY_MEDIUM &&
	    conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
4655 4656
		BT_DBG("Rejecting request: remote device can't provide MITM");
		hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
4657
			     sizeof(ev->bdaddr), &ev->bdaddr);
4658 4659 4660 4661
		goto unlock;
	}

	/* If no side requires MITM protection; auto-accept */
4662 4663
	if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
	    (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
4664 4665 4666

		/* If we're not the initiators request authorization to
		 * proceed from user space (mgmt_user_confirm with
4667
		 * confirm_hint set to 1). The exception is if neither
4668 4669
		 * side had MITM or if the local IO capability is
		 * NoInputNoOutput, in which case we do auto-accept
4670 4671
		 */
		if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
4672
		    conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
4673
		    (loc_mitm || rem_mitm)) {
4674 4675 4676 4677 4678
			BT_DBG("Confirming auto-accept as acceptor");
			confirm_hint = 1;
			goto confirm;
		}

4679 4680 4681 4682 4683 4684 4685 4686 4687 4688
		/* If there already exists link key in local host, leave the
		 * decision to user space since the remote device could be
		 * legitimate or malicious.
		 */
		if (hci_find_link_key(hdev, &ev->bdaddr)) {
			bt_dev_dbg(hdev, "Local host already has link key");
			confirm_hint = 1;
			goto confirm;
		}

4689
		BT_DBG("Auto-accept of user confirmation with %ums delay",
4690
		       hdev->auto_accept_delay);
4691 4692 4693

		if (hdev->auto_accept_delay > 0) {
			int delay = msecs_to_jiffies(hdev->auto_accept_delay);
4694 4695
			queue_delayed_work(conn->hdev->workqueue,
					   &conn->auto_accept_work, delay);
4696 4697 4698
			goto unlock;
		}

4699
		hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
4700
			     sizeof(ev->bdaddr), &ev->bdaddr);
4701 4702 4703
		goto unlock;
	}

4704
confirm:
4705 4706
	mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
				  le32_to_cpu(ev->passkey), confirm_hint);
4707 4708

unlock:
4709 4710 4711
	hci_dev_unlock(hdev);
}

4712 4713
static void hci_user_passkey_request_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4714 4715 4716 4717 4718
{
	struct hci_ev_user_passkey_req *ev = (void *) skb->data;

	BT_DBG("%s", hdev->name);

4719
	if (hci_dev_test_flag(hdev, HCI_MGMT))
4720
		mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
4721 4722
}

4723 4724 4725 4726 4727 4728 4729 4730 4731 4732 4733 4734 4735 4736 4737
static void hci_user_passkey_notify_evt(struct hci_dev *hdev,
					struct sk_buff *skb)
{
	struct hci_ev_user_passkey_notify *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s", hdev->name);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (!conn)
		return;

	conn->passkey_notify = __le32_to_cpu(ev->passkey);
	conn->passkey_entered = 0;

4738
	if (hci_dev_test_flag(hdev, HCI_MGMT))
4739 4740 4741 4742 4743 4744 4745 4746 4747 4748 4749 4750 4751 4752 4753 4754 4755 4756 4757 4758 4759 4760 4761 4762 4763 4764 4765 4766 4767 4768 4769 4770 4771 4772 4773 4774 4775
		mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
					 conn->dst_type, conn->passkey_notify,
					 conn->passkey_entered);
}

static void hci_keypress_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_keypress_notify *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s", hdev->name);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (!conn)
		return;

	switch (ev->type) {
	case HCI_KEYPRESS_STARTED:
		conn->passkey_entered = 0;
		return;

	case HCI_KEYPRESS_ENTERED:
		conn->passkey_entered++;
		break;

	case HCI_KEYPRESS_ERASED:
		conn->passkey_entered--;
		break;

	case HCI_KEYPRESS_CLEARED:
		conn->passkey_entered = 0;
		break;

	case HCI_KEYPRESS_COMPLETED:
		return;
	}

4776
	if (hci_dev_test_flag(hdev, HCI_MGMT))
4777 4778 4779 4780 4781
		mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
					 conn->dst_type, conn->passkey_notify,
					 conn->passkey_entered);
}

4782 4783
static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4784 4785 4786 4787 4788 4789 4790 4791 4792
{
	struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4793 4794 4795
	if (!conn)
		goto unlock;

4796 4797 4798
	/* Reset the authentication requirement to unknown */
	conn->remote_auth = 0xff;

4799 4800 4801 4802 4803
	/* To avoid duplicate auth_failed events to user space we check
	 * the HCI_CONN_AUTH_PEND flag which will be set if we
	 * initiated the authentication. A traditional auth_complete
	 * event gets always produced as initiator and is also mapped to
	 * the mgmt_auth_failed event */
4804
	if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
4805
		mgmt_auth_failed(conn, ev->status);
4806

4807
	hci_conn_drop(conn);
4808 4809

unlock:
4810 4811 4812
	hci_dev_unlock(hdev);
}

4813 4814
static void hci_remote_host_features_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4815 4816 4817
{
	struct hci_ev_remote_host_features *ev = (void *) skb->data;
	struct inquiry_entry *ie;
4818
	struct hci_conn *conn;
4819 4820 4821 4822 4823

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

4824 4825 4826 4827
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (conn)
		memcpy(conn->features[1], ev->features, 8);

4828 4829
	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie)
4830
		ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
4831 4832 4833 4834

	hci_dev_unlock(hdev);
}

4835 4836
static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
4837 4838 4839 4840 4841 4842 4843 4844
{
	struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
	struct oob_data *data;

	BT_DBG("%s", hdev->name);

	hci_dev_lock(hdev);

4845
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4846 4847
		goto unlock;

4848
	data = hci_find_remote_oob_data(hdev, &ev->bdaddr, BDADDR_BREDR);
4849 4850
	if (!data) {
		struct hci_cp_remote_oob_data_neg_reply cp;
4851

4852 4853 4854 4855 4856
		bacpy(&cp.bdaddr, &ev->bdaddr);
		hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
			     sizeof(cp), &cp);
		goto unlock;
	}
4857

4858 4859
	if (bredr_sc_enabled(hdev)) {
		struct hci_cp_remote_oob_ext_data_reply cp;
4860

4861
		bacpy(&cp.bdaddr, &ev->bdaddr);
4862
		if (hci_dev_test_flag(hdev, HCI_SC_ONLY)) {
4863 4864 4865 4866 4867
			memset(cp.hash192, 0, sizeof(cp.hash192));
			memset(cp.rand192, 0, sizeof(cp.rand192));
		} else {
			memcpy(cp.hash192, data->hash192, sizeof(cp.hash192));
			memcpy(cp.rand192, data->rand192, sizeof(cp.rand192));
4868
		}
4869 4870 4871 4872 4873
		memcpy(cp.hash256, data->hash256, sizeof(cp.hash256));
		memcpy(cp.rand256, data->rand256, sizeof(cp.rand256));

		hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_EXT_DATA_REPLY,
			     sizeof(cp), &cp);
4874
	} else {
4875
		struct hci_cp_remote_oob_data_reply cp;
4876 4877

		bacpy(&cp.bdaddr, &ev->bdaddr);
4878 4879 4880 4881
		memcpy(cp.hash, data->hash192, sizeof(cp.hash));
		memcpy(cp.rand, data->rand192, sizeof(cp.rand));

		hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY,
4882
			     sizeof(cp), &cp);
4883 4884
	}

4885
unlock:
4886 4887 4888
	hci_dev_unlock(hdev);
}

4889 4890 4891 4892 4893 4894 4895 4896 4897 4898 4899 4900 4901 4902 4903 4904 4905
#if IS_ENABLED(CONFIG_BT_HS)
static void hci_chan_selected_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_channel_selected *ev = (void *)skb->data;
	struct hci_conn *hcon;

	BT_DBG("%s handle 0x%2.2x", hdev->name, ev->phy_handle);

	skb_pull(skb, sizeof(*ev));

	hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
	if (!hcon)
		return;

	amp_read_loc_assoc_final_data(hdev, hcon);
}

4906 4907 4908 4909 4910 4911 4912 4913 4914 4915 4916 4917 4918 4919 4920 4921 4922 4923 4924 4925 4926 4927 4928 4929 4930 4931 4932 4933 4934 4935
static void hci_phy_link_complete_evt(struct hci_dev *hdev,
				      struct sk_buff *skb)
{
	struct hci_ev_phy_link_complete *ev = (void *) skb->data;
	struct hci_conn *hcon, *bredr_hcon;

	BT_DBG("%s handle 0x%2.2x status 0x%2.2x", hdev->name, ev->phy_handle,
	       ev->status);

	hci_dev_lock(hdev);

	hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
	if (!hcon) {
		hci_dev_unlock(hdev);
		return;
	}

	if (ev->status) {
		hci_conn_del(hcon);
		hci_dev_unlock(hdev);
		return;
	}

	bredr_hcon = hcon->amp_mgr->l2cap_conn->hcon;

	hcon->state = BT_CONNECTED;
	bacpy(&hcon->dst, &bredr_hcon->dst);

	hci_conn_hold(hcon);
	hcon->disc_timeout = HCI_DISCONN_TIMEOUT;
4936
	hci_conn_drop(hcon);
4937

4938
	hci_debugfs_create_conn(hcon);
4939 4940
	hci_conn_add_sysfs(hcon);

4941
	amp_physical_cfm(bredr_hcon, hcon);
4942

4943
	hci_dev_unlock(hdev);
4944 4945
}

4946 4947 4948 4949 4950 4951 4952 4953 4954 4955 4956 4957 4958 4959 4960 4961 4962 4963 4964 4965 4966 4967 4968 4969 4970 4971 4972 4973 4974 4975 4976 4977 4978 4979 4980 4981 4982 4983
static void hci_loglink_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_logical_link_complete *ev = (void *) skb->data;
	struct hci_conn *hcon;
	struct hci_chan *hchan;
	struct amp_mgr *mgr;

	BT_DBG("%s log_handle 0x%4.4x phy_handle 0x%2.2x status 0x%2.2x",
	       hdev->name, le16_to_cpu(ev->handle), ev->phy_handle,
	       ev->status);

	hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
	if (!hcon)
		return;

	/* Create AMP hchan */
	hchan = hci_chan_create(hcon);
	if (!hchan)
		return;

	hchan->handle = le16_to_cpu(ev->handle);

	BT_DBG("hcon %p mgr %p hchan %p", hcon, hcon->amp_mgr, hchan);

	mgr = hcon->amp_mgr;
	if (mgr && mgr->bredr_chan) {
		struct l2cap_chan *bredr_chan = mgr->bredr_chan;

		l2cap_chan_lock(bredr_chan);

		bredr_chan->conn->mtu = hdev->block_mtu;
		l2cap_logical_cfm(bredr_chan, hchan, 0);
		hci_conn_hold(hcon);

		l2cap_chan_unlock(bredr_chan);
	}
}

4984 4985 4986 4987 4988 4989 4990 4991 4992 4993 4994 4995 4996 4997 4998 4999 5000 5001 5002 5003 5004 5005 5006 5007
static void hci_disconn_loglink_complete_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
{
	struct hci_ev_disconn_logical_link_complete *ev = (void *) skb->data;
	struct hci_chan *hchan;

	BT_DBG("%s log handle 0x%4.4x status 0x%2.2x", hdev->name,
	       le16_to_cpu(ev->handle), ev->status);

	if (ev->status)
		return;

	hci_dev_lock(hdev);

	hchan = hci_chan_lookup_handle(hdev, le16_to_cpu(ev->handle));
	if (!hchan)
		goto unlock;

	amp_destroy_logical_link(hchan, ev->reason);

unlock:
	hci_dev_unlock(hdev);
}

5008 5009 5010 5011 5012 5013 5014 5015 5016 5017 5018 5019 5020 5021 5022 5023 5024 5025 5026 5027 5028
static void hci_disconn_phylink_complete_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
{
	struct hci_ev_disconn_phy_link_complete *ev = (void *) skb->data;
	struct hci_conn *hcon;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	if (ev->status)
		return;

	hci_dev_lock(hdev);

	hcon = hci_conn_hash_lookup_handle(hdev, ev->phy_handle);
	if (hcon) {
		hcon->state = BT_CLOSED;
		hci_conn_del(hcon);
	}

	hci_dev_unlock(hdev);
}
5029
#endif
5030

5031 5032 5033
static void le_conn_complete_evt(struct hci_dev *hdev, u8 status,
			bdaddr_t *bdaddr, u8 bdaddr_type, u8 role, u16 handle,
			u16 interval, u16 latency, u16 supervision_timeout)
V
Ville Tervo 已提交
5034
{
5035
	struct hci_conn_params *params;
V
Ville Tervo 已提交
5036
	struct hci_conn *conn;
5037
	struct smp_irk *irk;
5038
	u8 addr_type;
V
Ville Tervo 已提交
5039 5040 5041

	hci_dev_lock(hdev);

5042 5043 5044
	/* All controllers implicitly stop advertising in the event of a
	 * connection, so ensure that the state bit is cleared.
	 */
5045
	hci_dev_clear_flag(hdev, HCI_LE_ADV);
5046

5047
	conn = hci_lookup_le_connect(hdev);
5048
	if (!conn) {
5049
		conn = hci_conn_add(hdev, LE_LINK, bdaddr, role);
5050
		if (!conn) {
5051
			bt_dev_err(hdev, "no memory for new connection");
A
Andre Guedes 已提交
5052
			goto unlock;
5053
		}
5054

5055
		conn->dst_type = bdaddr_type;
5056

5057 5058 5059 5060 5061 5062 5063 5064 5065
		/* If we didn't have a hci_conn object previously
		 * but we're in master role this must be something
		 * initiated using a white list. Since white list based
		 * connections are not "first class citizens" we don't
		 * have full tracking of them. Therefore, we go ahead
		 * with a "best effort" approach of determining the
		 * initiator address based on the HCI_PRIVACY flag.
		 */
		if (conn->out) {
5066 5067
			conn->resp_addr_type = bdaddr_type;
			bacpy(&conn->resp_addr, bdaddr);
5068
			if (hci_dev_test_flag(hdev, HCI_PRIVACY)) {
5069 5070 5071 5072 5073 5074 5075 5076
				conn->init_addr_type = ADDR_LE_DEV_RANDOM;
				bacpy(&conn->init_addr, &hdev->rpa);
			} else {
				hci_copy_identity_address(hdev,
							  &conn->init_addr,
							  &conn->init_addr_type);
			}
		}
5077 5078
	} else {
		cancel_delayed_work(&conn->le_conn_timeout);
5079
	}
V
Ville Tervo 已提交
5080

5081 5082 5083 5084 5085
	if (!conn->out) {
		/* Set the responder (our side) address type based on
		 * the advertising address type.
		 */
		conn->resp_addr_type = hdev->adv_addr_type;
5086 5087 5088 5089 5090 5091 5092
		if (hdev->adv_addr_type == ADDR_LE_DEV_RANDOM) {
			/* In case of ext adv, resp_addr will be updated in
			 * Adv Terminated event.
			 */
			if (!ext_adv_capable(hdev))
				bacpy(&conn->resp_addr, &hdev->random_addr);
		} else {
5093
			bacpy(&conn->resp_addr, &hdev->bdaddr);
5094
		}
5095

5096 5097
		conn->init_addr_type = bdaddr_type;
		bacpy(&conn->init_addr, bdaddr);
5098 5099 5100 5101 5102 5103 5104 5105

		/* For incoming connections, set the default minimum
		 * and maximum connection interval. They will be used
		 * to check if the parameters are in range and if not
		 * trigger the connection update procedure.
		 */
		conn->le_conn_min_interval = hdev->le_conn_min_interval;
		conn->le_conn_max_interval = hdev->le_conn_max_interval;
5106
	}
5107

5108 5109 5110 5111 5112 5113 5114 5115 5116 5117
	/* Lookup the identity address from the stored connection
	 * address and address type.
	 *
	 * When establishing connections to an identity address, the
	 * connection procedure will store the resolvable random
	 * address first. Now if it can be converted back into the
	 * identity address, start using the identity address from
	 * now on.
	 */
	irk = hci_get_irk(hdev, &conn->dst, conn->dst_type);
5118 5119 5120 5121 5122
	if (irk) {
		bacpy(&conn->dst, &irk->bdaddr);
		conn->dst_type = irk->addr_type;
	}

5123 5124
	if (status) {
		hci_le_conn_failed(conn, status);
5125 5126 5127
		goto unlock;
	}

5128 5129 5130 5131 5132
	if (conn->dst_type == ADDR_LE_DEV_PUBLIC)
		addr_type = BDADDR_LE_PUBLIC;
	else
		addr_type = BDADDR_LE_RANDOM;

5133 5134 5135
	/* Drop the connection if the device is blocked */
	if (hci_bdaddr_list_lookup(&hdev->blacklist, &conn->dst, addr_type)) {
		hci_conn_drop(conn);
5136 5137 5138
		goto unlock;
	}

5139
	if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
5140
		mgmt_device_connected(hdev, conn, 0, NULL, 0);
5141

5142
	conn->sec_level = BT_SECURITY_LOW;
5143
	conn->handle = handle;
5144
	conn->state = BT_CONFIG;
V
Ville Tervo 已提交
5145

5146 5147 5148
	conn->le_conn_interval = interval;
	conn->le_conn_latency = latency;
	conn->le_supv_timeout = supervision_timeout;
5149

5150
	hci_debugfs_create_conn(conn);
V
Ville Tervo 已提交
5151 5152
	hci_conn_add_sysfs(conn);

5153 5154 5155 5156 5157 5158 5159 5160 5161 5162 5163 5164
	/* The remote features procedure is defined for master
	 * role only. So only in case of an initiated connection
	 * request the remote features.
	 *
	 * If the local controller supports slave-initiated features
	 * exchange, then requesting the remote features in slave
	 * role is possible. Otherwise just transition into the
	 * connected state without requesting the remote features.
	 */
	if (conn->out ||
	    (hdev->le_features[0] & HCI_LE_SLAVE_FEATURES)) {
		struct hci_cp_le_read_remote_features cp;
5165

5166
		cp.handle = __cpu_to_le16(conn->handle);
5167

5168 5169
		hci_send_cmd(hdev, HCI_OP_LE_READ_REMOTE_FEATURES,
			     sizeof(cp), &cp);
5170

5171
		hci_conn_hold(conn);
5172
	} else {
5173
		conn->state = BT_CONNECTED;
5174
		hci_connect_cfm(conn, status);
5175
	}
V
Ville Tervo 已提交
5176

5177 5178
	params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
					   conn->dst_type);
5179
	if (params) {
5180
		list_del_init(&params->action);
5181 5182
		if (params->conn) {
			hci_conn_drop(params->conn);
5183
			hci_conn_put(params->conn);
5184 5185 5186
			params->conn = NULL;
		}
	}
5187

V
Ville Tervo 已提交
5188
unlock:
5189
	hci_update_background_scan(hdev);
V
Ville Tervo 已提交
5190 5191 5192
	hci_dev_unlock(hdev);
}

5193 5194 5195 5196 5197 5198 5199 5200 5201 5202 5203 5204 5205
static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_le_conn_complete *ev = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	le_conn_complete_evt(hdev, ev->status, &ev->bdaddr, ev->bdaddr_type,
			     ev->role, le16_to_cpu(ev->handle),
			     le16_to_cpu(ev->interval),
			     le16_to_cpu(ev->latency),
			     le16_to_cpu(ev->supervision_timeout));
}

5206 5207 5208 5209 5210 5211 5212 5213 5214 5215 5216 5217 5218 5219
static void hci_le_enh_conn_complete_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	struct hci_ev_le_enh_conn_complete *ev = (void *) skb->data;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	le_conn_complete_evt(hdev, ev->status, &ev->bdaddr, ev->bdaddr_type,
			     ev->role, le16_to_cpu(ev->handle),
			     le16_to_cpu(ev->interval),
			     le16_to_cpu(ev->latency),
			     le16_to_cpu(ev->supervision_timeout));
}

5220 5221 5222 5223 5224 5225 5226 5227 5228 5229 5230 5231 5232 5233 5234 5235 5236 5237 5238 5239 5240 5241 5242 5243 5244 5245 5246 5247
static void hci_le_ext_adv_term_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_evt_le_ext_adv_set_term *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	if (ev->status)
		return;

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->conn_handle));
	if (conn) {
		struct adv_info *adv_instance;

		if (hdev->adv_addr_type != ADDR_LE_DEV_RANDOM)
			return;

		if (!hdev->cur_adv_instance) {
			bacpy(&conn->resp_addr, &hdev->random_addr);
			return;
		}

		adv_instance = hci_find_adv_instance(hdev, hdev->cur_adv_instance);
		if (adv_instance)
			bacpy(&conn->resp_addr, &adv_instance->random_addr);
	}
}

5248 5249 5250 5251 5252 5253 5254 5255 5256 5257 5258 5259 5260 5261 5262 5263 5264 5265 5266 5267 5268 5269 5270
static void hci_le_conn_update_complete_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
{
	struct hci_ev_le_conn_update_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	if (ev->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
	if (conn) {
		conn->le_conn_interval = le16_to_cpu(ev->interval);
		conn->le_conn_latency = le16_to_cpu(ev->latency);
		conn->le_supv_timeout = le16_to_cpu(ev->supervision_timeout);
	}

	hci_dev_unlock(hdev);
}

5271
/* This function requires the caller holds hdev->lock */
5272 5273
static struct hci_conn *check_pending_le_conn(struct hci_dev *hdev,
					      bdaddr_t *addr,
5274 5275
					      u8 addr_type, u8 adv_type,
					      bdaddr_t *direct_rpa)
5276 5277
{
	struct hci_conn *conn;
5278
	struct hci_conn_params *params;
5279

5280 5281
	/* If the event is not connectable don't proceed further */
	if (adv_type != LE_ADV_IND && adv_type != LE_ADV_DIRECT_IND)
5282
		return NULL;
5283 5284

	/* Ignore if the device is blocked */
5285
	if (hci_bdaddr_list_lookup(&hdev->blacklist, addr, addr_type))
5286
		return NULL;
5287

5288 5289 5290
	/* Most controller will fail if we try to create new connections
	 * while we have an existing one in slave role.
	 */
5291 5292 5293
	if (hdev->conn_hash.le_num_slave > 0 &&
	    (!test_bit(HCI_QUIRK_VALID_LE_STATES, &hdev->quirks) ||
	     !(hdev->le_states[3] & 0x10)))
5294
		return NULL;
5295

5296 5297 5298
	/* If we're not connectable only connect devices that we have in
	 * our pend_le_conns list.
	 */
5299 5300
	params = hci_pend_le_action_lookup(&hdev->pend_le_conns, addr,
					   addr_type);
5301
	if (!params)
5302
		return NULL;
5303

5304 5305 5306 5307 5308 5309 5310 5311 5312 5313 5314 5315 5316
	if (!params->explicit_connect) {
		switch (params->auto_connect) {
		case HCI_AUTO_CONN_DIRECT:
			/* Only devices advertising with ADV_DIRECT_IND are
			 * triggering a connection attempt. This is allowing
			 * incoming connections from slave devices.
			 */
			if (adv_type != LE_ADV_DIRECT_IND)
				return NULL;
			break;
		case HCI_AUTO_CONN_ALWAYS:
			/* Devices advertising with ADV_IND or ADV_DIRECT_IND
			 * are triggering a connection attempt. This means
5317
			 * that incoming connections from slave device are
5318 5319 5320 5321 5322
			 * accepted and also outgoing connections to slave
			 * devices are established when found.
			 */
			break;
		default:
5323
			return NULL;
5324
		}
5325
	}
5326 5327

	conn = hci_connect_le(hdev, addr, addr_type, BT_SECURITY_LOW,
5328 5329
			      HCI_LE_AUTOCONN_TIMEOUT, HCI_ROLE_MASTER,
			      direct_rpa);
5330
	if (!IS_ERR(conn)) {
5331 5332 5333
		/* If HCI_AUTO_CONN_EXPLICIT is set, conn is already owned
		 * by higher layer that tried to connect, if no then
		 * store the pointer since we don't really have any
5334 5335 5336 5337 5338
		 * other owner of the object besides the params that
		 * triggered it. This way we can abort the connection if
		 * the parameters get removed and keep the reference
		 * count consistent once the connection is established.
		 */
5339 5340 5341 5342

		if (!params->explicit_connect)
			params->conn = hci_conn_get(conn);

5343
		return conn;
5344
	}
5345 5346 5347 5348 5349 5350 5351 5352 5353 5354 5355

	switch (PTR_ERR(conn)) {
	case -EBUSY:
		/* If hci_connect() returns -EBUSY it means there is already
		 * an LE connection attempt going on. Since controllers don't
		 * support more than one connection attempt at the time, we
		 * don't consider this an error case.
		 */
		break;
	default:
		BT_DBG("Failed to connect: err %ld", PTR_ERR(conn));
5356
		return NULL;
5357
	}
5358 5359

	return NULL;
5360 5361
}

5362
static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
5363 5364
			       u8 bdaddr_type, bdaddr_t *direct_addr,
			       u8 direct_addr_type, s8 rssi, u8 *data, u8 len)
5365
{
5366
	struct discovery_state *d = &hdev->discovery;
5367
	struct smp_irk *irk;
5368
	struct hci_conn *conn;
5369
	bool match;
5370
	u32 flags;
5371 5372
	u8 *ptr, real_len;

5373 5374 5375 5376 5377 5378 5379 5380
	switch (type) {
	case LE_ADV_IND:
	case LE_ADV_DIRECT_IND:
	case LE_ADV_SCAN_IND:
	case LE_ADV_NONCONN_IND:
	case LE_ADV_SCAN_RSP:
		break;
	default:
5381 5382
		bt_dev_err_ratelimited(hdev, "unknown advertising packet "
				       "type: 0x%02x", type);
5383 5384 5385
		return;
	}

5386 5387 5388 5389 5390 5391 5392 5393 5394 5395 5396 5397 5398 5399 5400
	/* Find the end of the data in case the report contains padded zero
	 * bytes at the end causing an invalid length value.
	 *
	 * When data is NULL, len is 0 so there is no need for extra ptr
	 * check as 'ptr < data + 0' is already false in such case.
	 */
	for (ptr = data; ptr < data + len && *ptr; ptr += *ptr + 1) {
		if (ptr + 1 + *ptr > data + len)
			break;
	}

	real_len = ptr - data;

	/* Adjust for actual length */
	if (len != real_len) {
5401 5402
		bt_dev_err_ratelimited(hdev, "advertising data len corrected %u -> %u",
				       len, real_len);
5403 5404
		len = real_len;
	}
5405

5406 5407 5408 5409 5410 5411 5412 5413 5414 5415 5416 5417 5418 5419 5420
	/* If the direct address is present, then this report is from
	 * a LE Direct Advertising Report event. In that case it is
	 * important to see if the address is matching the local
	 * controller address.
	 */
	if (direct_addr) {
		/* Only resolvable random addresses are valid for these
		 * kind of reports and others can be ignored.
		 */
		if (!hci_bdaddr_is_rpa(direct_addr, direct_addr_type))
			return;

		/* If the controller is not using resolvable random
		 * addresses, then this report can be ignored.
		 */
5421
		if (!hci_dev_test_flag(hdev, HCI_PRIVACY))
5422 5423 5424 5425 5426 5427 5428 5429 5430 5431
			return;

		/* If the local IRK of the controller does not match
		 * with the resolvable random address provided, then
		 * this report can be ignored.
		 */
		if (!smp_irk_matches(hdev, hdev->irk, direct_addr))
			return;
	}

5432 5433 5434 5435 5436 5437 5438
	/* Check if we need to convert to identity address */
	irk = hci_get_irk(hdev, bdaddr, bdaddr_type);
	if (irk) {
		bdaddr = &irk->bdaddr;
		bdaddr_type = irk->addr_type;
	}

5439 5440 5441 5442 5443 5444 5445
	/* Check if we have been requested to connect to this device.
	 *
	 * direct_addr is set only for directed advertising reports (it is NULL
	 * for advertising reports) and is already verified to be RPA above.
	 */
	conn = check_pending_le_conn(hdev, bdaddr, bdaddr_type, type,
								direct_addr);
5446 5447 5448 5449 5450 5451 5452
	if (conn && type == LE_ADV_IND) {
		/* Store report for later inclusion by
		 * mgmt_device_connected
		 */
		memcpy(conn->le_adv_data, data, len);
		conn->le_adv_data_len = len;
	}
5453

5454 5455 5456 5457
	/* Passive scanning shouldn't trigger any device found events,
	 * except for devices marked as CONN_REPORT for which we do send
	 * device found events.
	 */
5458
	if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
5459 5460 5461
		if (type == LE_ADV_DIRECT_IND)
			return;

5462 5463
		if (!hci_pend_le_action_lookup(&hdev->pend_le_reports,
					       bdaddr, bdaddr_type))
5464 5465 5466 5467 5468 5469 5470 5471
			return;

		if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND)
			flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
		else
			flags = 0;
		mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
				  rssi, flags, data, len, NULL, 0);
5472
		return;
5473
	}
5474

5475 5476 5477 5478 5479 5480 5481 5482 5483 5484 5485 5486 5487 5488 5489 5490 5491 5492 5493 5494 5495
	/* When receiving non-connectable or scannable undirected
	 * advertising reports, this means that the remote device is
	 * not connectable and then clearly indicate this in the
	 * device found event.
	 *
	 * When receiving a scan response, then there is no way to
	 * know if the remote device is connectable or not. However
	 * since scan responses are merged with a previously seen
	 * advertising report, the flags field from that report
	 * will be used.
	 *
	 * In the really unlikely case that a controller get confused
	 * and just sends a scan response event, then it is marked as
	 * not connectable as well.
	 */
	if (type == LE_ADV_NONCONN_IND || type == LE_ADV_SCAN_IND ||
	    type == LE_ADV_SCAN_RSP)
		flags = MGMT_DEV_FOUND_NOT_CONNECTABLE;
	else
		flags = 0;

5496 5497 5498 5499 5500 5501 5502 5503 5504 5505
	/* If there's nothing pending either store the data from this
	 * event or send an immediate device found event if the data
	 * should not be stored for later.
	 */
	if (!has_pending_adv_report(hdev)) {
		/* If the report will trigger a SCAN_REQ store it for
		 * later merging.
		 */
		if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
			store_pending_adv_report(hdev, bdaddr, bdaddr_type,
5506
						 rssi, flags, data, len);
5507 5508 5509 5510
			return;
		}

		mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
5511
				  rssi, flags, data, len, NULL, 0);
5512 5513 5514
		return;
	}

5515 5516 5517 5518
	/* Check if the pending report is for the same device as the new one */
	match = (!bacmp(bdaddr, &d->last_adv_addr) &&
		 bdaddr_type == d->last_adv_addr_type);

5519 5520 5521 5522
	/* If the pending data doesn't match this report or this isn't a
	 * scan response (e.g. we got a duplicate ADV_IND) then force
	 * sending of the pending data.
	 */
5523 5524 5525 5526
	if (type != LE_ADV_SCAN_RSP || !match) {
		/* Send out whatever is in the cache, but skip duplicates */
		if (!match)
			mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
5527
					  d->last_adv_addr_type, NULL,
5528
					  d->last_adv_rssi, d->last_adv_flags,
5529
					  d->last_adv_data,
5530
					  d->last_adv_data_len, NULL, 0);
5531 5532 5533 5534 5535 5536

		/* If the new report will trigger a SCAN_REQ store it for
		 * later merging.
		 */
		if (type == LE_ADV_IND || type == LE_ADV_SCAN_IND) {
			store_pending_adv_report(hdev, bdaddr, bdaddr_type,
5537
						 rssi, flags, data, len);
5538 5539 5540 5541 5542 5543 5544
			return;
		}

		/* The advertising reports cannot be merged, so clear
		 * the pending report and send out a device found event.
		 */
		clear_pending_adv_report(hdev);
5545
		mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
5546
				  rssi, flags, data, len, NULL, 0);
5547 5548 5549 5550 5551 5552 5553 5554
		return;
	}

	/* If we get here we've got a pending ADV_IND or ADV_SCAN_IND and
	 * the new event is a SCAN_RSP. We can therefore proceed with
	 * sending a merged device found event.
	 */
	mgmt_device_found(hdev, &d->last_adv_addr, LE_LINK,
5555
			  d->last_adv_addr_type, NULL, rssi, d->last_adv_flags,
5556
			  d->last_adv_data, d->last_adv_data_len, data, len);
5557
	clear_pending_adv_report(hdev);
5558 5559
}

5560
static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
5561
{
5562 5563
	u8 num_reports = skb->data[0];
	void *ptr = &skb->data[1];
5564

5565 5566
	hci_dev_lock(hdev);

5567 5568
	while (num_reports--) {
		struct hci_ev_le_advertising_info *ev = ptr;
5569
		s8 rssi;
5570

5571 5572 5573 5574 5575 5576 5577 5578
		if (ev->length <= HCI_MAX_AD_LENGTH) {
			rssi = ev->data[ev->length];
			process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
					   ev->bdaddr_type, NULL, 0, rssi,
					   ev->data, ev->length);
		} else {
			bt_dev_err(hdev, "Dropping invalid advertising data");
		}
A
Andre Guedes 已提交
5579

5580
		ptr += sizeof(*ev) + ev->length + 1;
5581
	}
5582 5583

	hci_dev_unlock(hdev);
5584 5585
}

5586
static u8 ext_evt_type_to_legacy(struct hci_dev *hdev, u16 evt_type)
5587 5588 5589 5590 5591 5592 5593 5594 5595 5596 5597 5598 5599 5600 5601 5602
{
	if (evt_type & LE_EXT_ADV_LEGACY_PDU) {
		switch (evt_type) {
		case LE_LEGACY_ADV_IND:
			return LE_ADV_IND;
		case LE_LEGACY_ADV_DIRECT_IND:
			return LE_ADV_DIRECT_IND;
		case LE_LEGACY_ADV_SCAN_IND:
			return LE_ADV_SCAN_IND;
		case LE_LEGACY_NONCONN_IND:
			return LE_ADV_NONCONN_IND;
		case LE_LEGACY_SCAN_RSP_ADV:
		case LE_LEGACY_SCAN_RSP_ADV_SCAN:
			return LE_ADV_SCAN_RSP;
		}

5603
		goto invalid;
5604 5605 5606 5607 5608 5609
	}

	if (evt_type & LE_EXT_ADV_CONN_IND) {
		if (evt_type & LE_EXT_ADV_DIRECT_IND)
			return LE_ADV_DIRECT_IND;

5610
		return LE_ADV_IND;
5611 5612 5613 5614 5615 5616
	}

	if (evt_type & LE_EXT_ADV_SCAN_RSP)
		return LE_ADV_SCAN_RSP;

	if (evt_type & LE_EXT_ADV_SCAN_IND)
5617
		return LE_ADV_SCAN_IND;
5618 5619 5620

	if (evt_type == LE_EXT_ADV_NON_CONN_IND ||
	    evt_type & LE_EXT_ADV_DIRECT_IND)
5621 5622
		return LE_ADV_NONCONN_IND;

5623 5624 5625
invalid:
	bt_dev_err_ratelimited(hdev, "Unknown advertising packet type: 0x%02x",
			       evt_type);
5626 5627 5628 5629 5630 5631 5632 5633 5634 5635 5636 5637 5638 5639 5640 5641 5642

	return LE_ADV_INVALID;
}

static void hci_le_ext_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	u8 num_reports = skb->data[0];
	void *ptr = &skb->data[1];

	hci_dev_lock(hdev);

	while (num_reports--) {
		struct hci_ev_le_ext_adv_report *ev = ptr;
		u8 legacy_evt_type;
		u16 evt_type;

		evt_type = __le16_to_cpu(ev->evt_type);
5643
		legacy_evt_type = ext_evt_type_to_legacy(hdev, evt_type);
5644 5645 5646 5647 5648 5649
		if (legacy_evt_type != LE_ADV_INVALID) {
			process_adv_report(hdev, legacy_evt_type, &ev->bdaddr,
					   ev->bdaddr_type, NULL, 0, ev->rssi,
					   ev->data, ev->length);
		}

5650
		ptr += sizeof(*ev) + ev->length;
5651 5652 5653 5654 5655
	}

	hci_dev_unlock(hdev);
}

5656 5657 5658 5659 5660 5661 5662 5663 5664 5665 5666 5667 5668 5669 5670 5671 5672 5673 5674 5675 5676 5677 5678 5679 5680 5681 5682 5683 5684 5685 5686 5687 5688 5689 5690 5691 5692 5693 5694 5695 5696 5697
static void hci_le_remote_feat_complete_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
{
	struct hci_ev_le_remote_feat_complete *ev = (void *)skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
	if (conn) {
		if (!ev->status)
			memcpy(conn->features[0], ev->features, 8);

		if (conn->state == BT_CONFIG) {
			__u8 status;

			/* If the local controller supports slave-initiated
			 * features exchange, but the remote controller does
			 * not, then it is possible that the error code 0x1a
			 * for unsupported remote feature gets returned.
			 *
			 * In this specific case, allow the connection to
			 * transition into connected state and mark it as
			 * successful.
			 */
			if ((hdev->le_features[0] & HCI_LE_SLAVE_FEATURES) &&
			    !conn->out && ev->status == 0x1a)
				status = 0x00;
			else
				status = ev->status;

			conn->state = BT_CONNECTED;
			hci_connect_cfm(conn, status);
			hci_conn_drop(conn);
		}
	}

	hci_dev_unlock(hdev);
}

5698
static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
5699 5700 5701
{
	struct hci_ev_le_ltk_req *ev = (void *) skb->data;
	struct hci_cp_le_ltk_reply cp;
5702
	struct hci_cp_le_ltk_neg_reply neg;
5703
	struct hci_conn *conn;
5704
	struct smp_ltk *ltk;
5705

5706
	BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
5707 5708 5709 5710

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
5711 5712
	if (conn == NULL)
		goto not_found;
5713

5714
	ltk = hci_find_ltk(hdev, &conn->dst, conn->dst_type, conn->role);
5715
	if (!ltk)
5716 5717
		goto not_found;

5718 5719 5720 5721 5722 5723 5724 5725 5726 5727
	if (smp_ltk_is_sc(ltk)) {
		/* With SC both EDiv and Rand are set to zero */
		if (ev->ediv || ev->rand)
			goto not_found;
	} else {
		/* For non-SC keys check that EDiv and Rand match */
		if (ev->ediv != ltk->ediv || ev->rand != ltk->rand)
			goto not_found;
	}

5728 5729
	memcpy(cp.ltk, ltk->val, ltk->enc_size);
	memset(cp.ltk + ltk->enc_size, 0, sizeof(cp.ltk) - ltk->enc_size);
5730
	cp.handle = cpu_to_le16(conn->handle);
5731

5732
	conn->pending_sec_level = smp_ltk_sec_level(ltk);
5733

5734
	conn->enc_key_size = ltk->enc_size;
5735 5736 5737

	hci_send_cmd(hdev, HCI_OP_LE_LTK_REPLY, sizeof(cp), &cp);

5738 5739 5740 5741 5742 5743
	/* Ref. Bluetooth Core SPEC pages 1975 and 2004. STK is a
	 * temporary key used to encrypt a connection following
	 * pairing. It is used during the Encrypted Session Setup to
	 * distribute the keys. Later, security can be re-established
	 * using a distributed LTK.
	 */
5744
	if (ltk->type == SMP_STK) {
5745
		set_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
J
Johan Hedberg 已提交
5746 5747
		list_del_rcu(&ltk->list);
		kfree_rcu(ltk, rcu);
5748 5749
	} else {
		clear_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
5750 5751
	}

5752
	hci_dev_unlock(hdev);
5753 5754 5755 5756 5757 5758 5759

	return;

not_found:
	neg.handle = ev->handle;
	hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
	hci_dev_unlock(hdev);
5760 5761
}

5762 5763 5764 5765 5766 5767 5768 5769 5770 5771 5772 5773 5774 5775 5776 5777 5778 5779 5780 5781 5782 5783 5784 5785 5786 5787 5788 5789 5790 5791 5792 5793 5794 5795 5796
static void send_conn_param_neg_reply(struct hci_dev *hdev, u16 handle,
				      u8 reason)
{
	struct hci_cp_le_conn_param_req_neg_reply cp;

	cp.handle = cpu_to_le16(handle);
	cp.reason = reason;

	hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_NEG_REPLY, sizeof(cp),
		     &cp);
}

static void hci_le_remote_conn_param_req_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
{
	struct hci_ev_le_remote_conn_param_req *ev = (void *) skb->data;
	struct hci_cp_le_conn_param_req_reply cp;
	struct hci_conn *hcon;
	u16 handle, min, max, latency, timeout;

	handle = le16_to_cpu(ev->handle);
	min = le16_to_cpu(ev->interval_min);
	max = le16_to_cpu(ev->interval_max);
	latency = le16_to_cpu(ev->latency);
	timeout = le16_to_cpu(ev->timeout);

	hcon = hci_conn_hash_lookup_handle(hdev, handle);
	if (!hcon || hcon->state != BT_CONNECTED)
		return send_conn_param_neg_reply(hdev, handle,
						 HCI_ERROR_UNKNOWN_CONN_ID);

	if (hci_check_conn_params(min, max, latency, timeout))
		return send_conn_param_neg_reply(hdev, handle,
						 HCI_ERROR_INVALID_LL_PARAMS);

5797
	if (hcon->role == HCI_ROLE_MASTER) {
5798
		struct hci_conn_params *params;
5799
		u8 store_hint;
5800 5801 5802 5803 5804 5805 5806 5807 5808 5809

		hci_dev_lock(hdev);

		params = hci_conn_params_lookup(hdev, &hcon->dst,
						hcon->dst_type);
		if (params) {
			params->conn_min_interval = min;
			params->conn_max_interval = max;
			params->conn_latency = latency;
			params->supervision_timeout = timeout;
5810 5811 5812
			store_hint = 0x01;
		} else{
			store_hint = 0x00;
5813 5814 5815 5816
		}

		hci_dev_unlock(hdev);

5817 5818
		mgmt_new_conn_param(hdev, &hcon->dst, hcon->dst_type,
				    store_hint, min, max, latency, timeout);
5819
	}
5820

5821 5822 5823 5824 5825 5826 5827 5828 5829 5830 5831
	cp.handle = ev->handle;
	cp.interval_min = ev->interval_min;
	cp.interval_max = ev->interval_max;
	cp.latency = ev->latency;
	cp.timeout = ev->timeout;
	cp.min_ce_len = 0;
	cp.max_ce_len = 0;

	hci_send_cmd(hdev, HCI_OP_LE_CONN_PARAM_REQ_REPLY, sizeof(cp), &cp);
}

5832 5833 5834 5835 5836 5837 5838 5839 5840 5841 5842 5843 5844 5845 5846 5847 5848 5849 5850 5851 5852
static void hci_le_direct_adv_report_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	u8 num_reports = skb->data[0];
	void *ptr = &skb->data[1];

	hci_dev_lock(hdev);

	while (num_reports--) {
		struct hci_ev_le_direct_adv_info *ev = ptr;

		process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
				   ev->bdaddr_type, &ev->direct_addr,
				   ev->direct_addr_type, ev->rssi, NULL, 0);

		ptr += sizeof(*ev);
	}

	hci_dev_unlock(hdev);
}

5853 5854 5855 5856 5857 5858 5859 5860 5861 5862 5863 5864 5865 5866 5867 5868 5869 5870 5871 5872 5873 5874 5875
static void hci_le_phy_update_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_le_phy_update_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);

	if (!ev->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
	if (!conn)
		goto unlock;

	conn->le_tx_phy = ev->tx_phy;
	conn->le_rx_phy = ev->rx_phy;

unlock:
	hci_dev_unlock(hdev);
}

5876
static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
V
Ville Tervo 已提交
5877 5878 5879 5880 5881 5882 5883 5884 5885 5886
{
	struct hci_ev_le_meta *le_ev = (void *) skb->data;

	skb_pull(skb, sizeof(*le_ev));

	switch (le_ev->subevent) {
	case HCI_EV_LE_CONN_COMPLETE:
		hci_le_conn_complete_evt(hdev, skb);
		break;

5887 5888 5889 5890
	case HCI_EV_LE_CONN_UPDATE_COMPLETE:
		hci_le_conn_update_complete_evt(hdev, skb);
		break;

5891 5892 5893 5894
	case HCI_EV_LE_ADVERTISING_REPORT:
		hci_le_adv_report_evt(hdev, skb);
		break;

5895 5896 5897 5898
	case HCI_EV_LE_REMOTE_FEAT_COMPLETE:
		hci_le_remote_feat_complete_evt(hdev, skb);
		break;

5899 5900 5901 5902
	case HCI_EV_LE_LTK_REQ:
		hci_le_ltk_request_evt(hdev, skb);
		break;

5903 5904 5905 5906
	case HCI_EV_LE_REMOTE_CONN_PARAM_REQ:
		hci_le_remote_conn_param_req_evt(hdev, skb);
		break;

5907 5908 5909 5910
	case HCI_EV_LE_DIRECT_ADV_REPORT:
		hci_le_direct_adv_report_evt(hdev, skb);
		break;

5911 5912 5913 5914
	case HCI_EV_LE_PHY_UPDATE_COMPLETE:
		hci_le_phy_update_evt(hdev, skb);
		break;

5915 5916 5917 5918
	case HCI_EV_LE_EXT_ADV_REPORT:
		hci_le_ext_adv_report_evt(hdev, skb);
		break;

5919 5920 5921 5922
	case HCI_EV_LE_ENHANCED_CONN_COMPLETE:
		hci_le_enh_conn_complete_evt(hdev, skb);
		break;

5923 5924 5925 5926
	case HCI_EV_LE_EXT_ADV_SET_TERM:
		hci_le_ext_adv_term_evt(hdev, skb);
		break;

V
Ville Tervo 已提交
5927 5928 5929 5930 5931
	default:
		break;
	}
}

5932 5933 5934 5935 5936 5937 5938 5939 5940 5941
static bool hci_get_cmd_complete(struct hci_dev *hdev, u16 opcode,
				 u8 event, struct sk_buff *skb)
{
	struct hci_ev_cmd_complete *ev;
	struct hci_event_hdr *hdr;

	if (!skb)
		return false;

	if (skb->len < sizeof(*hdr)) {
5942
		bt_dev_err(hdev, "too short HCI event");
5943 5944 5945 5946 5947 5948 5949 5950 5951 5952 5953 5954
		return false;
	}

	hdr = (void *) skb->data;
	skb_pull(skb, HCI_EVENT_HDR_SIZE);

	if (event) {
		if (hdr->evt != event)
			return false;
		return true;
	}

5955 5956 5957 5958 5959 5960
	/* Check if request ended in Command Status - no way to retreive
	 * any extra parameters in this case.
	 */
	if (hdr->evt == HCI_EV_CMD_STATUS)
		return false;

5961
	if (hdr->evt != HCI_EV_CMD_COMPLETE) {
5962 5963
		bt_dev_err(hdev, "last event is not cmd complete (0x%2.2x)",
			   hdr->evt);
5964 5965 5966 5967
		return false;
	}

	if (skb->len < sizeof(*ev)) {
5968
		bt_dev_err(hdev, "too short cmd_complete event");
5969 5970 5971 5972 5973 5974 5975 5976 5977 5978 5979 5980 5981 5982 5983
		return false;
	}

	ev = (void *) skb->data;
	skb_pull(skb, sizeof(*ev));

	if (opcode != __le16_to_cpu(ev->opcode)) {
		BT_DBG("opcode doesn't match (0x%2.2x != 0x%2.2x)", opcode,
		       __le16_to_cpu(ev->opcode));
		return false;
	}

	return true;
}

5984 5985 5986
void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_event_hdr *hdr = (void *) skb->data;
5987 5988 5989
	hci_req_complete_t req_complete = NULL;
	hci_req_complete_skb_t req_complete_skb = NULL;
	struct sk_buff *orig_skb = NULL;
5990
	u8 status = 0, event = hdr->evt, req_evt = 0;
5991
	u16 opcode = HCI_OP_NOP;
5992

5993 5994 5995 5996 5997
	if (!event) {
		bt_dev_warn(hdev, "Received unexpected HCI Event 00000000");
		goto done;
	}

5998
	if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->hci.req_event == event) {
5999
		struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
6000 6001 6002
		opcode = __le16_to_cpu(cmd_hdr->opcode);
		hci_req_cmd_complete(hdev, opcode, status, &req_complete,
				     &req_complete_skb);
6003
		req_evt = event;
6004 6005
	}

6006 6007 6008 6009 6010 6011 6012 6013 6014 6015 6016
	/* If it looks like we might end up having to call
	 * req_complete_skb, store a pristine copy of the skb since the
	 * various handlers may modify the original one through
	 * skb_pull() calls, etc.
	 */
	if (req_complete_skb || event == HCI_EV_CMD_STATUS ||
	    event == HCI_EV_CMD_COMPLETE)
		orig_skb = skb_clone(skb, GFP_KERNEL);

	skb_pull(skb, HCI_EVENT_HDR_SIZE);

6017
	switch (event) {
L
Linus Torvalds 已提交
6018 6019 6020 6021 6022 6023 6024 6025
	case HCI_EV_INQUIRY_COMPLETE:
		hci_inquiry_complete_evt(hdev, skb);
		break;

	case HCI_EV_INQUIRY_RESULT:
		hci_inquiry_result_evt(hdev, skb);
		break;

6026 6027
	case HCI_EV_CONN_COMPLETE:
		hci_conn_complete_evt(hdev, skb);
6028 6029
		break;

L
Linus Torvalds 已提交
6030 6031 6032 6033 6034 6035 6036 6037 6038 6039 6040 6041
	case HCI_EV_CONN_REQUEST:
		hci_conn_request_evt(hdev, skb);
		break;

	case HCI_EV_DISCONN_COMPLETE:
		hci_disconn_complete_evt(hdev, skb);
		break;

	case HCI_EV_AUTH_COMPLETE:
		hci_auth_complete_evt(hdev, skb);
		break;

6042 6043 6044 6045
	case HCI_EV_REMOTE_NAME:
		hci_remote_name_evt(hdev, skb);
		break;

L
Linus Torvalds 已提交
6046 6047 6048 6049
	case HCI_EV_ENCRYPT_CHANGE:
		hci_encrypt_change_evt(hdev, skb);
		break;

6050 6051 6052 6053 6054 6055 6056 6057 6058
	case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
		hci_change_link_key_complete_evt(hdev, skb);
		break;

	case HCI_EV_REMOTE_FEATURES:
		hci_remote_features_evt(hdev, skb);
		break;

	case HCI_EV_CMD_COMPLETE:
6059 6060
		hci_cmd_complete_evt(hdev, skb, &opcode, &status,
				     &req_complete, &req_complete_skb);
6061 6062 6063
		break;

	case HCI_EV_CMD_STATUS:
6064 6065
		hci_cmd_status_evt(hdev, skb, &opcode, &status, &req_complete,
				   &req_complete_skb);
6066 6067
		break;

6068 6069 6070 6071
	case HCI_EV_HARDWARE_ERROR:
		hci_hardware_error_evt(hdev, skb);
		break;

6072 6073 6074 6075 6076 6077 6078 6079 6080 6081
	case HCI_EV_ROLE_CHANGE:
		hci_role_change_evt(hdev, skb);
		break;

	case HCI_EV_NUM_COMP_PKTS:
		hci_num_comp_pkts_evt(hdev, skb);
		break;

	case HCI_EV_MODE_CHANGE:
		hci_mode_change_evt(hdev, skb);
L
Linus Torvalds 已提交
6082 6083 6084 6085 6086 6087 6088 6089 6090 6091 6092 6093 6094 6095 6096 6097 6098 6099
		break;

	case HCI_EV_PIN_CODE_REQ:
		hci_pin_code_request_evt(hdev, skb);
		break;

	case HCI_EV_LINK_KEY_REQ:
		hci_link_key_request_evt(hdev, skb);
		break;

	case HCI_EV_LINK_KEY_NOTIFY:
		hci_link_key_notify_evt(hdev, skb);
		break;

	case HCI_EV_CLOCK_OFFSET:
		hci_clock_offset_evt(hdev, skb);
		break;

6100 6101 6102 6103
	case HCI_EV_PKT_TYPE_CHANGE:
		hci_pkt_type_change_evt(hdev, skb);
		break;

6104 6105 6106 6107
	case HCI_EV_PSCAN_REP_MODE:
		hci_pscan_rep_mode_evt(hdev, skb);
		break;

6108 6109
	case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
		hci_inquiry_result_with_rssi_evt(hdev, skb);
6110 6111
		break;

6112 6113
	case HCI_EV_REMOTE_EXT_FEATURES:
		hci_remote_ext_features_evt(hdev, skb);
L
Linus Torvalds 已提交
6114 6115
		break;

6116 6117 6118
	case HCI_EV_SYNC_CONN_COMPLETE:
		hci_sync_conn_complete_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
6119

6120 6121 6122
	case HCI_EV_EXTENDED_INQUIRY_RESULT:
		hci_extended_inquiry_result_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
6123

6124 6125 6126 6127
	case HCI_EV_KEY_REFRESH_COMPLETE:
		hci_key_refresh_complete_evt(hdev, skb);
		break;

6128 6129 6130 6131
	case HCI_EV_IO_CAPA_REQUEST:
		hci_io_capa_request_evt(hdev, skb);
		break;

6132 6133 6134 6135
	case HCI_EV_IO_CAPA_REPLY:
		hci_io_capa_reply_evt(hdev, skb);
		break;

6136 6137 6138 6139
	case HCI_EV_USER_CONFIRM_REQUEST:
		hci_user_confirm_request_evt(hdev, skb);
		break;

6140 6141 6142 6143
	case HCI_EV_USER_PASSKEY_REQUEST:
		hci_user_passkey_request_evt(hdev, skb);
		break;

6144 6145 6146 6147 6148 6149 6150 6151
	case HCI_EV_USER_PASSKEY_NOTIFY:
		hci_user_passkey_notify_evt(hdev, skb);
		break;

	case HCI_EV_KEYPRESS_NOTIFY:
		hci_keypress_notify_evt(hdev, skb);
		break;

6152 6153 6154 6155
	case HCI_EV_SIMPLE_PAIR_COMPLETE:
		hci_simple_pair_complete_evt(hdev, skb);
		break;

6156 6157 6158 6159
	case HCI_EV_REMOTE_HOST_FEATURES:
		hci_remote_host_features_evt(hdev, skb);
		break;

V
Ville Tervo 已提交
6160 6161 6162 6163
	case HCI_EV_LE_META:
		hci_le_meta_evt(hdev, skb);
		break;

6164 6165 6166 6167
	case HCI_EV_REMOTE_OOB_DATA_REQUEST:
		hci_remote_oob_data_request_evt(hdev, skb);
		break;

6168 6169 6170 6171 6172
#if IS_ENABLED(CONFIG_BT_HS)
	case HCI_EV_CHANNEL_SELECTED:
		hci_chan_selected_evt(hdev, skb);
		break;

6173 6174 6175 6176
	case HCI_EV_PHY_LINK_COMPLETE:
		hci_phy_link_complete_evt(hdev, skb);
		break;

6177 6178 6179 6180
	case HCI_EV_LOGICAL_LINK_COMPLETE:
		hci_loglink_complete_evt(hdev, skb);
		break;

6181 6182 6183 6184
	case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
		hci_disconn_loglink_complete_evt(hdev, skb);
		break;

6185 6186 6187
	case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
		hci_disconn_phylink_complete_evt(hdev, skb);
		break;
6188
#endif
6189

6190 6191 6192 6193
	case HCI_EV_NUM_COMP_BLOCKS:
		hci_num_comp_blocks_evt(hdev, skb);
		break;

6194 6195 6196 6197
	case HCI_EV_VENDOR:
		msft_vendor_evt(hdev, skb);
		break;

6198
	default:
6199
		BT_DBG("%s event 0x%2.2x", hdev->name, event);
L
Linus Torvalds 已提交
6200 6201 6202
		break;
	}

6203
	if (req_complete) {
6204
		req_complete(hdev, status, opcode);
6205 6206 6207 6208 6209
	} else if (req_complete_skb) {
		if (!hci_get_cmd_complete(hdev, opcode, req_evt, orig_skb)) {
			kfree_skb(orig_skb);
			orig_skb = NULL;
		}
6210
		req_complete_skb(hdev, status, opcode, orig_skb);
6211
	}
6212

6213
done:
6214
	kfree_skb(orig_skb);
L
Linus Torvalds 已提交
6215 6216 6217
	kfree_skb(skb);
	hdev->stat.evt_rx++;
}