hci_event.c 157.1 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"
39
#include "eir.h"
L
Linus Torvalds 已提交
40

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

44 45
#define secs_to_jiffies(_secs) msecs_to_jiffies((_secs) * 1000)

L
Linus Torvalds 已提交
46 47
/* Handle HCI Event packets */

48 49
static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb,
				  u8 *new_status)
L
Linus Torvalds 已提交
50
{
51
	__u8 status = *((__u8 *) skb->data);
L
Linus Torvalds 已提交
52

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

55 56 57 58 59 60 61 62 63 64 65 66 67 68
	/* It is possible that we receive Inquiry Complete event right
	 * before we receive Inquiry Cancel Command Complete event, in
	 * which case the latter event should have status of Command
	 * Disallowed (0x0c). This should not be treated as error, since
	 * we actually achieve what Inquiry Cancel wants to achieve,
	 * which is to end the last Inquiry session.
	 */
	if (status == 0x0c && !test_bit(HCI_INQUIRY, &hdev->flags)) {
		bt_dev_warn(hdev, "Ignoring error of Inquiry Cancel command");
		status = 0x00;
	}

	*new_status = status;

69
	if (status)
70
		return;
L
Linus Torvalds 已提交
71

72
	clear_bit(HCI_INQUIRY, &hdev->flags);
73
	smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
74
	wake_up_bit(&hdev->flags, HCI_INQUIRY);
75

76
	hci_dev_lock(hdev);
77 78 79 80 81 82
	/* 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);
83 84
	hci_dev_unlock(hdev);

85 86
	hci_conn_check_pending(hdev);
}
87

88 89 90 91
static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

92
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
93 94 95 96

	if (status)
		return;

97
	hci_dev_set_flag(hdev, HCI_PERIODIC_INQ);
98 99
}

100 101 102
static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
103

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

106 107
	if (status)
		return;
L
Linus Torvalds 已提交
108

109
	hci_dev_clear_flag(hdev, HCI_PERIODIC_INQ);
110

111 112 113
	hci_conn_check_pending(hdev);
}

114 115
static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
					  struct sk_buff *skb)
116 117 118 119 120 121 122 123 124
{
	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;

125
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
126 127 128 129 130 131 132

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
133 134
	if (conn)
		conn->role = rp->role;
135 136

	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
137 138
}

139 140 141 142 143
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;

144
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
145 146 147 148 149 150 151 152 153 154 155 156 157

	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);
}

158
static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
159
{
160
	struct hci_rp_write_link_policy *rp = (void *) skb->data;
L
Linus Torvalds 已提交
161
	struct hci_conn *conn;
162
	void *sent;
L
Linus Torvalds 已提交
163

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

166 167
	if (rp->status)
		return;
L
Linus Torvalds 已提交
168

169 170 171
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
	if (!sent)
		return;
L
Linus Torvalds 已提交
172

173
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
174

175
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
176
	if (conn)
177
		conn->link_policy = get_unaligned_le16(sent + 2);
L
Linus Torvalds 已提交
178

179 180
	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
181

182 183
static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
					struct sk_buff *skb)
184 185 186
{
	struct hci_rp_read_def_link_policy *rp = (void *) skb->data;

187
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
188 189 190 191 192 193 194

	if (rp->status)
		return;

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

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

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

203 204 205
	if (status)
		return;

206 207 208 209
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
	if (!sent)
		return;

210
	hdev->link_policy = get_unaligned_le16(sent);
211 212
}

213 214 215
static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
216

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

219 220
	clear_bit(HCI_RESET, &hdev->flags);

221 222 223
	if (status)
		return;

224
	/* Reset all non-persistent flags */
225
	hci_dev_clear_volatile_flags(hdev);
226

227 228
	hci_discovery_set_state(hdev, DISCOVERY_STOPPED);

229 230
	hdev->inq_tx_power = HCI_TX_POWER_INVALID;
	hdev->adv_tx_power = HCI_TX_POWER_INVALID;
231 232 233

	memset(hdev->adv_data, 0, sizeof(hdev->adv_data));
	hdev->adv_data_len = 0;
234 235 236

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

238 239
	hdev->le_scan_type = LE_SCAN_PASSIVE;

240
	hdev->ssp_debug_mode = 0;
241

242
	hci_bdaddr_list_clear(&hdev->le_accept_list);
A
Ankit Navik 已提交
243
	hci_bdaddr_list_clear(&hdev->le_resolv_list);
244
}
245

246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263
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;
	}
}

264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279
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;
}

280 281 282 283
static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;
284

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

287 288 289
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
	if (!sent)
		return;
290

291 292
	hci_dev_lock(hdev);

293
	if (hci_dev_test_flag(hdev, HCI_MGMT))
294
		mgmt_set_local_name_complete(hdev, sent, status);
295 296
	else if (!status)
		memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
297

298
	hci_dev_unlock(hdev);
299 300 301 302 303 304
}

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;

305
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
306 307 308 309

	if (rp->status)
		return;

310 311
	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG))
312
		memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
313 314 315 316 317 318 319
}

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

320
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
321 322 323 324 325

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

326 327
	hci_dev_lock(hdev);

328 329 330 331 332 333 334
	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 已提交
335
	}
336

337
	if (hci_dev_test_flag(hdev, HCI_MGMT))
338
		mgmt_auth_enable_complete(hdev, status);
339 340

	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
341 342
}

343
static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
344
{
345
	__u8 status = *((__u8 *) skb->data);
346
	__u8 param;
L
Linus Torvalds 已提交
347 348
	void *sent;

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

351 352 353
	if (status)
		return;

354 355 356
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
	if (!sent)
		return;
L
Linus Torvalds 已提交
357

358
	param = *((__u8 *) sent);
359

360 361 362 363
	if (param)
		set_bit(HCI_ENCRYPT, &hdev->flags);
	else
		clear_bit(HCI_ENCRYPT, &hdev->flags);
364
}
L
Linus Torvalds 已提交
365

366 367
static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
{
368 369
	__u8 status = *((__u8 *) skb->data);
	__u8 param;
370
	void *sent;
L
Linus Torvalds 已提交
371

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

374 375 376
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
	if (!sent)
		return;
L
Linus Torvalds 已提交
377

378 379
	param = *((__u8 *) sent);

380 381
	hci_dev_lock(hdev);

382
	if (status) {
383 384 385 386
		hdev->discov_timeout = 0;
		goto done;
	}

387
	if (param & SCAN_INQUIRY)
388
		set_bit(HCI_ISCAN, &hdev->flags);
389 390
	else
		clear_bit(HCI_ISCAN, &hdev->flags);
391

392
	if (param & SCAN_PAGE)
393
		set_bit(HCI_PSCAN, &hdev->flags);
394
	else
395
		clear_bit(HCI_PSCAN, &hdev->flags);
L
Linus Torvalds 已提交
396

397
done:
398
	hci_dev_unlock(hdev);
399
}
L
Linus Torvalds 已提交
400

401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423
static void hci_cc_set_event_filter(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *)skb->data);
	struct hci_cp_set_event_filter *cp;
	void *sent;

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

	if (status)
		return;

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

	cp = (struct hci_cp_set_event_filter *)sent;

	if (cp->flt_type == HCI_FLT_CLEAR_ALL)
		hci_dev_clear_flag(hdev, HCI_EVENT_FILTER_CONFIGURED);
	else
		hci_dev_set_flag(hdev, HCI_EVENT_FILTER_CONFIGURED);
}

424 425 426
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 已提交
427

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

430 431
	if (rp->status)
		return;
L
Linus Torvalds 已提交
432

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

435
	BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
436
	       hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
437
}
L
Linus Torvalds 已提交
438

439 440 441 442
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 已提交
443

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

446 447 448
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
	if (!sent)
		return;
L
Linus Torvalds 已提交
449

450 451 452 453 454
	hci_dev_lock(hdev);

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

455
	if (hci_dev_test_flag(hdev, HCI_MGMT))
456 457 458
		mgmt_set_class_of_dev_complete(hdev, sent, status);

	hci_dev_unlock(hdev);
459
}
L
Linus Torvalds 已提交
460

461 462 463 464 465
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;

466
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
467 468 469 470 471 472

	if (rp->status)
		return;

	setting = __le16_to_cpu(rp->voice_setting);

473
	if (hdev->voice_setting == setting)
474 475 476 477
		return;

	hdev->voice_setting = setting;

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

480
	if (hdev->notify)
481 482 483
		hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
}

484 485
static void hci_cc_write_voice_setting(struct hci_dev *hdev,
				       struct sk_buff *skb)
486 487
{
	__u8 status = *((__u8 *) skb->data);
488
	__u16 setting;
489 490
	void *sent;

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

493 494 495
	if (status)
		return;

496 497 498
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
	if (!sent)
		return;
L
Linus Torvalds 已提交
499

500
	setting = get_unaligned_le16(sent);
L
Linus Torvalds 已提交
501

502 503 504 505
	if (hdev->voice_setting == setting)
		return;

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

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

509
	if (hdev->notify)
510
		hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
L
Linus Torvalds 已提交
511 512
}

513 514 515 516 517 518 519 520 521 522 523 524 525 526 527
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);
}

528 529 530
static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
531
	struct hci_cp_write_ssp_mode *sent;
532

533
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
534 535 536 537 538

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

539 540
	hci_dev_lock(hdev);

541 542
	if (!status) {
		if (sent->mode)
543
			hdev->features[1][0] |= LMP_HOST_SSP;
544
		else
545
			hdev->features[1][0] &= ~LMP_HOST_SSP;
546 547
	}

548
	if (hci_dev_test_flag(hdev, HCI_MGMT))
549
		mgmt_ssp_enable_complete(hdev, sent->mode, status);
550
	else if (!status) {
551
		if (sent->mode)
552
			hci_dev_set_flag(hdev, HCI_SSP_ENABLED);
553
		else
554
			hci_dev_clear_flag(hdev, HCI_SSP_ENABLED);
555
	}
556 557

	hci_dev_unlock(hdev);
558 559
}

560 561 562 563 564 565 566 567 568 569 570
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;

571 572
	hci_dev_lock(hdev);

573 574 575 576 577 578 579
	if (!status) {
		if (sent->support)
			hdev->features[1][0] |= LMP_HOST_SC;
		else
			hdev->features[1][0] &= ~LMP_HOST_SC;
	}

580
	if (!hci_dev_test_flag(hdev, HCI_MGMT) && !status) {
581
		if (sent->support)
582
			hci_dev_set_flag(hdev, HCI_SC_ENABLED);
583
		else
584
			hci_dev_clear_flag(hdev, HCI_SC_ENABLED);
585
	}
586 587

	hci_dev_unlock(hdev);
588 589
}

590 591 592
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;
593

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

596
	if (rp->status)
597
		return;
598

599 600
	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG)) {
601 602 603 604 605 606
		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);
	}
607 608
}

609 610
static void hci_cc_read_local_commands(struct hci_dev *hdev,
				       struct sk_buff *skb)
611 612
{
	struct hci_rp_read_local_commands *rp = (void *) skb->data;
L
Linus Torvalds 已提交
613

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

616 617 618
	if (rp->status)
		return;

619 620
	if (hci_dev_test_flag(hdev, HCI_SETUP) ||
	    hci_dev_test_flag(hdev, HCI_CONFIG))
621
		memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
622
}
L
Linus Torvalds 已提交
623

624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668
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);
}

669 670
static void hci_cc_read_local_features(struct hci_dev *hdev,
				       struct sk_buff *skb)
671 672
{
	struct hci_rp_read_local_features *rp = (void *) skb->data;
673

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

676 677
	if (rp->status)
		return;
678

679
	memcpy(hdev->features, rp->features, 8);
680

681 682
	/* Adjust default settings according to features
	 * supported by device. */
L
Linus Torvalds 已提交
683

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

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

690
	if (hdev->features[0][1] & LMP_HV2) {
691 692 693
		hdev->pkt_type  |= (HCI_HV2);
		hdev->esco_type |= (ESCO_HV2);
	}
L
Linus Torvalds 已提交
694

695
	if (hdev->features[0][1] & LMP_HV3) {
696 697 698
		hdev->pkt_type  |= (HCI_HV3);
		hdev->esco_type |= (ESCO_HV3);
	}
L
Linus Torvalds 已提交
699

700
	if (lmp_esco_capable(hdev))
701
		hdev->esco_type |= (ESCO_EV3);
702

703
	if (hdev->features[0][4] & LMP_EV4)
704
		hdev->esco_type |= (ESCO_EV4);
705

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

709
	if (hdev->features[0][5] & LMP_EDR_ESCO_2M)
710 711
		hdev->esco_type |= (ESCO_2EV3);

712
	if (hdev->features[0][5] & LMP_EDR_ESCO_3M)
713 714
		hdev->esco_type |= (ESCO_3EV3);

715
	if (hdev->features[0][5] & LMP_EDR_3S_ESCO)
716
		hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
717
}
L
Linus Torvalds 已提交
718

719
static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
720
					   struct sk_buff *skb)
721 722 723
{
	struct hci_rp_read_local_ext_features *rp = (void *) skb->data;

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

	if (rp->status)
727
		return;
728

729 730
	if (hdev->max_page < rp->max_page)
		hdev->max_page = rp->max_page;
731

732 733
	if (rp->page < HCI_MAX_PAGES)
		memcpy(hdev->features[rp->page], rp->features, 8);
734 735
}

736
static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
737
					  struct sk_buff *skb)
738 739 740
{
	struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;

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

743 744 745 746
	if (rp->status)
		return;

	hdev->flow_ctl_mode = rp->mode;
747 748
}

749 750 751
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 已提交
752

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

755 756
	if (rp->status)
		return;
L
Linus Torvalds 已提交
757

758 759 760 761 762 763 764 765
	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 已提交
766
	}
767 768 769 770

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

771 772
	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);
773 774 775 776 777 778
}

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;

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

781 782 783 784
	if (rp->status)
		return;

	if (test_bit(HCI_INIT, &hdev->flags))
785
		bacpy(&hdev->bdaddr, &rp->bdaddr);
786

787
	if (hci_dev_test_flag(hdev, HCI_SETUP))
788
		bacpy(&hdev->setup_addr, &rp->bdaddr);
789 790
}

791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807
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;
	}
}

808 809 810 811 812 813 814
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);

815 816 817 818
	if (rp->status)
		return;

	if (test_bit(HCI_INIT, &hdev->flags)) {
819 820 821 822 823
		hdev->page_scan_interval = __le16_to_cpu(rp->interval);
		hdev->page_scan_window = __le16_to_cpu(rp->window);
	}
}

824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842
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);
}

843 844 845 846 847 848 849
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);

850 851 852 853
	if (rp->status)
		return;

	if (test_bit(HCI_INIT, &hdev->flags))
854 855 856
		hdev->page_scan_type = rp->type;
}

857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872
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;
}

873
static void hci_cc_read_data_block_size(struct hci_dev *hdev,
874
					struct sk_buff *skb)
875 876 877
{
	struct hci_rp_read_data_block_size *rp = (void *) skb->data;

878
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
879 880 881 882 883 884 885 886 887 888 889

	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,
890
	       hdev->block_cnt, hdev->block_len);
891 892
}

893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927
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);
}

928
static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
929
				       struct sk_buff *skb)
930 931 932
{
	struct hci_rp_read_local_amp_info *rp = (void *) skb->data;

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

	if (rp->status)
936
		return;
937 938 939 940 941 942 943 944 945 946 947 948 949

	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);
}

950
static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
951
					 struct sk_buff *skb)
952
{
953
	struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
954

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

957 958 959 960
	if (rp->status)
		return;

	hdev->inq_tx_power = rp->tx_power;
961 962
}

963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993
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;
}

994 995 996 997 998 999
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;

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

1002 1003
	hci_dev_lock(hdev);

1004
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1005
		mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
1006

1007
	if (rp->status)
1008
		goto unlock;
1009 1010 1011

	cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
	if (!cp)
1012
		goto unlock;
1013 1014 1015 1016

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
	if (conn)
		conn->pin_length = cp->pin_len;
1017 1018 1019

unlock:
	hci_dev_unlock(hdev);
1020 1021 1022 1023 1024 1025
}

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;

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

1028 1029
	hci_dev_lock(hdev);

1030
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1031
		mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
1032
						 rp->status);
1033 1034

	hci_dev_unlock(hdev);
1035
}
1036

1037 1038 1039 1040 1041
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;

1042
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053

	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);
}
1054

1055 1056 1057 1058 1059 1060 1061
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);

1062 1063 1064 1065
	if (rp->status)
		return;

	memcpy(hdev->le_features, rp->features, 8);
1066 1067
}

1068 1069 1070 1071 1072 1073 1074
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);

1075 1076 1077 1078
	if (rp->status)
		return;

	hdev->adv_tx_power = rp->tx_power;
1079 1080
}

1081 1082 1083 1084
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;

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

1087 1088
	hci_dev_lock(hdev);

1089
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1090 1091
		mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
						 rp->status);
1092 1093

	hci_dev_unlock(hdev);
1094 1095 1096
}

static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
1097
					  struct sk_buff *skb)
1098 1099 1100
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

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

1103 1104
	hci_dev_lock(hdev);

1105
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1106
		mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
1107
						     ACL_LINK, 0, rp->status);
1108 1109

	hci_dev_unlock(hdev);
1110 1111
}

1112 1113 1114 1115
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;

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

	hci_dev_lock(hdev);

1120
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1121
		mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
1122
						 0, rp->status);
1123 1124 1125 1126 1127

	hci_dev_unlock(hdev);
}

static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
1128
					  struct sk_buff *skb)
1129 1130 1131
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

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

	hci_dev_lock(hdev);

1136
	if (hci_dev_test_flag(hdev, HCI_MGMT))
1137
		mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
1138
						     ACL_LINK, 0, rp->status);
1139 1140 1141 1142

	hci_dev_unlock(hdev);
}

1143 1144
static void hci_cc_read_local_oob_data(struct hci_dev *hdev,
				       struct sk_buff *skb)
1145 1146 1147
{
	struct hci_rp_read_local_oob_data *rp = (void *) skb->data;

1148
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1149 1150 1151 1152 1153 1154 1155 1156
}

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);
1157 1158
}

1159 1160 1161 1162 1163 1164 1165
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);

1166 1167 1168
	if (status)
		return;

1169 1170 1171 1172 1173 1174
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_RANDOM_ADDR);
	if (!sent)
		return;

	hci_dev_lock(hdev);

1175
	bacpy(&hdev->random_addr, sent);
1176

1177 1178 1179 1180 1181 1182
	if (!bacmp(&hdev->rpa, sent)) {
		hci_dev_clear_flag(hdev, HCI_RPA_EXPIRED);
		queue_delayed_work(hdev->workqueue, &hdev->rpa_expired,
				   secs_to_jiffies(hdev->rpa_timeout));
	}

1183 1184 1185
	hci_dev_unlock(hdev);
}

1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207
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);
}

1208 1209 1210 1211 1212
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;
1213
	struct adv_info *adv;
1214 1215 1216 1217 1218

	if (status)
		return;

	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_SET_RAND_ADDR);
1219 1220 1221 1222 1223
	/* Update only in case the adv instance since handle 0x00 shall be using
	 * HCI_OP_LE_SET_RANDOM_ADDR since that allows both extended and
	 * non-extended adverting.
	 */
	if (!cp || !cp->handle)
1224 1225 1226 1227
		return;

	hci_dev_lock(hdev);

1228 1229 1230 1231 1232 1233 1234 1235 1236
	adv = hci_find_adv_instance(hdev, cp->handle);
	if (adv) {
		bacpy(&adv->random_addr, &cp->bdaddr);
		if (!bacmp(&hdev->rpa, &cp->bdaddr)) {
			adv->rpa_expired = false;
			queue_delayed_work(hdev->workqueue,
					   &adv->rpa_expired_cb,
					   secs_to_jiffies(hdev->rpa_timeout));
		}
1237 1238 1239 1240 1241
	}

	hci_dev_unlock(hdev);
}

1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
static void hci_cc_le_read_transmit_power(struct hci_dev *hdev,
					  struct sk_buff *skb)
{
	struct hci_rp_le_read_transmit_power *rp = (void *)skb->data;

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

	if (rp->status)
		return;

	hdev->min_le_tx_power = rp->min_le_tx_power;
	hdev->max_le_tx_power = rp->max_le_tx_power;
}

1256 1257 1258 1259 1260 1261
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);

1262
	if (status)
1263 1264
		return;

1265 1266
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_ADV_ENABLE);
	if (!sent)
1267 1268
		return;

1269 1270
	hci_dev_lock(hdev);

S
Stephen Hemminger 已提交
1271
	/* If we're doing connection initiation as peripheral. Set a
1272 1273 1274 1275 1276
	 * timeout in case something goes wrong.
	 */
	if (*sent) {
		struct hci_conn *conn;

1277
		hci_dev_set_flag(hdev, HCI_LE_ADV);
1278

1279
		conn = hci_lookup_le_connect(hdev);
1280 1281 1282
		if (conn)
			queue_delayed_work(hdev->workqueue,
					   &conn->le_conn_timeout,
1283
					   conn->conn_timeout);
1284
	} else {
1285
		hci_dev_clear_flag(hdev, HCI_LE_ADV);
1286 1287
	}

1288
	hci_dev_unlock(hdev);
1289 1290
}

1291 1292 1293 1294
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;
1295
	struct hci_cp_ext_adv_set *set;
1296
	__u8 status = *((__u8 *) skb->data);
1297
	struct adv_info *adv = NULL, *n;
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307

	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;

1308 1309
	set = (void *)cp->data;

1310 1311
	hci_dev_lock(hdev);

1312 1313 1314
	if (cp->num_of_sets)
		adv = hci_find_adv_instance(hdev, set->handle);

1315 1316 1317 1318 1319
	if (cp->enable) {
		struct hci_conn *conn;

		hci_dev_set_flag(hdev, HCI_LE_ADV);

1320 1321 1322
		if (adv)
			adv->enabled = true;

1323 1324 1325 1326 1327
		conn = hci_lookup_le_connect(hdev);
		if (conn)
			queue_delayed_work(hdev->workqueue,
					   &conn->le_conn_timeout,
					   conn->conn_timeout);
1328
	} else {
1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345
		if (adv) {
			adv->enabled = false;
			/* If just one instance was disabled check if there are
			 * any other instance enabled before clearing HCI_LE_ADV
			 */
			list_for_each_entry_safe(adv, n, &hdev->adv_instances,
						 list) {
				if (adv->enabled)
					goto unlock;
			}
		} else {
			/* All instances shall be considered disabled */
			list_for_each_entry_safe(adv, n, &hdev->adv_instances,
						 list)
				adv->enabled = false;
		}

1346
		hci_dev_clear_flag(hdev, HCI_LE_ADV);
1347 1348
	}

1349
unlock:
1350 1351 1352
	hci_dev_unlock(hdev);
}

1353 1354 1355 1356 1357 1358 1359
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);

1360 1361 1362
	if (status)
		return;

1363 1364 1365 1366 1367 1368
	cp = hci_sent_cmd_data(hdev, HCI_OP_LE_SET_SCAN_PARAM);
	if (!cp)
		return;

	hci_dev_lock(hdev);

1369
	hdev->le_scan_type = cp->type;
1370 1371 1372 1373

	hci_dev_unlock(hdev);
}

1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398
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);
}

1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414
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,
1415 1416
				     u8 bdaddr_type, s8 rssi, u32 flags,
				     u8 *data, u8 len)
1417 1418 1419
{
	struct discovery_state *d = &hdev->discovery;

1420 1421 1422
	if (len > HCI_MAX_AD_LENGTH)
		return;

1423 1424
	bacpy(&d->last_adv_addr, bdaddr);
	d->last_adv_addr_type = bdaddr_type;
1425
	d->last_adv_rssi = rssi;
1426
	d->last_adv_flags = flags;
1427 1428 1429 1430
	memcpy(d->last_adv_data, data, len);
	d->last_adv_data_len = len;
}

1431
static void le_set_scan_enable_complete(struct hci_dev *hdev, u8 enable)
1432
{
1433 1434
	hci_dev_lock(hdev);

1435
	switch (enable) {
1436
	case LE_SCAN_ENABLE:
1437
		hci_dev_set_flag(hdev, HCI_LE_SCAN);
1438 1439
		if (hdev->le_scan_type == LE_SCAN_ACTIVE)
			clear_pending_adv_report(hdev);
1440 1441
		break;

1442
	case LE_SCAN_DISABLE:
1443 1444 1445 1446 1447 1448 1449 1450
		/* 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,
1451
					  d->last_adv_addr_type, NULL,
1452
					  d->last_adv_rssi, d->last_adv_flags,
1453
					  d->last_adv_data,
1454 1455 1456
					  d->last_adv_data_len, NULL, 0);
		}

1457 1458 1459 1460 1461
		/* Cancel this timer so that we don't try to disable scanning
		 * when it's already disabled.
		 */
		cancel_delayed_work(&hdev->le_scan_disable);

1462
		hci_dev_clear_flag(hdev, HCI_LE_SCAN);
1463

1464 1465
		/* The HCI_LE_SCAN_INTERRUPTED flag indicates that we
		 * interrupted scanning due to a connect request. Mark
1466 1467 1468 1469
		 * 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.
1470
		 */
1471
		if (hci_dev_test_and_clear_flag(hdev, HCI_LE_SCAN_INTERRUPTED))
1472
			hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
1473
		else if (!hci_dev_test_flag(hdev, HCI_LE_ADV) &&
1474
			 hdev->discovery.state == DISCOVERY_FINDING)
1475
			hci_req_reenable_advertising(hdev);
1476

1477 1478 1479
		break;

	default:
1480
		bt_dev_err(hdev, "use of reserved LE_Scan_Enable param %d",
1481
			   enable);
1482
		break;
1483
	}
1484 1485

	hci_dev_unlock(hdev);
1486 1487
}

1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505
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);
}

1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523
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);
}

1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537
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;
}

1538 1539
static void hci_cc_le_read_accept_list_size(struct hci_dev *hdev,
					    struct sk_buff *skb)
1540
{
1541
	struct hci_rp_le_read_accept_list_size *rp = (void *)skb->data;
1542 1543 1544

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

1545 1546 1547
	if (rp->status)
		return;

1548
	hdev->le_accept_list_size = rp->size;
1549 1550
}

1551 1552
static void hci_cc_le_clear_accept_list(struct hci_dev *hdev,
					struct sk_buff *skb)
1553 1554 1555 1556 1557
{
	__u8 status = *((__u8 *) skb->data);

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

1558 1559 1560
	if (status)
		return;

1561
	hci_bdaddr_list_clear(&hdev->le_accept_list);
1562 1563
}

1564 1565
static void hci_cc_le_add_to_accept_list(struct hci_dev *hdev,
					 struct sk_buff *skb)
1566
{
1567
	struct hci_cp_le_add_to_accept_list *sent;
1568 1569 1570 1571
	__u8 status = *((__u8 *) skb->data);

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

1572 1573 1574
	if (status)
		return;

1575
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_ADD_TO_ACCEPT_LIST);
1576 1577 1578
	if (!sent)
		return;

1579 1580
	hci_bdaddr_list_add(&hdev->le_accept_list, &sent->bdaddr,
			    sent->bdaddr_type);
1581 1582
}

1583 1584
static void hci_cc_le_del_from_accept_list(struct hci_dev *hdev,
					   struct sk_buff *skb)
1585
{
1586
	struct hci_cp_le_del_from_accept_list *sent;
1587 1588 1589 1590
	__u8 status = *((__u8 *) skb->data);

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

1591 1592 1593
	if (status)
		return;

1594
	sent = hci_sent_cmd_data(hdev, HCI_OP_LE_DEL_FROM_ACCEPT_LIST);
1595 1596 1597
	if (!sent)
		return;

1598
	hci_bdaddr_list_del(&hdev->le_accept_list, &sent->bdaddr,
1599
			    sent->bdaddr_type);
1600 1601
}

1602 1603 1604 1605 1606 1607 1608
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);

1609 1610 1611 1612
	if (rp->status)
		return;

	memcpy(hdev->le_states, rp->le_states, 8);
1613 1614
}

1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647
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);
}

1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686
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);
}

1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
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 已提交
1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712
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;
}

1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736
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);
}

1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752
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);
}

1753 1754
static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
					   struct sk_buff *skb)
1755
{
1756
	struct hci_cp_write_le_host_supported *sent;
1757 1758
	__u8 status = *((__u8 *) skb->data);

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

1761 1762 1763
	if (status)
		return;

1764
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
1765
	if (!sent)
1766 1767
		return;

1768 1769
	hci_dev_lock(hdev);

1770 1771
	if (sent->le) {
		hdev->features[1][0] |= LMP_HOST_LE;
1772
		hci_dev_set_flag(hdev, HCI_LE_ENABLED);
1773 1774
	} else {
		hdev->features[1][0] &= ~LMP_HOST_LE;
1775 1776
		hci_dev_clear_flag(hdev, HCI_LE_ENABLED);
		hci_dev_clear_flag(hdev, HCI_ADVERTISING);
1777
	}
1778 1779 1780 1781 1782

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

	hci_dev_unlock(hdev);
1785 1786
}

1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805
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);
}

1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822
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;
1823
	if (!cp->handle) {
1824 1825 1826
		/* Store in hdev for instance 0 */
		hdev->adv_tx_power = rp->tx_power;
	} else {
1827
		adv_instance = hci_find_adv_instance(hdev, cp->handle);
1828 1829 1830
		if (adv_instance)
			adv_instance->tx_power = rp->tx_power;
	}
1831
	/* Update adv data as tx power is known now */
1832
	hci_req_update_adv_data(hdev, cp->handle);
1833

1834 1835 1836
	hci_dev_unlock(hdev);
}

1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855
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);
}

1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873
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));
1874 1875 1876 1877 1878
	if (!conn)
		goto unlock;

	switch (sent->type) {
	case 0x00:
1879
		conn->tx_power = rp->tx_power;
1880 1881 1882 1883 1884
		break;
	case 0x01:
		conn->max_tx_power = rp->tx_power;
		break;
	}
1885

1886
unlock:
1887 1888 1889
	hci_dev_unlock(hdev);
}

1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904
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;
}

1905
static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
1906
{
1907
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1908 1909 1910

	if (status) {
		hci_conn_check_pending(hdev);
1911 1912 1913
		return;
	}

1914
	set_bit(HCI_INQUIRY, &hdev->flags);
L
Linus Torvalds 已提交
1915 1916
}

1917
static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1918
{
1919
	struct hci_cp_create_conn *cp;
L
Linus Torvalds 已提交
1920 1921
	struct hci_conn *conn;

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

	cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
L
Linus Torvalds 已提交
1925 1926 1927 1928 1929 1930 1931
	if (!cp)
		return;

	hci_dev_lock(hdev);

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

1932
	BT_DBG("%s bdaddr %pMR hcon %p", hdev->name, &cp->bdaddr, conn);
L
Linus Torvalds 已提交
1933 1934 1935

	if (status) {
		if (conn && conn->state == BT_CONNECT) {
1936 1937
			if (status != 0x0c || conn->attempt > 2) {
				conn->state = BT_CLOSED;
1938
				hci_connect_cfm(conn, status);
1939 1940 1941
				hci_conn_del(conn);
			} else
				conn->state = BT_CONNECT2;
L
Linus Torvalds 已提交
1942 1943 1944
		}
	} else {
		if (!conn) {
1945 1946 1947
			conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr,
					    HCI_ROLE_MASTER);
			if (!conn)
1948
				bt_dev_err(hdev, "no memory for new connection");
L
Linus Torvalds 已提交
1949 1950 1951 1952 1953 1954
		}
	}

	hci_dev_unlock(hdev);
}

1955
static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1956
{
1957 1958 1959
	struct hci_cp_add_sco *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;
L
Linus Torvalds 已提交
1960

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

1963 1964
	if (!status)
		return;
L
Linus Torvalds 已提交
1965

1966 1967 1968
	cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
	if (!cp)
		return;
L
Linus Torvalds 已提交
1969

1970
	handle = __le16_to_cpu(cp->handle);
L
Linus Torvalds 已提交
1971

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

1974
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
1975

1976
	acl = hci_conn_hash_lookup_handle(hdev, handle);
1977 1978 1979 1980
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;
L
Linus Torvalds 已提交
1981

1982
			hci_connect_cfm(sco, status);
1983 1984
			hci_conn_del(sco);
		}
1985
	}
L
Linus Torvalds 已提交
1986

1987 1988
	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
1989

1990 1991 1992 1993 1994
static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_auth_requested *cp;
	struct hci_conn *conn;

1995
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008

	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) {
2009
			hci_connect_cfm(conn, status);
2010
			hci_conn_drop(conn);
2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021
		}
	}

	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;

2022
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035

	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) {
2036
			hci_connect_cfm(conn, status);
2037
			hci_conn_drop(conn);
2038 2039 2040 2041 2042 2043
		}
	}

	hci_dev_unlock(hdev);
}

2044
static int hci_outgoing_auth_needed(struct hci_dev *hdev,
2045
				    struct hci_conn *conn)
2046 2047 2048 2049
{
	if (conn->state != BT_CONFIG || !conn->out)
		return 0;

2050
	if (conn->pending_sec_level == BT_SECURITY_SDP)
2051 2052 2053
		return 0;

	/* Only request authentication for SSP connections or non-SSP
2054 2055 2056
	 * devices with sec_level MEDIUM or HIGH or if MITM protection
	 * is requested.
	 */
2057
	if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
2058
	    conn->pending_sec_level != BT_SECURITY_FIPS &&
2059 2060
	    conn->pending_sec_level != BT_SECURITY_HIGH &&
	    conn->pending_sec_level != BT_SECURITY_MEDIUM)
2061 2062 2063 2064 2065
		return 0;

	return 1;
}

2066
static int hci_resolve_name(struct hci_dev *hdev,
2067
				   struct inquiry_entry *e)
2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080
{
	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);
}

2081
static bool hci_resolve_next_name(struct hci_dev *hdev)
2082 2083 2084 2085
{
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;

2086 2087 2088 2089
	if (list_empty(&discov->resolve))
		return false;

	e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
2090 2091 2092
	if (!e)
		return false;

2093 2094 2095 2096 2097 2098 2099 2100 2101
	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,
2102
				   bdaddr_t *bdaddr, u8 *name, u8 name_len)
2103 2104 2105 2106
{
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;

2107 2108 2109 2110 2111 2112 2113
	/* 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) &&
2114
	    !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
2115
		mgmt_device_connected(hdev, conn, name, name_len);
2116 2117 2118 2119

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

2120 2121 2122 2123 2124 2125 2126
	if (discov->state == DISCOVERY_STOPPING)
		goto discov_complete;

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

	e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
2127 2128 2129 2130 2131 2132 2133 2134 2135
	/* 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) {
2136
		e->name_state = NAME_KNOWN;
2137 2138
		mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
				 e->data.rssi, name, name_len);
2139 2140
	} else {
		e->name_state = NAME_NOT_KNOWN;
2141 2142
	}

2143
	if (hci_resolve_next_name(hdev))
2144 2145 2146 2147 2148 2149
		return;

discov_complete:
	hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
}

2150 2151
static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
{
2152 2153 2154
	struct hci_cp_remote_name_req *cp;
	struct hci_conn *conn;

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

	/* 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);

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

2170
	if (hci_dev_test_flag(hdev, HCI_MGMT))
2171
		hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
2172

2173 2174 2175 2176 2177 2178
	if (!conn)
		goto unlock;

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

2179
	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
2180 2181
		struct hci_cp_auth_requested auth_cp;

2182 2183
		set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);

2184 2185 2186
		auth_cp.handle = __cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
			     sizeof(auth_cp), &auth_cp);
2187 2188
	}

2189
unlock:
2190
	hci_dev_unlock(hdev);
2191
}
L
Linus Torvalds 已提交
2192

2193 2194 2195 2196 2197
static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_read_remote_features *cp;
	struct hci_conn *conn;

2198
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211

	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) {
2212
			hci_connect_cfm(conn, status);
2213
			hci_conn_drop(conn);
2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224
		}
	}

	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;

2225
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238

	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) {
2239
			hci_connect_cfm(conn, status);
2240
			hci_conn_drop(conn);
2241 2242 2243 2244 2245 2246
		}
	}

	hci_dev_unlock(hdev);
}

2247 2248
static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
{
2249 2250 2251 2252
	struct hci_cp_setup_sync_conn *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;

2253
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
2254 2255 2256 2257 2258 2259 2260 2261 2262 2263

	if (!status)
		return;

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

	handle = __le16_to_cpu(cp->handle);

2264
	BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
2265 2266 2267 2268

	hci_dev_lock(hdev);

	acl = hci_conn_hash_lookup_handle(hdev, handle);
2269 2270 2271 2272
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;
2273

2274
			hci_connect_cfm(sco, status);
2275 2276
			hci_conn_del(sco);
		}
2277 2278 2279
	}

	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2280 2281
}

2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316
static void hci_cs_enhanced_setup_sync_conn(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_enhanced_setup_sync_conn *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;

	bt_dev_dbg(hdev, "status 0x%2.2x", status);

	if (!status)
		return;

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

	handle = __le16_to_cpu(cp->handle);

	bt_dev_dbg(hdev, "handle 0x%4.4x", handle);

	hci_dev_lock(hdev);

	acl = hci_conn_hash_lookup_handle(hdev, handle);
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;

			hci_connect_cfm(sco, status);
			hci_conn_del(sco);
		}
	}

	hci_dev_unlock(hdev);
}

2317
static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
2318
{
2319 2320
	struct hci_cp_sniff_mode *cp;
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2321

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

2324 2325
	if (!status)
		return;
2326

2327 2328 2329
	cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
	if (!cp)
		return;
2330

2331
	hci_dev_lock(hdev);
2332

2333
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2334
	if (conn) {
2335
		clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
2336

2337
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
2338 2339 2340
			hci_sco_setup(conn, status);
	}

2341 2342
	hci_dev_unlock(hdev);
}
2343

2344 2345 2346 2347
static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_exit_sniff_mode *cp;
	struct hci_conn *conn;
2348

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

2351 2352
	if (!status)
		return;
2353

2354 2355 2356
	cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
	if (!cp)
		return;
2357

2358
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
2359

2360
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
2361
	if (conn) {
2362
		clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
L
Linus Torvalds 已提交
2363

2364
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
2365 2366 2367
			hci_sco_setup(conn, status);
	}

2368
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2369 2370
}

2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385
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));
2386
	if (conn) {
2387
		mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
2388
				       conn->dst_type, status);
2389

2390
		if (conn->type == LE_LINK && conn->role == HCI_ROLE_SLAVE) {
2391 2392 2393 2394
			hdev->cur_adv_instance = conn->adv_instance;
			hci_req_reenable_advertising(hdev);
		}

2395 2396 2397 2398 2399 2400 2401 2402
		/* 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);
	}

2403 2404 2405
	hci_dev_unlock(hdev);
}

2406
static u8 ev_bdaddr_type(struct hci_dev *hdev, u8 type, bool *resolved)
2407 2408 2409 2410 2411 2412 2413
{
	/* When using controller based address resolution, then the new
	 * address types 0x02 and 0x03 are used. These types need to be
	 * converted back into either public address or random address type
	 */
	switch (type) {
	case ADDR_LE_DEV_PUBLIC_RESOLVED:
2414 2415
		if (resolved)
			*resolved = true;
2416 2417
		return ADDR_LE_DEV_PUBLIC;
	case ADDR_LE_DEV_RANDOM_RESOLVED:
2418 2419
		if (resolved)
			*resolved = true;
2420 2421 2422
		return ADDR_LE_DEV_RANDOM;
	}

2423 2424
	if (resolved)
		*resolved = false;
2425 2426 2427
	return type;
}

2428 2429 2430
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)
2431 2432 2433
{
	struct hci_conn *conn;

2434 2435
	conn = hci_conn_hash_lookup_le(hdev, peer_addr,
				       peer_addr_type);
2436
	if (!conn)
2437
		return;
2438

2439
	own_address_type = ev_bdaddr_type(hdev, own_address_type, NULL);
2440

2441 2442 2443 2444
	/* Store the initiator and responder address information which
	 * is needed for SMP. These values will not change during the
	 * lifetime of the connection.
	 */
2445 2446
	conn->init_addr_type = own_address_type;
	if (own_address_type == ADDR_LE_DEV_RANDOM)
2447 2448 2449 2450
		bacpy(&conn->init_addr, &hdev->random_addr);
	else
		bacpy(&conn->init_addr, &hdev->bdaddr);

2451 2452
	conn->resp_addr_type = peer_addr_type;
	bacpy(&conn->resp_addr, peer_addr);
2453

2454 2455 2456
	/* 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
2457
	 * the accept list for connecting.
2458
	 */
2459
	if (filter_policy == HCI_LE_USE_PEER_ADDR)
2460 2461
		queue_delayed_work(conn->hdev->workqueue,
				   &conn->le_conn_timeout,
2462
				   conn->conn_timeout);
2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485
}

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);
2486

2487 2488 2489
	hci_dev_unlock(hdev);
}

2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514
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);
}

2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541
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);
}

2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571
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);
}

2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594
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);
}

2595
static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2596 2597
{
	__u8 status = *((__u8 *) skb->data);
2598 2599
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;
L
Linus Torvalds 已提交
2600

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

2603
	hci_conn_check_pending(hdev);
2604 2605 2606 2607

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

2608
	smp_mb__after_atomic(); /* wake_up_bit advises about this barrier */
2609 2610
	wake_up_bit(&hdev->flags, HCI_INQUIRY);

2611
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
2612 2613
		return;

2614
	hci_dev_lock(hdev);
2615

2616
	if (discov->state != DISCOVERY_FINDING)
2617 2618 2619
		goto unlock;

	if (list_empty(&discov->resolve)) {
2620 2621 2622 2623 2624 2625 2626 2627 2628 2629
		/* 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);
2630 2631 2632 2633 2634 2635 2636 2637
		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 {
2638 2639 2640 2641 2642 2643 2644 2645 2646 2647
		/* 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);
2648 2649 2650
	}

unlock:
2651
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2652 2653
}

2654
static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2655
{
2656
	struct inquiry_data data;
2657
	struct inquiry_info *info = (void *) (skb->data + 1);
L
Linus Torvalds 已提交
2658 2659 2660 2661
	int num_rsp = *((__u8 *) skb->data);

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

2662
	if (!num_rsp || skb->len < num_rsp * sizeof(*info) + 1)
2663 2664
		return;

2665
	if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
2666 2667
		return;

L
Linus Torvalds 已提交
2668
	hci_dev_lock(hdev);
2669

2670
	for (; num_rsp; num_rsp--, info++) {
2671
		u32 flags;
2672

L
Linus Torvalds 已提交
2673 2674 2675 2676 2677 2678
		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;
2679
		data.rssi		= HCI_RSSI_INVALID;
2680
		data.ssp_mode		= 0x00;
2681

2682 2683
		flags = hci_inquiry_cache_update(hdev, &data, false);

2684
		mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
2685 2686
				  info->dev_class, HCI_RSSI_INVALID,
				  flags, NULL, 0, NULL, 0);
L
Linus Torvalds 已提交
2687
	}
2688

L
Linus Torvalds 已提交
2689 2690 2691
	hci_dev_unlock(hdev);
}

2692
static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2693
{
2694 2695
	struct hci_ev_conn_complete *ev = (void *) skb->data;
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2696 2697 2698 2699 2700 2701

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

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
2702
	if (!conn) {
2703 2704 2705
		/* Connection may not exist if auto-connected. Check the bredr
		 * allowlist to see if this device is allowed to auto connect.
		 * If link is an ACL type, create a connection class
2706
		 * automatically.
2707 2708 2709 2710
		 *
		 * Auto-connect will only occur if the event filter is
		 * programmed with a given address. Right now, event filter is
		 * only used during suspend.
2711
		 */
2712
		if (ev->link_type == ACL_LINK &&
2713
		    hci_bdaddr_list_lookup_with_flags(&hdev->accept_list,
2714 2715
						      &ev->bdaddr,
						      BDADDR_BREDR)) {
2716 2717 2718 2719 2720 2721
			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;
			}
2722 2723 2724
		} else {
			if (ev->link_type != SCO_LINK)
				goto unlock;
2725

2726 2727 2728 2729
			conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK,
						       &ev->bdaddr);
			if (!conn)
				goto unlock;
2730

2731 2732
			conn->type = SCO_LINK;
		}
2733
	}
L
Linus Torvalds 已提交
2734 2735 2736

	if (!ev->status) {
		conn->handle = __le16_to_cpu(ev->handle);
2737 2738 2739 2740

		if (conn->type == ACL_LINK) {
			conn->state = BT_CONFIG;
			hci_conn_hold(conn);
2741 2742 2743 2744 2745 2746

			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;
2747 2748
		} else
			conn->state = BT_CONNECTED;
L
Linus Torvalds 已提交
2749

2750
		hci_debugfs_create_conn(conn);
2751 2752
		hci_conn_add_sysfs(conn);

L
Linus Torvalds 已提交
2753
		if (test_bit(HCI_AUTH, &hdev->flags))
2754
			set_bit(HCI_CONN_AUTH, &conn->flags);
L
Linus Torvalds 已提交
2755 2756

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

2759 2760 2761 2762
		/* Get remote features */
		if (conn->type == ACL_LINK) {
			struct hci_cp_read_remote_features cp;
			cp.handle = ev->handle;
2763
			hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
2764
				     sizeof(cp), &cp);
2765

2766
			hci_req_update_scan(hdev);
2767 2768
		}

L
Linus Torvalds 已提交
2769
		/* Set packet type for incoming connection */
2770
		if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
L
Linus Torvalds 已提交
2771 2772
			struct hci_cp_change_conn_ptype cp;
			cp.handle = ev->handle;
2773
			cp.pkt_type = cpu_to_le16(conn->pkt_type);
2774 2775
			hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
				     &cp);
L
Linus Torvalds 已提交
2776
		}
2777
	} else {
L
Linus Torvalds 已提交
2778
		conn->state = BT_CLOSED;
2779
		if (conn->type == ACL_LINK)
2780
			mgmt_connect_failed(hdev, &conn->dst, conn->type,
2781
					    conn->dst_type, ev->status);
2782
	}
L
Linus Torvalds 已提交
2783

2784 2785
	if (conn->type == ACL_LINK)
		hci_sco_setup(conn, ev->status);
L
Linus Torvalds 已提交
2786

2787
	if (ev->status) {
2788
		hci_connect_cfm(conn, ev->status);
L
Linus Torvalds 已提交
2789
		hci_conn_del(conn);
2790 2791 2792 2793 2794 2795 2796 2797
	} 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;
		}

2798
		hci_connect_cfm(conn, ev->status);
2799
	}
L
Linus Torvalds 已提交
2800

2801
unlock:
L
Linus Torvalds 已提交
2802 2803
	hci_dev_unlock(hdev);

2804
	hci_conn_check_pending(hdev);
L
Linus Torvalds 已提交
2805 2806
}

2807 2808 2809 2810 2811 2812 2813 2814 2815
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);
}

2816
static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2817
{
2818 2819
	struct hci_ev_conn_request *ev = (void *) skb->data;
	int mask = hdev->link_mode;
2820 2821
	struct inquiry_entry *ie;
	struct hci_conn *conn;
2822
	__u8 flags = 0;
L
Linus Torvalds 已提交
2823

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

2827 2828
	mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type,
				      &flags);
L
Linus Torvalds 已提交
2829

2830 2831 2832 2833 2834
	if (!(mask & HCI_LM_ACCEPT)) {
		hci_reject_conn(hdev, &ev->bdaddr);
		return;
	}

2835
	if (hci_bdaddr_list_lookup(&hdev->reject_list, &ev->bdaddr,
2836 2837 2838 2839 2840
				   BDADDR_BREDR)) {
		hci_reject_conn(hdev, &ev->bdaddr);
		return;
	}

2841
	/* Require HCI_CONNECTABLE or an accept list entry to accept the
2842 2843 2844
	 * connection. These features are only touched through mgmt so
	 * only do the checks if HCI_MGMT is set.
	 */
2845 2846
	if (hci_dev_test_flag(hdev, HCI_MGMT) &&
	    !hci_dev_test_flag(hdev, HCI_CONNECTABLE) &&
2847
	    !hci_bdaddr_list_lookup_with_flags(&hdev->accept_list, &ev->bdaddr,
2848 2849 2850
					       BDADDR_BREDR)) {
		hci_reject_conn(hdev, &ev->bdaddr);
		return;
2851
	}
L
Linus Torvalds 已提交
2852

2853
	/* Connection accepted */
2854

2855 2856 2857 2858 2859
	hci_dev_lock(hdev);

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

2861 2862 2863
	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
			&ev->bdaddr);
	if (!conn) {
2864 2865
		conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr,
				    HCI_ROLE_SLAVE);
2866
		if (!conn) {
2867
			bt_dev_err(hdev, "no memory for new connection");
2868 2869
			hci_dev_unlock(hdev);
			return;
L
Linus Torvalds 已提交
2870
		}
2871
	}
2872

2873
	memcpy(conn->dev_class, ev->dev_class, 3);
2874

2875
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2876

2877 2878 2879 2880
	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 已提交
2881

2882
		bacpy(&cp.bdaddr, &ev->bdaddr);
2883

2884
		if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
2885
			cp.role = 0x00; /* Become central */
2886
		else
2887
			cp.role = 0x01; /* Remain peripheral */
2888

2889 2890 2891 2892
		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;
2893

2894 2895
		bacpy(&cp.bdaddr, &ev->bdaddr);
		cp.pkt_type = cpu_to_le16(conn->pkt_type);
2896

2897 2898 2899 2900 2901
		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 已提交
2902

2903 2904
		hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ, sizeof(cp),
			     &cp);
2905
	} else {
2906
		conn->state = BT_CONNECT2;
2907
		hci_connect_cfm(conn, 0);
L
Linus Torvalds 已提交
2908 2909 2910
	}
}

2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926
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;
	}
}

2927
static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2928
{
2929
	struct hci_ev_disconn_complete *ev = (void *) skb->data;
2930
	u8 reason;
2931
	struct hci_conn_params *params;
2932
	struct hci_conn *conn;
2933
	bool mgmt_connected;
2934

2935
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2936 2937 2938 2939

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2940 2941
	if (!conn)
		goto unlock;
2942

2943 2944 2945 2946
	if (ev->status) {
		mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
				       conn->dst_type, ev->status);
		goto unlock;
2947
	}
2948

2949 2950
	conn->state = BT_CLOSED;

2951
	mgmt_connected = test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags);
2952 2953 2954 2955 2956 2957

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

2958 2959
	mgmt_device_disconnected(hdev, &conn->dst, conn->type, conn->dst_type,
				reason, mgmt_connected);
2960

2961 2962 2963 2964
	if (conn->type == ACL_LINK) {
		if (test_bit(HCI_CONN_FLUSH_KEY, &conn->flags))
			hci_remove_link_key(hdev, &conn->dst);

2965
		hci_req_update_scan(hdev);
2966
	}
2967

2968 2969 2970 2971 2972 2973
	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;
2974
			fallthrough;
2975

2976
		case HCI_AUTO_CONN_DIRECT:
2977
		case HCI_AUTO_CONN_ALWAYS:
2978 2979 2980
			list_del_init(&params->action);
			list_add(&params->action, &hdev->pend_le_conns);
			hci_update_background_scan(hdev);
2981 2982 2983 2984 2985 2986 2987
			break;

		default:
			break;
		}
	}

2988
	hci_disconn_cfm(conn, ev->reason);
2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999

	/* 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."
	 */
3000
	if (conn->type == LE_LINK && conn->role == HCI_ROLE_SLAVE) {
3001
		hdev->cur_adv_instance = conn->adv_instance;
3002
		hci_req_reenable_advertising(hdev);
3003 3004 3005
	}

	hci_conn_del(conn);
3006

3007 3008 3009 3010 3011 3012 3013 3014
	/* 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);
	}

3015
unlock:
3016 3017 3018
	hci_dev_unlock(hdev);
}

3019
static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
3020
{
3021
	struct hci_ev_auth_complete *ev = (void *) skb->data;
3022
	struct hci_conn *conn;
L
Linus Torvalds 已提交
3023

3024
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
3025 3026 3027

	hci_dev_lock(hdev);

3028
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3029 3030 3031 3032
	if (!conn)
		goto unlock;

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

3035
		if (!hci_conn_ssp_enabled(conn) &&
3036
		    test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
3037
			bt_dev_info(hdev, "re-auth of legacy device is not possible.");
3038
		} else {
3039
			set_bit(HCI_CONN_AUTH, &conn->flags);
3040
			conn->sec_level = conn->pending_sec_level;
3041
		}
3042
	} else {
3043 3044 3045
		if (ev->status == HCI_ERROR_PIN_OR_KEY_MISSING)
			set_bit(HCI_CONN_AUTH_FAILURE, &conn->flags);

3046
		mgmt_auth_failed(conn, ev->status);
3047
	}
L
Linus Torvalds 已提交
3048

3049 3050
	clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
	clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
L
Linus Torvalds 已提交
3051

3052
	if (conn->state == BT_CONFIG) {
3053
		if (!ev->status && hci_conn_ssp_enabled(conn)) {
3054 3055 3056 3057
			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),
3058
				     &cp);
3059
		} else {
3060
			conn->state = BT_CONNECTED;
3061
			hci_connect_cfm(conn, ev->status);
3062
			hci_conn_drop(conn);
3063
		}
3064 3065
	} else {
		hci_auth_cfm(conn, ev->status);
3066

3067 3068
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
3069
		hci_conn_drop(conn);
3070 3071
	}

3072
	if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
3073 3074 3075 3076 3077
		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),
3078
				     &cp);
3079
		} else {
3080
			clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3081
			hci_encrypt_cfm(conn, ev->status);
L
Linus Torvalds 已提交
3082 3083 3084
		}
	}

3085
unlock:
L
Linus Torvalds 已提交
3086 3087 3088
	hci_dev_unlock(hdev);
}

3089
static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
3090
{
3091 3092 3093
	struct hci_ev_remote_name *ev = (void *) skb->data;
	struct hci_conn *conn;

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

3096
	hci_conn_check_pending(hdev);
3097 3098 3099

	hci_dev_lock(hdev);

3100
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
3101

3102
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
3103
		goto check_auth;
3104

3105 3106
	if (ev->status == 0)
		hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
3107
				       strnlen(ev->name, HCI_MAX_NAME_LENGTH));
3108 3109 3110 3111
	else
		hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);

check_auth:
3112 3113 3114 3115 3116 3117
	if (!conn)
		goto unlock;

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

3118
	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
3119
		struct hci_cp_auth_requested cp;
3120 3121 3122

		set_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags);

3123 3124 3125 3126
		cp.handle = __cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
	}

3127
unlock:
3128
	hci_dev_unlock(hdev);
3129 3130
}

3131 3132 3133 3134 3135 3136 3137 3138 3139 3140
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)) {
3141
		bt_dev_err(hdev, "invalid read key size response");
3142 3143 3144 3145 3146 3147 3148 3149 3150 3151 3152 3153
		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;

3154 3155 3156
	/* 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.
3157 3158
	 */
	if (rp->status) {
3159 3160
		bt_dev_err(hdev, "failed to read key size for handle %u",
			   handle);
3161
		conn->enc_key_size = 0;
3162 3163 3164 3165
	} else {
		conn->enc_key_size = rp->key_size;
	}

3166
	hci_encrypt_cfm(conn, 0);
3167 3168 3169 3170 3171

unlock:
	hci_dev_unlock(hdev);
}

3172
static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
3173 3174 3175 3176
{
	struct hci_ev_encrypt_change *ev = (void *) skb->data;
	struct hci_conn *conn;

3177
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
3178 3179 3180

	hci_dev_lock(hdev);

3181
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3182 3183
	if (!conn)
		goto unlock;
L
Linus Torvalds 已提交
3184

3185 3186 3187
	if (!ev->status) {
		if (ev->encrypt) {
			/* Encryption implies authentication */
3188 3189
			set_bit(HCI_CONN_AUTH, &conn->flags);
			set_bit(HCI_CONN_ENCRYPT, &conn->flags);
3190
			conn->sec_level = conn->pending_sec_level;
3191

3192 3193
			/* P-256 authentication key implies FIPS */
			if (conn->key_type == HCI_LK_AUTH_COMBINATION_P256)
3194
				set_bit(HCI_CONN_FIPS, &conn->flags);
3195

3196 3197 3198 3199
			if ((conn->type == ACL_LINK && ev->encrypt == 0x02) ||
			    conn->type == LE_LINK)
				set_bit(HCI_CONN_AES_CCM, &conn->flags);
		} else {
3200
			clear_bit(HCI_CONN_ENCRYPT, &conn->flags);
3201 3202
			clear_bit(HCI_CONN_AES_CCM, &conn->flags);
		}
3203
	}
3204

3205 3206 3207
	/* We should disregard the current RPA and generate a new one
	 * whenever the encryption procedure fails.
	 */
3208
	if (ev->status && conn->type == LE_LINK) {
3209
		hci_dev_set_flag(hdev, HCI_RPA_EXPIRED);
3210 3211
		hci_adv_instances_set_rpa_expired(hdev, true);
	}
3212

3213
	clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
3214

3215 3216 3217 3218
	/* Check link security requirements are met */
	if (!hci_conn_check_link_mode(conn))
		ev->status = HCI_ERROR_AUTH_FAILURE;

3219
	if (ev->status && conn->state == BT_CONNECTED) {
3220 3221 3222
		if (ev->status == HCI_ERROR_PIN_OR_KEY_MISSING)
			set_bit(HCI_CONN_AUTH_FAILURE, &conn->flags);

3223 3224 3225 3226
		/* Notify upper layers so they can cleanup before
		 * disconnecting.
		 */
		hci_encrypt_cfm(conn, ev->status);
3227 3228 3229
		hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
		hci_conn_drop(conn);
		goto unlock;
L
Linus Torvalds 已提交
3230 3231
	}

3232 3233 3234 3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251
	/* 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)) {
3252
			bt_dev_err(hdev, "sending read key size failed");
3253 3254 3255 3256 3257 3258 3259
			conn->enc_key_size = HCI_LINK_KEY_SIZE;
			goto notify;
		}

		goto unlock;
	}

3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278
	/* 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);
	}

3279
notify:
3280
	hci_encrypt_cfm(conn, ev->status);
3281

3282
unlock:
L
Linus Torvalds 已提交
3283 3284 3285
	hci_dev_unlock(hdev);
}

3286 3287
static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
L
Linus Torvalds 已提交
3288
{
3289
	struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
3290
	struct hci_conn *conn;
L
Linus Torvalds 已提交
3291

3292
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
3293 3294 3295

	hci_dev_lock(hdev);

3296
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
3297 3298
	if (conn) {
		if (!ev->status)
3299
			set_bit(HCI_CONN_SECURE, &conn->flags);
L
Linus Torvalds 已提交
3300

3301
		clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
L
Linus Torvalds 已提交
3302 3303 3304 3305 3306 3307 3308

		hci_key_change_cfm(conn, ev->status);
	}

	hci_dev_unlock(hdev);
}

3309 3310
static void hci_remote_features_evt(struct hci_dev *hdev,
				    struct sk_buff *skb)
L
Linus Torvalds 已提交
3311
{
3312 3313 3314
	struct hci_ev_remote_features *ev = (void *) skb->data;
	struct hci_conn *conn;

3315
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3316 3317 3318 3319

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3320 3321
	if (!conn)
		goto unlock;
3322

3323
	if (!ev->status)
3324
		memcpy(conn->features[0], ev->features, 8);
3325 3326 3327 3328

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

3329 3330
	if (!ev->status && lmp_ext_feat_capable(hdev) &&
	    lmp_ext_feat_capable(conn)) {
3331 3332 3333 3334
		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,
3335
			     sizeof(cp), &cp);
3336 3337 3338
		goto unlock;
	}

3339
	if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
3340 3341 3342 3343 3344
		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);
3345
	} else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
3346
		mgmt_device_connected(hdev, conn, NULL, 0);
3347

3348
	if (!hci_outgoing_auth_needed(hdev, conn)) {
3349
		conn->state = BT_CONNECTED;
3350
		hci_connect_cfm(conn, ev->status);
3351
		hci_conn_drop(conn);
3352
	}
3353

3354
unlock:
3355
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
3356 3357
}

3358
static inline void handle_cmd_cnt_and_timer(struct hci_dev *hdev, u8 ncmd)
3359
{
3360
	cancel_delayed_work(&hdev->cmd_timer);
3361 3362 3363 3364 3365 3366 3367 3368 3369 3370 3371 3372

	if (!test_bit(HCI_RESET, &hdev->flags)) {
		if (ncmd) {
			cancel_delayed_work(&hdev->ncmd_timer);
			atomic_set(&hdev->cmd_cnt, 1);
		} else {
			schedule_delayed_work(&hdev->ncmd_timer,
					      HCI_NCMD_TIMEOUT);
		}
	}
}

3373 3374 3375 3376
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)
3377 3378 3379
{
	struct hci_ev_cmd_complete *ev = (void *) skb->data;

3380 3381
	*opcode = __le16_to_cpu(ev->opcode);
	*status = skb->data[sizeof(*ev)];
3382

3383
	skb_pull(skb, sizeof(*ev));
3384

3385
	switch (*opcode) {
3386
	case HCI_OP_INQUIRY_CANCEL:
3387
		hci_cc_inquiry_cancel(hdev, skb, status);
3388 3389
		break;

3390 3391 3392 3393
	case HCI_OP_PERIODIC_INQ:
		hci_cc_periodic_inq(hdev, skb);
		break;

3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404 3405
	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;

3406 3407 3408 3409
	case HCI_OP_READ_LINK_POLICY:
		hci_cc_read_link_policy(hdev, skb);
		break;

3410 3411 3412 3413
	case HCI_OP_WRITE_LINK_POLICY:
		hci_cc_write_link_policy(hdev, skb);
		break;

3414 3415 3416 3417 3418 3419 3420 3421
	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;

3422 3423 3424 3425
	case HCI_OP_RESET:
		hci_cc_reset(hdev, skb);
		break;

3426 3427 3428 3429
	case HCI_OP_READ_STORED_LINK_KEY:
		hci_cc_read_stored_link_key(hdev, skb);
		break;

3430 3431 3432 3433
	case HCI_OP_DELETE_STORED_LINK_KEY:
		hci_cc_delete_stored_link_key(hdev, skb);
		break;

3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453
	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;

3454 3455 3456 3457
	case HCI_OP_SET_EVENT_FLT:
		hci_cc_set_event_filter(hdev, skb);
		break;

3458 3459 3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473
	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;

3474 3475 3476 3477
	case HCI_OP_READ_NUM_SUPPORTED_IAC:
		hci_cc_read_num_supported_iac(hdev, skb);
		break;

3478 3479 3480 3481
	case HCI_OP_WRITE_SSP_MODE:
		hci_cc_write_ssp_mode(hdev, skb);
		break;

3482 3483 3484 3485
	case HCI_OP_WRITE_SC_SUPPORT:
		hci_cc_write_sc_support(hdev, skb);
		break;

3486 3487 3488 3489 3490 3491 3492 3493
	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;

3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505
	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;

3506 3507 3508 3509
	case HCI_OP_READ_LOCAL_EXT_FEATURES:
		hci_cc_read_local_ext_features(hdev, skb);
		break;

3510 3511 3512 3513 3514 3515 3516 3517
	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;

3518 3519 3520 3521
	case HCI_OP_READ_LOCAL_PAIRING_OPTS:
		hci_cc_read_local_pairing_opts(hdev, skb);
		break;

3522 3523 3524 3525
	case HCI_OP_READ_PAGE_SCAN_ACTIVITY:
		hci_cc_read_page_scan_activity(hdev, skb);
		break;

3526 3527 3528 3529
	case HCI_OP_WRITE_PAGE_SCAN_ACTIVITY:
		hci_cc_write_page_scan_activity(hdev, skb);
		break;

3530 3531 3532 3533
	case HCI_OP_READ_PAGE_SCAN_TYPE:
		hci_cc_read_page_scan_type(hdev, skb);
		break;

3534 3535 3536 3537
	case HCI_OP_WRITE_PAGE_SCAN_TYPE:
		hci_cc_write_page_scan_type(hdev, skb);
		break;

3538 3539 3540 3541
	case HCI_OP_READ_DATA_BLOCK_SIZE:
		hci_cc_read_data_block_size(hdev, skb);
		break;

3542 3543 3544 3545
	case HCI_OP_READ_FLOW_CONTROL_MODE:
		hci_cc_read_flow_control_mode(hdev, skb);
		break;

3546 3547 3548 3549
	case HCI_OP_READ_LOCAL_AMP_INFO:
		hci_cc_read_local_amp_info(hdev, skb);
		break;

3550 3551 3552 3553
	case HCI_OP_READ_CLOCK:
		hci_cc_read_clock(hdev, skb);
		break;

3554 3555 3556 3557
	case HCI_OP_READ_INQ_RSP_TX_POWER:
		hci_cc_read_inq_rsp_tx_power(hdev, skb);
		break;

3558 3559 3560 3561 3562 3563 3564 3565
	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;

3566 3567 3568 3569 3570 3571 3572 3573
	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;

3574
	case HCI_OP_READ_LOCAL_OOB_DATA:
3575 3576 3577 3578 3579
		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);
3580 3581
		break;

3582 3583 3584 3585
	case HCI_OP_LE_READ_BUFFER_SIZE:
		hci_cc_le_read_buffer_size(hdev, skb);
		break;

3586 3587 3588 3589
	case HCI_OP_LE_READ_LOCAL_FEATURES:
		hci_cc_le_read_local_features(hdev, skb);
		break;

3590 3591 3592 3593
	case HCI_OP_LE_READ_ADV_TX_POWER:
		hci_cc_le_read_adv_tx_power(hdev, skb);
		break;

3594 3595 3596 3597 3598 3599 3600 3601
	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;

3602 3603 3604 3605 3606 3607
	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);
3608
		break;
3609

3610 3611 3612 3613
	case HCI_OP_LE_SET_RANDOM_ADDR:
		hci_cc_le_set_random_addr(hdev, skb);
		break;

3614 3615 3616 3617
	case HCI_OP_LE_SET_ADV_ENABLE:
		hci_cc_le_set_adv_enable(hdev, skb);
		break;

3618 3619 3620 3621
	case HCI_OP_LE_SET_SCAN_PARAM:
		hci_cc_le_set_scan_param(hdev, skb);
		break;

3622 3623 3624 3625
	case HCI_OP_LE_SET_SCAN_ENABLE:
		hci_cc_le_set_scan_enable(hdev, skb);
		break;

3626 3627
	case HCI_OP_LE_READ_ACCEPT_LIST_SIZE:
		hci_cc_le_read_accept_list_size(hdev, skb);
3628 3629
		break;

3630 3631
	case HCI_OP_LE_CLEAR_ACCEPT_LIST:
		hci_cc_le_clear_accept_list(hdev, skb);
3632 3633
		break;

3634 3635
	case HCI_OP_LE_ADD_TO_ACCEPT_LIST:
		hci_cc_le_add_to_accept_list(hdev, skb);
3636 3637
		break;

3638 3639
	case HCI_OP_LE_DEL_FROM_ACCEPT_LIST:
		hci_cc_le_del_from_accept_list(hdev, skb);
3640 3641
		break;

3642 3643 3644 3645
	case HCI_OP_LE_READ_SUPPORTED_STATES:
		hci_cc_le_read_supported_states(hdev, skb);
		break;

3646 3647 3648 3649 3650 3651 3652 3653
	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;

3654 3655 3656 3657 3658 3659 3660 3661
	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;

3662 3663 3664 3665
	case HCI_OP_LE_CLEAR_RESOLV_LIST:
		hci_cc_le_clear_resolv_list(hdev, skb);
		break;

A
Ankit Navik 已提交
3666 3667 3668 3669
	case HCI_OP_LE_READ_RESOLV_LIST_SIZE:
		hci_cc_le_read_resolv_list_size(hdev, skb);
		break;

3670 3671 3672 3673
	case HCI_OP_LE_SET_ADDR_RESOLV_ENABLE:
		hci_cc_le_set_addr_resolution_enable(hdev, skb);
		break;

3674 3675 3676 3677
	case HCI_OP_LE_READ_MAX_DATA_LEN:
		hci_cc_le_read_max_data_len(hdev, skb);
		break;

3678 3679 3680 3681
	case HCI_OP_WRITE_LE_HOST_SUPPORTED:
		hci_cc_write_le_host_supported(hdev, skb);
		break;

3682 3683 3684 3685
	case HCI_OP_LE_SET_ADV_PARAM:
		hci_cc_set_adv_param(hdev, skb);
		break;

3686 3687 3688 3689
	case HCI_OP_READ_RSSI:
		hci_cc_read_rssi(hdev, skb);
		break;

3690 3691 3692 3693
	case HCI_OP_READ_TX_POWER:
		hci_cc_read_tx_power(hdev, skb);
		break;

3694 3695 3696 3697
	case HCI_OP_WRITE_SSP_DEBUG_MODE:
		hci_cc_write_ssp_debug_mode(hdev, skb);
		break;

3698 3699 3700 3701 3702 3703 3704 3705
	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;

3706 3707 3708 3709
	case HCI_OP_LE_SET_DEFAULT_PHY:
		hci_cc_le_set_default_phy(hdev, skb);
		break;

3710 3711 3712 3713
	case HCI_OP_LE_READ_NUM_SUPPORTED_ADV_SETS:
		hci_cc_le_read_num_adv_sets(hdev, skb);
		break;

3714 3715 3716 3717 3718 3719 3720 3721
	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;

3722 3723 3724 3725
	case HCI_OP_LE_SET_ADV_SET_RAND_ADDR:
		hci_cc_le_set_adv_set_random_addr(hdev, skb);
		break;

3726 3727 3728 3729
	case HCI_OP_LE_READ_TRANSMIT_POWER:
		hci_cc_le_read_transmit_power(hdev, skb);
		break;

3730
	default:
3731
		BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
3732 3733 3734
		break;
	}

3735
	handle_cmd_cnt_and_timer(hdev, ev->ncmd);
3736

3737 3738
	hci_req_cmd_complete(hdev, *opcode, *status, req_complete,
			     req_complete_skb);
3739

3740 3741 3742 3743 3744 3745
	if (hci_dev_test_flag(hdev, HCI_CMD_PENDING)) {
		bt_dev_err(hdev,
			   "unexpected event for opcode 0x%4.4x", *opcode);
		return;
	}

3746 3747
	if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
		queue_work(hdev->workqueue, &hdev->cmd_work);
3748 3749
}

3750 3751 3752 3753
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)
3754 3755 3756 3757 3758
{
	struct hci_ev_cmd_status *ev = (void *) skb->data;

	skb_pull(skb, sizeof(*ev));

3759 3760
	*opcode = __le16_to_cpu(ev->opcode);
	*status = ev->status;
3761

3762
	switch (*opcode) {
3763 3764 3765 3766 3767 3768 3769 3770
	case HCI_OP_INQUIRY:
		hci_cs_inquiry(hdev, ev->status);
		break;

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

3771 3772 3773 3774
	case HCI_OP_DISCONNECT:
		hci_cs_disconnect(hdev, ev->status);
		break;

3775 3776 3777 3778
	case HCI_OP_ADD_SCO:
		hci_cs_add_sco(hdev, ev->status);
		break;

3779 3780 3781 3782 3783 3784 3785 3786
	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;

3787 3788 3789 3790
	case HCI_OP_REMOTE_NAME_REQ:
		hci_cs_remote_name_req(hdev, ev->status);
		break;

3791 3792 3793 3794 3795 3796 3797 3798
	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;

3799 3800 3801 3802
	case HCI_OP_SETUP_SYNC_CONN:
		hci_cs_setup_sync_conn(hdev, ev->status);
		break;

3803 3804 3805 3806
	case HCI_OP_ENHANCED_SETUP_SYNC_CONN:
		hci_cs_enhanced_setup_sync_conn(hdev, ev->status);
		break;

3807 3808 3809 3810 3811 3812 3813 3814
	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;

3815 3816 3817 3818
	case HCI_OP_SWITCH_ROLE:
		hci_cs_switch_role(hdev, ev->status);
		break;

3819 3820 3821 3822
	case HCI_OP_LE_CREATE_CONN:
		hci_cs_le_create_conn(hdev, ev->status);
		break;

3823 3824 3825 3826
	case HCI_OP_LE_READ_REMOTE_FEATURES:
		hci_cs_le_read_remote_features(hdev, ev->status);
		break;

3827 3828 3829 3830
	case HCI_OP_LE_START_ENC:
		hci_cs_le_start_enc(hdev, ev->status);
		break;

3831 3832 3833 3834
	case HCI_OP_LE_EXT_CREATE_CONN:
		hci_cs_le_ext_create_conn(hdev, ev->status);
		break;

3835
	default:
3836
		BT_DBG("%s opcode 0x%4.4x", hdev->name, *opcode);
3837 3838 3839
		break;
	}

3840
	handle_cmd_cnt_and_timer(hdev, ev->ncmd);
3841

3842 3843 3844 3845 3846 3847
	/* 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).
	 */
3848
	if (ev->status ||
3849
	    (hdev->sent_cmd && !bt_cb(hdev->sent_cmd)->hci.req_event))
3850 3851
		hci_req_cmd_complete(hdev, *opcode, ev->status, req_complete,
				     req_complete_skb);
3852

3853 3854 3855 3856 3857 3858
	if (hci_dev_test_flag(hdev, HCI_CMD_PENDING)) {
		bt_dev_err(hdev,
			   "unexpected event for opcode 0x%4.4x", *opcode);
		return;
	}

3859 3860
	if (atomic_read(&hdev->cmd_cnt) && !skb_queue_empty(&hdev->cmd_q))
		queue_work(hdev->workqueue, &hdev->cmd_work);
3861 3862
}

3863 3864 3865 3866
static void hci_hardware_error_evt(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_ev_hardware_error *ev = (void *) skb->data;

3867 3868 3869
	hdev->hw_error_code = ev->code;

	queue_work(hdev->req_workqueue, &hdev->error_reset);
3870 3871
}

3872
static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
3873 3874 3875 3876
{
	struct hci_ev_role_change *ev = (void *) skb->data;
	struct hci_conn *conn;

3877
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3878 3879 3880 3881 3882

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (conn) {
3883 3884
		if (!ev->status)
			conn->role = ev->role;
3885

3886
		clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
3887 3888 3889 3890 3891 3892 3893

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

	hci_dev_unlock(hdev);
}

3894
static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
3895 3896 3897 3898
{
	struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
	int i;

3899
	if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
3900
		bt_dev_err(hdev, "wrong event for mode %d", hdev->flow_ctl_mode);
3901 3902 3903
		return;
	}

3904 3905
	if (skb->len < sizeof(*ev) ||
	    skb->len < struct_size(ev, handles, ev->num_hndl)) {
3906 3907 3908 3909
		BT_DBG("%s bad parameters", hdev->name);
		return;
	}

3910 3911
	BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);

3912 3913
	for (i = 0; i < ev->num_hndl; i++) {
		struct hci_comp_pkts_info *info = &ev->handles[i];
3914 3915 3916
		struct hci_conn *conn;
		__u16  handle, count;

3917 3918
		handle = __le16_to_cpu(info->handle);
		count  = __le16_to_cpu(info->count);
3919 3920

		conn = hci_conn_hash_lookup_handle(hdev, handle);
3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938
		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 已提交
3939 3940
				hdev->acl_cnt += count;
				if (hdev->acl_cnt > hdev->acl_pkts)
3941 3942
					hdev->acl_cnt = hdev->acl_pkts;
			}
3943 3944 3945 3946 3947 3948 3949 3950 3951
			break;

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

		default:
3952 3953
			bt_dev_err(hdev, "unknown type %d conn %p",
				   conn->type, conn);
3954
			break;
3955 3956 3957
		}
	}

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

3961 3962 3963 3964 3965 3966
static struct hci_conn *__hci_conn_lookup_handle(struct hci_dev *hdev,
						 __u16 handle)
{
	struct hci_chan *chan;

	switch (hdev->dev_type) {
3967
	case HCI_PRIMARY:
3968 3969 3970 3971 3972 3973 3974
		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:
3975
		bt_dev_err(hdev, "unknown dev_type %d", hdev->dev_type);
3976 3977 3978 3979 3980 3981
		break;
	}

	return NULL;
}

3982
static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
3983 3984 3985 3986 3987
{
	struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
	int i;

	if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
3988
		bt_dev_err(hdev, "wrong event for mode %d", hdev->flow_ctl_mode);
3989 3990 3991
		return;
	}

3992 3993
	if (skb->len < sizeof(*ev) ||
	    skb->len < struct_size(ev, handles, ev->num_hndl)) {
3994 3995 3996 3997 3998
		BT_DBG("%s bad parameters", hdev->name);
		return;
	}

	BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
3999
	       ev->num_hndl);
4000 4001 4002

	for (i = 0; i < ev->num_hndl; i++) {
		struct hci_comp_blocks_info *info = &ev->handles[i];
4003
		struct hci_conn *conn = NULL;
4004 4005 4006 4007 4008
		__u16  handle, block_count;

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

4009
		conn = __hci_conn_lookup_handle(hdev, handle);
4010 4011 4012 4013 4014 4015 4016
		if (!conn)
			continue;

		conn->sent -= block_count;

		switch (conn->type) {
		case ACL_LINK:
4017
		case AMP_LINK:
4018 4019 4020 4021 4022 4023
			hdev->block_cnt += block_count;
			if (hdev->block_cnt > hdev->num_blocks)
				hdev->block_cnt = hdev->num_blocks;
			break;

		default:
4024 4025
			bt_dev_err(hdev, "unknown type %d conn %p",
				   conn->type, conn);
4026 4027 4028 4029 4030 4031 4032
			break;
		}
	}

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

4033
static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
4034
{
4035
	struct hci_ev_mode_change *ev = (void *) skb->data;
4036 4037
	struct hci_conn *conn;

4038
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4039 4040 4041 4042

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4043 4044 4045
	if (conn) {
		conn->mode = ev->mode;

4046 4047
		if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
					&conn->flags)) {
4048
			if (conn->mode == HCI_CM_ACTIVE)
4049
				set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
4050
			else
4051
				clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
4052
		}
4053

4054
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
4055
			hci_sco_setup(conn, ev->status);
4056 4057 4058 4059 4060
	}

	hci_dev_unlock(hdev);
}

4061
static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
4062
{
4063 4064 4065
	struct hci_ev_pin_code_req *ev = (void *) skb->data;
	struct hci_conn *conn;

4066
	BT_DBG("%s", hdev->name);
4067 4068 4069 4070

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4071 4072 4073 4074
	if (!conn)
		goto unlock;

	if (conn->state == BT_CONNECTED) {
4075 4076
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_PAIRING_TIMEOUT;
4077
		hci_conn_drop(conn);
4078 4079
	}

4080
	if (!hci_dev_test_flag(hdev, HCI_BONDABLE) &&
4081
	    !test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags)) {
4082
		hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
4083
			     sizeof(ev->bdaddr), &ev->bdaddr);
4084
	} else if (hci_dev_test_flag(hdev, HCI_MGMT)) {
4085 4086 4087 4088 4089 4090 4091
		u8 secure;

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

4092
		mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
4093
	}
4094

4095
unlock:
4096
	hci_dev_unlock(hdev);
4097 4098
}

4099 4100 4101 4102 4103 4104 4105 4106 4107 4108 4109 4110 4111 4112 4113 4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125 4126 4127 4128 4129 4130
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;
	}
}

4131
static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
4132
{
4133 4134 4135 4136 4137
	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;

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

4140
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4141 4142 4143 4144 4145 4146
		return;

	hci_dev_lock(hdev);

	key = hci_find_link_key(hdev, &ev->bdaddr);
	if (!key) {
4147 4148
		BT_DBG("%s link key not found for %pMR", hdev->name,
		       &ev->bdaddr);
4149 4150 4151
		goto not_found;
	}

4152 4153
	BT_DBG("%s found key type %u for %pMR", hdev->name, key->type,
	       &ev->bdaddr);
4154 4155

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4156
	if (conn) {
4157 4158
		clear_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);

4159 4160
		if ((key->type == HCI_LK_UNAUTH_COMBINATION_P192 ||
		     key->type == HCI_LK_UNAUTH_COMBINATION_P256) &&
4161
		    conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
4162 4163 4164
			BT_DBG("%s ignoring unauthenticated key", hdev->name);
			goto not_found;
		}
4165

4166
		if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
4167 4168
		    (conn->pending_sec_level == BT_SECURITY_HIGH ||
		     conn->pending_sec_level == BT_SECURITY_FIPS)) {
4169 4170
			BT_DBG("%s ignoring key unauthenticated for high security",
			       hdev->name);
4171 4172 4173
			goto not_found;
		}

4174
		conn_set_key(conn, key->type, key->pin_len);
4175 4176 4177
	}

	bacpy(&cp.bdaddr, &ev->bdaddr);
4178
	memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
4179 4180 4181 4182 4183 4184 4185 4186 4187 4188

	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);
4189 4190
}

4191
static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
4192
{
4193 4194
	struct hci_ev_link_key_notify *ev = (void *) skb->data;
	struct hci_conn *conn;
4195 4196
	struct link_key *key;
	bool persistent;
4197
	u8 pin_len = 0;
4198

4199
	BT_DBG("%s", hdev->name);
4200 4201 4202 4203

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
4204 4205 4206 4207 4208 4209 4210
	if (!conn)
		goto unlock;

	hci_conn_hold(conn);
	conn->disc_timeout = HCI_DISCONN_TIMEOUT;
	hci_conn_drop(conn);

4211
	set_bit(HCI_CONN_NEW_LINK_KEY, &conn->flags);
4212
	conn_set_key(conn, ev->key_type, conn->pin_length);
4213

4214
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4215 4216 4217 4218 4219 4220 4221
		goto unlock;

	key = hci_add_link_key(hdev, conn, &ev->bdaddr, ev->link_key,
			        ev->key_type, pin_len, &persistent);
	if (!key)
		goto unlock;

4222 4223 4224 4225 4226 4227
	/* 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);

4228
	mgmt_new_link_key(hdev, key, persistent);
4229

4230 4231 4232 4233 4234 4235
	/* 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 &&
4236
	    !hci_dev_test_flag(hdev, HCI_KEEP_DEBUG_KEYS)) {
4237 4238
		list_del_rcu(&key->list);
		kfree_rcu(key, rcu);
4239
		goto unlock;
4240
	}
4241

4242 4243 4244 4245 4246
	if (persistent)
		clear_bit(HCI_CONN_FLUSH_KEY, &conn->flags);
	else
		set_bit(HCI_CONN_FLUSH_KEY, &conn->flags);

4247
unlock:
4248
	hci_dev_unlock(hdev);
4249 4250
}

4251
static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
4252
{
4253
	struct hci_ev_clock_offset *ev = (void *) skb->data;
4254
	struct hci_conn *conn;
L
Linus Torvalds 已提交
4255

4256
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
4257 4258 4259

	hci_dev_lock(hdev);

4260
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
4261 4262 4263
	if (conn && !ev->status) {
		struct inquiry_entry *ie;

4264 4265
		ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
		if (ie) {
L
Linus Torvalds 已提交
4266 4267 4268 4269 4270 4271 4272 4273
			ie->data.clock_offset = ev->clock_offset;
			ie->timestamp = jiffies;
		}
	}

	hci_dev_unlock(hdev);
}

4274
static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
4275 4276 4277 4278
{
	struct hci_ev_pkt_type_change *ev = (void *) skb->data;
	struct hci_conn *conn;

4279
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4280 4281 4282 4283 4284 4285 4286 4287 4288 4289

	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);
}

4290
static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
4291
{
4292
	struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
4293 4294 4295 4296 4297 4298
	struct inquiry_entry *ie;

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

	hci_dev_lock(hdev);

4299 4300
	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie) {
4301 4302 4303 4304 4305 4306 4307
		ie->data.pscan_rep_mode = ev->pscan_rep_mode;
		ie->timestamp = jiffies;
	}

	hci_dev_unlock(hdev);
}

4308 4309
static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
4310 4311 4312 4313 4314 4315 4316 4317 4318
{
	struct inquiry_data data;
	int num_rsp = *((__u8 *) skb->data);

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

	if (!num_rsp)
		return;

4319
	if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
4320 4321
		return;

4322 4323 4324
	hci_dev_lock(hdev);

	if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
4325 4326
		struct inquiry_info_with_rssi_and_pscan_mode *info;
		info = (void *) (skb->data + 1);
4327

4328 4329 4330
		if (skb->len < num_rsp * sizeof(*info) + 1)
			goto unlock;

4331
		for (; num_rsp; num_rsp--, info++) {
4332 4333
			u32 flags;

4334 4335 4336 4337 4338 4339 4340
			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;
4341
			data.ssp_mode		= 0x00;
4342

4343 4344
			flags = hci_inquiry_cache_update(hdev, &data, false);

4345
			mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
4346
					  info->dev_class, info->rssi,
4347
					  flags, NULL, 0, NULL, 0);
4348 4349 4350 4351
		}
	} else {
		struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);

4352 4353 4354
		if (skb->len < num_rsp * sizeof(*info) + 1)
			goto unlock;

4355
		for (; num_rsp; num_rsp--, info++) {
4356 4357
			u32 flags;

4358 4359 4360 4361 4362 4363 4364
			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;
4365
			data.ssp_mode		= 0x00;
4366 4367 4368

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

4369
			mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
4370
					  info->dev_class, info->rssi,
4371
					  flags, NULL, 0, NULL, 0);
4372 4373 4374
		}
	}

4375
unlock:
4376 4377 4378
	hci_dev_unlock(hdev);
}

4379 4380
static void hci_remote_ext_features_evt(struct hci_dev *hdev,
					struct sk_buff *skb)
4381
{
4382 4383 4384
	struct hci_ev_remote_ext_features *ev = (void *) skb->data;
	struct hci_conn *conn;

4385
	BT_DBG("%s", hdev->name);
4386 4387 4388 4389

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
4390 4391
	if (!conn)
		goto unlock;
4392

4393 4394 4395
	if (ev->page < HCI_MAX_PAGES)
		memcpy(conn->features[ev->page], ev->features, 8);

4396 4397
	if (!ev->status && ev->page == 0x01) {
		struct inquiry_entry *ie;
4398

4399 4400
		ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
		if (ie)
4401
			ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
4402

4403
		if (ev->features[0] & LMP_HOST_SSP) {
4404
			set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415
		} 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);
		}
4416 4417 4418

		if (ev->features[0] & LMP_HOST_SC)
			set_bit(HCI_CONN_SC_ENABLED, &conn->flags);
4419 4420 4421 4422 4423
	}

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

4424
	if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
4425 4426 4427 4428 4429
		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);
4430
	} else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
4431
		mgmt_device_connected(hdev, conn, NULL, 0);
4432

4433
	if (!hci_outgoing_auth_needed(hdev, conn)) {
4434
		conn->state = BT_CONNECTED;
4435
		hci_connect_cfm(conn, ev->status);
4436
		hci_conn_drop(conn);
4437 4438
	}

4439
unlock:
4440
	hci_dev_unlock(hdev);
4441 4442
}

4443 4444
static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
				       struct sk_buff *skb)
4445
{
4446 4447
	struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
	struct hci_conn *conn;
4448
	unsigned int notify_evt;
4449

4450
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
4451 4452 4453 4454

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
4455 4456 4457 4458
	if (!conn) {
		if (ev->link_type == ESCO_LINK)
			goto unlock;

4459 4460 4461 4462 4463 4464 4465 4466 4467
		/* 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.
		 */
4468 4469 4470 4471
		conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
		if (!conn)
			goto unlock;
	}
4472

4473 4474
	switch (ev->status) {
	case 0x00:
4475 4476 4477 4478 4479 4480 4481 4482 4483 4484 4485 4486 4487 4488 4489
		/* The synchronous connection complete event should only be
		 * sent once per new connection. Receiving a successful
		 * complete event when the connection status is already
		 * BT_CONNECTED means that the device is misbehaving and sent
		 * multiple complete event packets for the same new connection.
		 *
		 * Registering the device more than once can corrupt kernel
		 * memory, hence upon detecting this invalid event, we report
		 * an error and ignore the packet.
		 */
		if (conn->state == BT_CONNECTED) {
			bt_dev_err(hdev, "Ignoring connect complete event for existing connection");
			goto unlock;
		}

4490 4491
		conn->handle = __le16_to_cpu(ev->handle);
		conn->state  = BT_CONNECTED;
4492
		conn->type   = ev->link_type;
4493

4494
		hci_debugfs_create_conn(conn);
4495
		hci_conn_add_sysfs(conn);
4496 4497
		break;

4498
	case 0x10:	/* Connection Accept Timeout */
4499
	case 0x0d:	/* Connection Rejected due to Limited Resources */
4500
	case 0x11:	/* Unsupported Feature or Parameter Value */
4501
	case 0x1c:	/* SCO interval rejected */
4502
	case 0x1a:	/* Unsupported Remote Feature */
4503
	case 0x1e:	/* Invalid LMP Parameters */
4504
	case 0x1f:	/* Unspecified error */
4505
	case 0x20:	/* Unsupported LMP Parameter value */
4506
		if (conn->out) {
4507 4508
			conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
					(hdev->esco_type & EDR_ESCO_MASK);
4509 4510
			if (hci_setup_sync(conn, conn->link->handle))
				goto unlock;
4511
		}
4512
		fallthrough;
4513 4514

	default:
4515
		conn->state = BT_CLOSED;
4516 4517
		break;
	}
4518

4519 4520
	bt_dev_dbg(hdev, "SCO connected with air mode: %02x", ev->air_mode);

4521 4522
	switch (ev->air_mode) {
	case 0x02:
4523
		notify_evt = HCI_NOTIFY_ENABLE_SCO_CVSD;
4524
		break;
4525
	case 0x03:
4526
		notify_evt = HCI_NOTIFY_ENABLE_SCO_TRANSP;
4527 4528 4529
		break;
	}

4530 4531 4532 4533 4534 4535 4536 4537
	/* Notify only in case of SCO over HCI transport data path which
	 * is zero and non-zero value shall be non-HCI transport data path
	 */
	if (conn->codec.data_path == 0) {
		if (hdev->notify)
			hdev->notify(hdev, notify_evt);
	}

4538
	hci_connect_cfm(conn, ev->status);
4539 4540 4541 4542 4543
	if (ev->status)
		hci_conn_del(conn);

unlock:
	hci_dev_unlock(hdev);
4544 4545
}

4546 4547 4548 4549 4550 4551 4552 4553 4554 4555 4556 4557 4558 4559 4560 4561 4562
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;
}

4563 4564
static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
L
Linus Torvalds 已提交
4565
{
4566 4567 4568
	struct inquiry_data data;
	struct extended_inquiry_info *info = (void *) (skb->data + 1);
	int num_rsp = *((__u8 *) skb->data);
4569
	size_t eir_len;
L
Linus Torvalds 已提交
4570

4571
	BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
L
Linus Torvalds 已提交
4572

4573
	if (!num_rsp || skb->len < num_rsp * sizeof(*info) + 1)
4574
		return;
L
Linus Torvalds 已提交
4575

4576
	if (hci_dev_test_flag(hdev, HCI_PERIODIC_INQ))
4577 4578
		return;

4579 4580
	hci_dev_lock(hdev);

4581
	for (; num_rsp; num_rsp--, info++) {
4582 4583
		u32 flags;
		bool name_known;
4584

4585
		bacpy(&data.bdaddr, &info->bdaddr);
4586 4587 4588
		data.pscan_rep_mode	= info->pscan_rep_mode;
		data.pscan_period_mode	= info->pscan_period_mode;
		data.pscan_mode		= 0x00;
4589
		memcpy(data.dev_class, info->dev_class, 3);
4590 4591
		data.clock_offset	= info->clock_offset;
		data.rssi		= info->rssi;
4592
		data.ssp_mode		= 0x01;
4593

4594
		if (hci_dev_test_flag(hdev, HCI_MGMT))
4595 4596 4597
			name_known = eir_get_data(info->data,
						  sizeof(info->data),
						  EIR_NAME_COMPLETE, NULL);
4598 4599 4600
		else
			name_known = true;

4601 4602
		flags = hci_inquiry_cache_update(hdev, &data, name_known);

4603
		eir_len = eir_get_length(info->data, sizeof(info->data));
4604

4605
		mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
4606 4607
				  info->dev_class, info->rssi,
				  flags, info->data, eir_len, NULL, 0);
4608 4609 4610 4611
	}

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

4613 4614 4615 4616 4617 4618
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;

4619
	BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
4620 4621 4622 4623 4624 4625 4626 4627
	       __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;

4628 4629 4630 4631 4632 4633
	/* For BR/EDR the necessary steps are taken through the
	 * auth_complete event.
	 */
	if (conn->type != LE_LINK)
		goto unlock;

4634 4635 4636 4637 4638 4639
	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 已提交
4640
		hci_disconnect(conn, HCI_ERROR_AUTH_FAILURE);
4641
		hci_conn_drop(conn);
4642 4643 4644 4645 4646 4647 4648
		goto unlock;
	}

	if (conn->state == BT_CONFIG) {
		if (!ev->status)
			conn->state = BT_CONNECTED;

4649
		hci_connect_cfm(conn, ev->status);
4650
		hci_conn_drop(conn);
4651 4652 4653 4654 4655
	} else {
		hci_auth_cfm(conn, ev->status);

		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
4656
		hci_conn_drop(conn);
4657 4658 4659 4660 4661 4662
	}

unlock:
	hci_dev_unlock(hdev);
}

4663
static u8 hci_get_auth_req(struct hci_conn *conn)
4664 4665
{
	/* If remote requests no-bonding follow that lead */
4666 4667
	if (conn->remote_auth == HCI_AT_NO_BONDING ||
	    conn->remote_auth == HCI_AT_NO_BONDING_MITM)
4668
		return conn->remote_auth | (conn->auth_type & 0x01);
4669

4670 4671 4672 4673 4674 4675 4676
	/* 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;

4677 4678
	/* No MITM protection possible so ignore remote requirement */
	return (conn->remote_auth & ~0x01) | (conn->auth_type & 0x01);
4679 4680
}

4681 4682 4683 4684 4685 4686 4687 4688 4689
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;

4690 4691 4692 4693 4694 4695 4696 4697 4698
	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;
4699

4700 4701 4702 4703
		/* 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.
4704
		 */
4705 4706
		if (!memcmp(data->rand256, ZERO_KEY, 16) ||
		    !memcmp(data->hash256, ZERO_KEY, 16))
4707 4708
			return 0x00;

4709
		return 0x02;
4710
	}
4711

4712 4713 4714 4715 4716 4717 4718 4719 4720
	/* 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;
4721 4722
}

4723
static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
4724 4725 4726 4727 4728 4729 4730 4731 4732
{
	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);
4733 4734 4735 4736 4737
	if (!conn)
		goto unlock;

	hci_conn_hold(conn);

4738
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4739 4740
		goto unlock;

4741 4742 4743
	/* Allow pairing if we're pairable, the initiators of the
	 * pairing or if the remote is not requesting bonding.
	 */
4744
	if (hci_dev_test_flag(hdev, HCI_BONDABLE) ||
4745
	    test_bit(HCI_CONN_AUTH_INITIATOR, &conn->flags) ||
4746
	    (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
4747 4748 4749
		struct hci_cp_io_capability_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
4750 4751 4752
		/* Change the IO capability from KeyboardDisplay
		 * to DisplayYesNo as it is not supported by BT spec. */
		cp.capability = (conn->io_capability == 0x04) ?
4753
				HCI_IO_DISPLAY_YESNO : conn->io_capability;
4754 4755 4756

		/* If we are initiators, there is no remote information yet */
		if (conn->remote_auth == 0xff) {
4757
			/* Request MITM protection if our IO caps allow it
4758
			 * except for the no-bonding case.
4759
			 */
4760
			if (conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
4761
			    conn->auth_type != HCI_AT_NO_BONDING)
4762
				conn->auth_type |= 0x01;
4763 4764 4765
		} else {
			conn->auth_type = hci_get_auth_req(conn);
		}
4766

4767 4768 4769
		/* If we're not bondable, force one of the non-bondable
		 * authentication requirement values.
		 */
4770
		if (!hci_dev_test_flag(hdev, HCI_BONDABLE))
4771 4772 4773
			conn->auth_type &= HCI_AT_NO_BONDING_MITM;

		cp.authentication = conn->auth_type;
4774
		cp.oob_data = bredr_oob_data_present(conn);
4775

4776
		hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
4777
			     sizeof(cp), &cp);
4778 4779 4780 4781
	} else {
		struct hci_cp_io_capability_neg_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
4782
		cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
4783

4784
		hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
4785
			     sizeof(cp), &cp);
4786 4787 4788 4789 4790 4791
	}

unlock:
	hci_dev_unlock(hdev);
}

4792
static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
4793 4794 4795 4796 4797 4798 4799 4800 4801 4802 4803 4804 4805 4806 4807 4808
{
	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:
4809 4810 4811
	hci_dev_unlock(hdev);
}

4812 4813
static void hci_user_confirm_request_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4814 4815
{
	struct hci_ev_user_confirm_req *ev = (void *) skb->data;
4816
	int loc_mitm, rem_mitm, confirm_hint = 0;
4817
	struct hci_conn *conn;
4818 4819 4820 4821 4822

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

	hci_dev_lock(hdev);

4823
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
4824
		goto unlock;
4825

4826 4827 4828 4829 4830 4831 4832 4833
	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
4834 4835 4836
	 * (it has NoInputNoOutput) then reject the confirmation
	 * request. We check the security level here since it doesn't
	 * necessarily match conn->auth_type.
4837
	 */
4838 4839
	if (conn->pending_sec_level > BT_SECURITY_MEDIUM &&
	    conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) {
4840 4841
		BT_DBG("Rejecting request: remote device can't provide MITM");
		hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
4842
			     sizeof(ev->bdaddr), &ev->bdaddr);
4843 4844 4845 4846
		goto unlock;
	}

	/* If no side requires MITM protection; auto-accept */
4847 4848
	if ((!loc_mitm || conn->remote_cap == HCI_IO_NO_INPUT_OUTPUT) &&
	    (!rem_mitm || conn->io_capability == HCI_IO_NO_INPUT_OUTPUT)) {
4849 4850 4851

		/* If we're not the initiators request authorization to
		 * proceed from user space (mgmt_user_confirm with
4852
		 * confirm_hint set to 1). The exception is if neither
4853 4854
		 * side had MITM or if the local IO capability is
		 * NoInputNoOutput, in which case we do auto-accept
4855 4856
		 */
		if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) &&
4857
		    conn->io_capability != HCI_IO_NO_INPUT_OUTPUT &&
4858
		    (loc_mitm || rem_mitm)) {
4859 4860 4861 4862 4863
			BT_DBG("Confirming auto-accept as acceptor");
			confirm_hint = 1;
			goto confirm;
		}

4864 4865 4866 4867 4868 4869 4870 4871 4872 4873
		/* 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;
		}

4874
		BT_DBG("Auto-accept of user confirmation with %ums delay",
4875
		       hdev->auto_accept_delay);
4876 4877 4878

		if (hdev->auto_accept_delay > 0) {
			int delay = msecs_to_jiffies(hdev->auto_accept_delay);
4879 4880
			queue_delayed_work(conn->hdev->workqueue,
					   &conn->auto_accept_work, delay);
4881 4882 4883
			goto unlock;
		}

4884
		hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
4885
			     sizeof(ev->bdaddr), &ev->bdaddr);
4886 4887 4888
		goto unlock;
	}

4889
confirm:
4890 4891
	mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0,
				  le32_to_cpu(ev->passkey), confirm_hint);
4892 4893

unlock:
4894 4895 4896
	hci_dev_unlock(hdev);
}

4897 4898
static void hci_user_passkey_request_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4899 4900 4901 4902 4903
{
	struct hci_ev_user_passkey_req *ev = (void *) skb->data;

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

4904
	if (hci_dev_test_flag(hdev, HCI_MGMT))
4905
		mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
4906 4907
}

4908 4909 4910 4911 4912 4913 4914 4915 4916 4917 4918 4919 4920 4921 4922
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;

4923
	if (hci_dev_test_flag(hdev, HCI_MGMT))
4924 4925 4926 4927 4928 4929 4930 4931 4932 4933 4934 4935 4936 4937 4938 4939 4940 4941 4942 4943 4944 4945 4946 4947 4948 4949 4950 4951 4952 4953 4954 4955 4956 4957 4958 4959 4960
		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;
	}

4961
	if (hci_dev_test_flag(hdev, HCI_MGMT))
4962 4963 4964 4965 4966
		mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
					 conn->dst_type, conn->passkey_notify,
					 conn->passkey_entered);
}

4967 4968
static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
4969 4970 4971 4972 4973 4974 4975 4976 4977
{
	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);
4978 4979 4980
	if (!conn)
		goto unlock;

4981 4982 4983
	/* Reset the authentication requirement to unknown */
	conn->remote_auth = 0xff;

4984 4985 4986 4987 4988
	/* 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 */
4989
	if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
4990
		mgmt_auth_failed(conn, ev->status);
4991

4992
	hci_conn_drop(conn);
4993 4994

unlock:
4995 4996 4997
	hci_dev_unlock(hdev);
}

4998 4999
static void hci_remote_host_features_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
5000 5001 5002
{
	struct hci_ev_remote_host_features *ev = (void *) skb->data;
	struct inquiry_entry *ie;
5003
	struct hci_conn *conn;
5004 5005 5006 5007 5008

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

	hci_dev_lock(hdev);

5009 5010 5011 5012
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (conn)
		memcpy(conn->features[1], ev->features, 8);

5013 5014
	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie)
5015
		ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
5016 5017 5018 5019

	hci_dev_unlock(hdev);
}

5020 5021
static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
5022 5023 5024 5025 5026 5027 5028 5029
{
	struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
	struct oob_data *data;

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

	hci_dev_lock(hdev);

5030
	if (!hci_dev_test_flag(hdev, HCI_MGMT))
5031 5032
		goto unlock;

5033
	data = hci_find_remote_oob_data(hdev, &ev->bdaddr, BDADDR_BREDR);
5034 5035
	if (!data) {
		struct hci_cp_remote_oob_data_neg_reply cp;
5036

5037 5038 5039 5040 5041
		bacpy(&cp.bdaddr, &ev->bdaddr);
		hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY,
			     sizeof(cp), &cp);
		goto unlock;
	}
5042

5043 5044
	if (bredr_sc_enabled(hdev)) {
		struct hci_cp_remote_oob_ext_data_reply cp;
5045

5046
		bacpy(&cp.bdaddr, &ev->bdaddr);
5047
		if (hci_dev_test_flag(hdev, HCI_SC_ONLY)) {
5048 5049 5050 5051 5052
			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));
5053
		}
5054 5055 5056 5057 5058
		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);
5059
	} else {
5060
		struct hci_cp_remote_oob_data_reply cp;
5061 5062

		bacpy(&cp.bdaddr, &ev->bdaddr);
5063 5064 5065 5066
		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,
5067
			     sizeof(cp), &cp);
5068 5069
	}

5070
unlock:
5071 5072 5073
	hci_dev_unlock(hdev);
}

5074 5075 5076 5077 5078 5079 5080 5081 5082 5083 5084 5085 5086 5087 5088 5089 5090
#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);
}

5091 5092 5093 5094 5095 5096 5097 5098 5099 5100 5101 5102
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);
5103 5104
	if (!hcon)
		goto unlock;
5105

5106 5107
	if (!hcon->amp_mgr)
		goto unlock;
5108

5109 5110
	if (ev->status) {
		hci_conn_del(hcon);
5111
		goto unlock;
5112 5113 5114 5115 5116 5117 5118 5119 5120
	}

	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;
5121
	hci_conn_drop(hcon);
5122

5123
	hci_debugfs_create_conn(hcon);
5124 5125
	hci_conn_add_sysfs(hcon);

5126
	amp_physical_cfm(bredr_hcon, hcon);
5127

5128
unlock:
5129
	hci_dev_unlock(hdev);
5130 5131
}

5132 5133 5134 5135 5136 5137 5138 5139 5140 5141 5142 5143 5144 5145 5146 5147 5148 5149 5150 5151 5152
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);
5153
	hchan->amp = true;
5154 5155 5156 5157 5158 5159 5160 5161 5162 5163 5164 5165 5166 5167 5168 5169 5170

	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);
	}
}

5171 5172 5173 5174 5175 5176 5177 5178 5179 5180 5181 5182 5183 5184 5185
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));
5186
	if (!hchan || !hchan->amp)
5187 5188 5189 5190 5191 5192 5193 5194
		goto unlock;

	amp_destroy_logical_link(hchan, ev->reason);

unlock:
	hci_dev_unlock(hdev);
}

5195 5196 5197 5198 5199 5200 5201 5202 5203 5204 5205 5206 5207 5208 5209 5210 5211 5212 5213 5214 5215
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);
}
5216
#endif
5217

5218 5219 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 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 le_conn_update_addr(struct hci_conn *conn, bdaddr_t *bdaddr,
				u8 bdaddr_type, bdaddr_t *local_rpa)
{
	if (conn->out) {
		conn->dst_type = bdaddr_type;
		conn->resp_addr_type = bdaddr_type;
		bacpy(&conn->resp_addr, bdaddr);

		/* Check if the controller has set a Local RPA then it must be
		 * used instead or hdev->rpa.
		 */
		if (local_rpa && bacmp(local_rpa, BDADDR_ANY)) {
			conn->init_addr_type = ADDR_LE_DEV_RANDOM;
			bacpy(&conn->init_addr, local_rpa);
		} else if (hci_dev_test_flag(conn->hdev, HCI_PRIVACY)) {
			conn->init_addr_type = ADDR_LE_DEV_RANDOM;
			bacpy(&conn->init_addr, &conn->hdev->rpa);
		} else {
			hci_copy_identity_address(conn->hdev, &conn->init_addr,
						  &conn->init_addr_type);
		}
	} else {
		conn->resp_addr_type = conn->hdev->adv_addr_type;
		/* Check if the controller has set a Local RPA then it must be
		 * used instead or hdev->rpa.
		 */
		if (local_rpa && bacmp(local_rpa, BDADDR_ANY)) {
			conn->resp_addr_type = ADDR_LE_DEV_RANDOM;
			bacpy(&conn->resp_addr, local_rpa);
		} else if (conn->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(conn->hdev))
				bacpy(&conn->resp_addr,
				      &conn->hdev->random_addr);
		} else {
			bacpy(&conn->resp_addr, &conn->hdev->bdaddr);
		}

		conn->init_addr_type = bdaddr_type;
		bacpy(&conn->init_addr, bdaddr);

		/* 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 = conn->hdev->le_conn_min_interval;
		conn->le_conn_max_interval = conn->hdev->le_conn_max_interval;
	}
}

5271
static void le_conn_complete_evt(struct hci_dev *hdev, u8 status,
5272 5273 5274 5275
				 bdaddr_t *bdaddr, u8 bdaddr_type,
				 bdaddr_t *local_rpa, u8 role, u16 handle,
				 u16 interval, u16 latency,
				 u16 supervision_timeout)
V
Ville Tervo 已提交
5276
{
5277
	struct hci_conn_params *params;
V
Ville Tervo 已提交
5278
	struct hci_conn *conn;
5279
	struct smp_irk *irk;
5280
	u8 addr_type;
V
Ville Tervo 已提交
5281 5282 5283

	hci_dev_lock(hdev);

5284 5285 5286
	/* All controllers implicitly stop advertising in the event of a
	 * connection, so ensure that the state bit is cleared.
	 */
5287
	hci_dev_clear_flag(hdev, HCI_LE_ADV);
5288

5289
	conn = hci_lookup_le_connect(hdev);
5290
	if (!conn) {
5291
		conn = hci_conn_add(hdev, LE_LINK, bdaddr, role);
5292
		if (!conn) {
5293
			bt_dev_err(hdev, "no memory for new connection");
A
Andre Guedes 已提交
5294
			goto unlock;
5295
		}
5296

5297
		conn->dst_type = bdaddr_type;
5298

5299
		/* If we didn't have a hci_conn object previously
5300
		 * but we're in central role this must be something
5301
		 * initiated using an accept list. Since accept list based
5302 5303 5304 5305 5306 5307
		 * 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) {
5308 5309
			conn->resp_addr_type = bdaddr_type;
			bacpy(&conn->resp_addr, bdaddr);
5310
			if (hci_dev_test_flag(hdev, HCI_PRIVACY)) {
5311 5312 5313 5314 5315 5316 5317 5318
				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);
			}
		}
5319 5320
	} else {
		cancel_delayed_work(&conn->le_conn_timeout);
5321
	}
V
Ville Tervo 已提交
5322

5323
	le_conn_update_addr(conn, bdaddr, bdaddr_type, local_rpa);
5324

5325 5326 5327 5328 5329 5330 5331 5332 5333 5334
	/* 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);
5335 5336 5337 5338 5339
	if (irk) {
		bacpy(&conn->dst, &irk->bdaddr);
		conn->dst_type = irk->addr_type;
	}

5340
	conn->dst_type = ev_bdaddr_type(hdev, conn->dst_type, NULL);
5341

5342 5343
	if (status) {
		hci_le_conn_failed(conn, status);
5344 5345 5346
		goto unlock;
	}

5347 5348 5349 5350 5351
	if (conn->dst_type == ADDR_LE_DEV_PUBLIC)
		addr_type = BDADDR_LE_PUBLIC;
	else
		addr_type = BDADDR_LE_RANDOM;

5352
	/* Drop the connection if the device is blocked */
5353
	if (hci_bdaddr_list_lookup(&hdev->reject_list, &conn->dst, addr_type)) {
5354
		hci_conn_drop(conn);
5355 5356 5357
		goto unlock;
	}

5358
	if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
5359
		mgmt_device_connected(hdev, conn, NULL, 0);
5360

5361
	conn->sec_level = BT_SECURITY_LOW;
5362
	conn->handle = handle;
5363
	conn->state = BT_CONFIG;
V
Ville Tervo 已提交
5364

5365 5366 5367 5368 5369 5370 5371
	/* Store current advertising instance as connection advertising instance
	 * when sotfware rotation is in use so it can be re-enabled when
	 * disconnected.
	 */
	if (!ext_adv_capable(hdev))
		conn->adv_instance = hdev->cur_adv_instance;

5372 5373 5374
	conn->le_conn_interval = interval;
	conn->le_conn_latency = latency;
	conn->le_supv_timeout = supervision_timeout;
5375

5376
	hci_debugfs_create_conn(conn);
V
Ville Tervo 已提交
5377 5378
	hci_conn_add_sysfs(conn);

5379
	/* The remote features procedure is defined for central
5380 5381 5382
	 * role only. So only in case of an initiated connection
	 * request the remote features.
	 *
5383 5384
	 * If the local controller supports peripheral-initiated features
	 * exchange, then requesting the remote features in peripheral
5385 5386 5387 5388
	 * role is possible. Otherwise just transition into the
	 * connected state without requesting the remote features.
	 */
	if (conn->out ||
5389
	    (hdev->le_features[0] & HCI_LE_PERIPHERAL_FEATURES)) {
5390
		struct hci_cp_le_read_remote_features cp;
5391

5392
		cp.handle = __cpu_to_le16(conn->handle);
5393

5394 5395
		hci_send_cmd(hdev, HCI_OP_LE_READ_REMOTE_FEATURES,
			     sizeof(cp), &cp);
5396

5397
		hci_conn_hold(conn);
5398
	} else {
5399
		conn->state = BT_CONNECTED;
5400
		hci_connect_cfm(conn, status);
5401
	}
V
Ville Tervo 已提交
5402

5403 5404
	params = hci_pend_le_action_lookup(&hdev->pend_le_conns, &conn->dst,
					   conn->dst_type);
5405
	if (params) {
5406
		list_del_init(&params->action);
5407 5408
		if (params->conn) {
			hci_conn_drop(params->conn);
5409
			hci_conn_put(params->conn);
5410 5411 5412
			params->conn = NULL;
		}
	}
5413

V
Ville Tervo 已提交
5414
unlock:
5415
	hci_update_background_scan(hdev);
V
Ville Tervo 已提交
5416 5417 5418
	hci_dev_unlock(hdev);
}

5419 5420 5421 5422 5423 5424 5425
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,
5426
			     NULL, ev->role, le16_to_cpu(ev->handle),
5427 5428 5429 5430 5431
			     le16_to_cpu(ev->interval),
			     le16_to_cpu(ev->latency),
			     le16_to_cpu(ev->supervision_timeout));
}

5432 5433 5434 5435 5436 5437 5438 5439
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,
5440
			     &ev->local_rpa, ev->role, le16_to_cpu(ev->handle),
5441 5442 5443
			     le16_to_cpu(ev->interval),
			     le16_to_cpu(ev->latency),
			     le16_to_cpu(ev->supervision_timeout));
5444 5445

	if (use_ll_privacy(hdev) &&
5446
	    hci_dev_test_flag(hdev, HCI_ENABLE_LL_PRIVACY) &&
5447 5448
	    hci_dev_test_flag(hdev, HCI_LL_RPA_RESOLUTION))
		hci_req_disable_address_resolution(hdev);
5449 5450
}

5451 5452 5453 5454
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;
5455
	struct adv_info *adv;
5456 5457 5458

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

5459
	adv = hci_find_adv_instance(hdev, ev->handle);
5460

5461
	if (ev->status) {
5462 5463 5464 5465 5466 5467 5468
		if (!adv)
			return;

		/* Remove advertising as it has been terminated */
		hci_remove_adv_instance(hdev, ev->handle);
		mgmt_advertising_removed(NULL, hdev, ev->handle);

5469
		return;
5470
	}
5471

5472 5473 5474
	if (adv)
		adv->enabled = false;

5475 5476
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->conn_handle));
	if (conn) {
5477 5478 5479 5480
		/* Store handle in the connection so the correct advertising
		 * instance can be re-enabled when disconnected.
		 */
		conn->adv_instance = ev->handle;
5481

5482 5483
		if (hdev->adv_addr_type != ADDR_LE_DEV_RANDOM ||
		    bacmp(&conn->resp_addr, BDADDR_ANY))
5484 5485
			return;

5486
		if (!ev->handle) {
5487 5488 5489 5490
			bacpy(&conn->resp_addr, &hdev->random_addr);
			return;
		}

5491 5492
		if (adv)
			bacpy(&conn->resp_addr, &adv->random_addr);
5493 5494 5495
	}
}

5496 5497 5498 5499 5500 5501 5502 5503 5504 5505 5506 5507 5508 5509 5510 5511 5512 5513 5514 5515 5516 5517 5518
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);
}

5519
/* This function requires the caller holds hdev->lock */
5520 5521
static struct hci_conn *check_pending_le_conn(struct hci_dev *hdev,
					      bdaddr_t *addr,
5522 5523
					      u8 addr_type, bool addr_resolved,
					      u8 adv_type, bdaddr_t *direct_rpa)
5524 5525
{
	struct hci_conn *conn;
5526
	struct hci_conn_params *params;
5527

5528 5529
	/* If the event is not connectable don't proceed further */
	if (adv_type != LE_ADV_IND && adv_type != LE_ADV_DIRECT_IND)
5530
		return NULL;
5531 5532

	/* Ignore if the device is blocked */
5533
	if (hci_bdaddr_list_lookup(&hdev->reject_list, addr, addr_type))
5534
		return NULL;
5535

5536
	/* Most controller will fail if we try to create new connections
5537
	 * while we have an existing one in peripheral role.
5538
	 */
5539
	if (hdev->conn_hash.le_num_peripheral > 0 &&
5540 5541
	    (!test_bit(HCI_QUIRK_VALID_LE_STATES, &hdev->quirks) ||
	     !(hdev->le_states[3] & 0x10)))
5542
		return NULL;
5543

5544 5545 5546
	/* If we're not connectable only connect devices that we have in
	 * our pend_le_conns list.
	 */
5547 5548
	params = hci_pend_le_action_lookup(&hdev->pend_le_conns, addr,
					   addr_type);
5549
	if (!params)
5550
		return NULL;
5551

5552 5553 5554 5555 5556
	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
5557
			 * incoming connections from peripheral devices.
5558 5559 5560 5561 5562 5563 5564
			 */
			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
5565 5566
			 * that incoming connections from peripheral device are
			 * accepted and also outgoing connections to peripheral
5567 5568 5569 5570
			 * devices are established when found.
			 */
			break;
		default:
5571
			return NULL;
5572
		}
5573
	}
5574

5575 5576 5577
	conn = hci_connect_le(hdev, addr, addr_type, addr_resolved,
			      BT_SECURITY_LOW, hdev->def_le_autoconnect_timeout,
			      HCI_ROLE_MASTER, direct_rpa);
5578
	if (!IS_ERR(conn)) {
5579 5580 5581
		/* 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
5582 5583 5584 5585 5586
		 * 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.
		 */
5587 5588 5589 5590

		if (!params->explicit_connect)
			params->conn = hci_conn_get(conn);

5591
		return conn;
5592
	}
5593 5594 5595 5596 5597 5598 5599 5600 5601 5602 5603

	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));
5604
		return NULL;
5605
	}
5606 5607

	return NULL;
5608 5609
}

5610
static void process_adv_report(struct hci_dev *hdev, u8 type, bdaddr_t *bdaddr,
5611
			       u8 bdaddr_type, bdaddr_t *direct_addr,
5612 5613
			       u8 direct_addr_type, s8 rssi, u8 *data, u8 len,
			       bool ext_adv)
5614
{
5615
	struct discovery_state *d = &hdev->discovery;
5616
	struct smp_irk *irk;
5617
	struct hci_conn *conn;
5618
	bool match, bdaddr_resolved;
5619
	u32 flags;
5620
	u8 *ptr;
5621

5622 5623 5624 5625 5626 5627 5628 5629
	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:
5630 5631
		bt_dev_err_ratelimited(hdev, "unknown advertising packet "
				       "type: 0x%02x", type);
5632 5633 5634
		return;
	}

5635 5636 5637 5638 5639
	if (!ext_adv && len > HCI_MAX_AD_LENGTH) {
		bt_dev_err_ratelimited(hdev, "legacy adv larger than 31 bytes");
		return;
	}

5640 5641 5642 5643 5644 5645 5646 5647 5648 5649 5650
	/* 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;
	}

5651 5652 5653 5654
	/* Adjust for actual length. This handles the case when remote
	 * device is advertising with incorrect data length.
	 */
	len = ptr - data;
5655

5656 5657 5658 5659 5660 5661
	/* 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) {
5662 5663
		direct_addr_type = ev_bdaddr_type(hdev, direct_addr_type,
						  &bdaddr_resolved);
5664

5665 5666 5667 5668 5669 5670 5671 5672 5673
		/* 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.
		 */
5674
		if (!hci_dev_test_flag(hdev, HCI_PRIVACY))
5675 5676 5677 5678 5679 5680 5681 5682 5683 5684
			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;
	}

5685 5686 5687 5688 5689 5690 5691
	/* 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;
	}

5692
	bdaddr_type = ev_bdaddr_type(hdev, bdaddr_type, &bdaddr_resolved);
5693

5694 5695 5696 5697 5698
	/* 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.
	 */
5699 5700
	conn = check_pending_le_conn(hdev, bdaddr, bdaddr_type, bdaddr_resolved,
				     type, direct_addr);
5701
	if (!ext_adv && conn && type == LE_ADV_IND && len <= HCI_MAX_AD_LENGTH) {
5702 5703 5704 5705 5706 5707
		/* Store report for later inclusion by
		 * mgmt_device_connected
		 */
		memcpy(conn->le_adv_data, data, len);
		conn->le_adv_data_len = len;
	}
5708

5709 5710
	/* Passive scanning shouldn't trigger any device found events,
	 * except for devices marked as CONN_REPORT for which we do send
5711
	 * device found events, or advertisement monitoring requested.
5712
	 */
5713
	if (hdev->le_scan_type == LE_SCAN_PASSIVE) {
5714 5715 5716
		if (type == LE_ADV_DIRECT_IND)
			return;

5717
		if (!hci_pend_le_action_lookup(&hdev->pend_le_reports,
5718 5719
					       bdaddr, bdaddr_type) &&
		    idr_is_empty(&hdev->adv_monitors_idr))
5720 5721 5722 5723 5724 5725 5726 5727
			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);
5728
		return;
5729
	}
5730

5731 5732 5733 5734 5735 5736 5737 5738 5739 5740 5741 5742 5743 5744 5745 5746 5747 5748 5749 5750 5751
	/* 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;

5752 5753 5754 5755
	/* 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.
	 */
5756
	if (!ext_adv &&	!has_pending_adv_report(hdev)) {
5757 5758 5759 5760 5761
		/* 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,
5762
						 rssi, flags, data, len);
5763 5764 5765 5766
			return;
		}

		mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
5767
				  rssi, flags, data, len, NULL, 0);
5768 5769 5770
		return;
	}

5771 5772 5773 5774
	/* 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);

5775 5776 5777 5778
	/* 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.
	 */
5779 5780 5781 5782
	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,
5783
					  d->last_adv_addr_type, NULL,
5784
					  d->last_adv_rssi, d->last_adv_flags,
5785
					  d->last_adv_data,
5786
					  d->last_adv_data_len, NULL, 0);
5787 5788 5789 5790

		/* If the new report will trigger a SCAN_REQ store it for
		 * later merging.
		 */
5791 5792
		if (!ext_adv && (type == LE_ADV_IND ||
				 type == LE_ADV_SCAN_IND)) {
5793
			store_pending_adv_report(hdev, bdaddr, bdaddr_type,
5794
						 rssi, flags, data, len);
5795 5796 5797 5798 5799 5800 5801
			return;
		}

		/* The advertising reports cannot be merged, so clear
		 * the pending report and send out a device found event.
		 */
		clear_pending_adv_report(hdev);
5802
		mgmt_device_found(hdev, bdaddr, LE_LINK, bdaddr_type, NULL,
5803
				  rssi, flags, data, len, NULL, 0);
5804 5805 5806 5807 5808 5809 5810 5811
		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,
5812
			  d->last_adv_addr_type, NULL, rssi, d->last_adv_flags,
5813
			  d->last_adv_data, d->last_adv_data_len, data, len);
5814
	clear_pending_adv_report(hdev);
5815 5816
}

5817
static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
5818
{
5819 5820
	u8 num_reports = skb->data[0];
	void *ptr = &skb->data[1];
5821

5822 5823
	hci_dev_lock(hdev);

5824 5825
	while (num_reports--) {
		struct hci_ev_le_advertising_info *ev = ptr;
5826
		s8 rssi;
5827

5828 5829 5830 5831
		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,
5832
					   ev->data, ev->length, false);
5833 5834 5835
		} else {
			bt_dev_err(hdev, "Dropping invalid advertising data");
		}
A
Andre Guedes 已提交
5836

5837
		ptr += sizeof(*ev) + ev->length + 1;
5838
	}
5839 5840

	hci_dev_unlock(hdev);
5841 5842
}

5843
static u8 ext_evt_type_to_legacy(struct hci_dev *hdev, u16 evt_type)
5844 5845 5846 5847 5848 5849 5850 5851 5852 5853 5854 5855 5856 5857 5858 5859
{
	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;
		}

5860
		goto invalid;
5861 5862 5863 5864 5865 5866
	}

	if (evt_type & LE_EXT_ADV_CONN_IND) {
		if (evt_type & LE_EXT_ADV_DIRECT_IND)
			return LE_ADV_DIRECT_IND;

5867
		return LE_ADV_IND;
5868 5869 5870 5871 5872 5873
	}

	if (evt_type & LE_EXT_ADV_SCAN_RSP)
		return LE_ADV_SCAN_RSP;

	if (evt_type & LE_EXT_ADV_SCAN_IND)
5874
		return LE_ADV_SCAN_IND;
5875 5876 5877

	if (evt_type == LE_EXT_ADV_NON_CONN_IND ||
	    evt_type & LE_EXT_ADV_DIRECT_IND)
5878 5879
		return LE_ADV_NONCONN_IND;

5880 5881 5882
invalid:
	bt_dev_err_ratelimited(hdev, "Unknown advertising packet type: 0x%02x",
			       evt_type);
5883 5884 5885 5886 5887 5888 5889 5890 5891 5892 5893 5894 5895 5896 5897 5898 5899

	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);
5900
		legacy_evt_type = ext_evt_type_to_legacy(hdev, evt_type);
5901 5902 5903
		if (legacy_evt_type != LE_ADV_INVALID) {
			process_adv_report(hdev, legacy_evt_type, &ev->bdaddr,
					   ev->bdaddr_type, NULL, 0, ev->rssi,
5904 5905
					   ev->data, ev->length,
					   !(evt_type & LE_EXT_ADV_LEGACY_PDU));
5906 5907
		}

5908
		ptr += sizeof(*ev) + ev->length;
5909 5910 5911 5912 5913
	}

	hci_dev_unlock(hdev);
}

5914 5915 5916 5917 5918 5919 5920 5921 5922 5923 5924 5925 5926 5927 5928 5929 5930 5931
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;

5932
			/* If the local controller supports peripheral-initiated
5933 5934 5935 5936 5937 5938 5939 5940
			 * 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.
			 */
5941 5942
			if (!conn->out && ev->status == 0x1a &&
			    (hdev->le_features[0] & HCI_LE_PERIPHERAL_FEATURES))
5943 5944 5945 5946 5947 5948 5949 5950 5951 5952 5953 5954 5955
				status = 0x00;
			else
				status = ev->status;

			conn->state = BT_CONNECTED;
			hci_connect_cfm(conn, status);
			hci_conn_drop(conn);
		}
	}

	hci_dev_unlock(hdev);
}

5956
static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
5957 5958 5959
{
	struct hci_ev_le_ltk_req *ev = (void *) skb->data;
	struct hci_cp_le_ltk_reply cp;
5960
	struct hci_cp_le_ltk_neg_reply neg;
5961
	struct hci_conn *conn;
5962
	struct smp_ltk *ltk;
5963

5964
	BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
5965 5966 5967 5968

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
5969 5970
	if (conn == NULL)
		goto not_found;
5971

5972
	ltk = hci_find_ltk(hdev, &conn->dst, conn->dst_type, conn->role);
5973
	if (!ltk)
5974 5975
		goto not_found;

5976 5977 5978 5979 5980 5981 5982 5983 5984 5985
	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;
	}

5986 5987
	memcpy(cp.ltk, ltk->val, ltk->enc_size);
	memset(cp.ltk + ltk->enc_size, 0, sizeof(cp.ltk) - ltk->enc_size);
5988
	cp.handle = cpu_to_le16(conn->handle);
5989

5990
	conn->pending_sec_level = smp_ltk_sec_level(ltk);
5991

5992
	conn->enc_key_size = ltk->enc_size;
5993 5994 5995

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

5996 5997 5998 5999 6000 6001
	/* 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.
	 */
6002
	if (ltk->type == SMP_STK) {
6003
		set_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
J
Johan Hedberg 已提交
6004 6005
		list_del_rcu(&ltk->list);
		kfree_rcu(ltk, rcu);
6006 6007
	} else {
		clear_bit(HCI_CONN_STK_ENCRYPT, &conn->flags);
6008 6009
	}

6010
	hci_dev_unlock(hdev);
6011 6012 6013 6014 6015 6016 6017

	return;

not_found:
	neg.handle = ev->handle;
	hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
	hci_dev_unlock(hdev);
6018 6019
}

6020 6021 6022 6023 6024 6025 6026 6027 6028 6029 6030 6031 6032 6033 6034 6035 6036 6037 6038 6039 6040 6041 6042 6043 6044 6045 6046 6047 6048 6049 6050 6051 6052 6053 6054
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);

6055
	if (hcon->role == HCI_ROLE_MASTER) {
6056
		struct hci_conn_params *params;
6057
		u8 store_hint;
6058 6059 6060 6061 6062 6063 6064 6065 6066 6067

		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;
6068
			store_hint = 0x01;
M
Meng Yu 已提交
6069
		} else {
6070
			store_hint = 0x00;
6071 6072 6073 6074
		}

		hci_dev_unlock(hdev);

6075 6076
		mgmt_new_conn_param(hdev, &hcon->dst, hcon->dst_type,
				    store_hint, min, max, latency, timeout);
6077
	}
6078

6079 6080 6081 6082 6083 6084 6085 6086 6087 6088 6089
	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);
}

6090 6091 6092 6093
static void hci_le_direct_adv_report_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
{
	u8 num_reports = skb->data[0];
6094
	struct hci_ev_le_direct_adv_info *ev = (void *)&skb->data[1];
6095

6096 6097
	if (!num_reports || skb->len < num_reports * sizeof(*ev) + 1)
		return;
6098

6099
	hci_dev_lock(hdev);
6100

6101
	for (; num_reports; num_reports--, ev++)
6102 6103
		process_adv_report(hdev, ev->evt_type, &ev->bdaddr,
				   ev->bdaddr_type, &ev->direct_addr,
6104 6105
				   ev->direct_addr_type, ev->rssi, NULL, 0,
				   false);
6106 6107 6108 6109

	hci_dev_unlock(hdev);
}

6110 6111 6112 6113 6114 6115 6116
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);

6117
	if (ev->status)
6118 6119 6120 6121 6122 6123 6124 6125 6126 6127 6128 6129 6130 6131 6132
		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);
}

6133
static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
V
Ville Tervo 已提交
6134 6135 6136 6137 6138 6139 6140 6141 6142 6143
{
	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;

6144 6145 6146 6147
	case HCI_EV_LE_CONN_UPDATE_COMPLETE:
		hci_le_conn_update_complete_evt(hdev, skb);
		break;

6148 6149 6150 6151
	case HCI_EV_LE_ADVERTISING_REPORT:
		hci_le_adv_report_evt(hdev, skb);
		break;

6152 6153 6154 6155
	case HCI_EV_LE_REMOTE_FEAT_COMPLETE:
		hci_le_remote_feat_complete_evt(hdev, skb);
		break;

6156 6157 6158 6159
	case HCI_EV_LE_LTK_REQ:
		hci_le_ltk_request_evt(hdev, skb);
		break;

6160 6161 6162 6163
	case HCI_EV_LE_REMOTE_CONN_PARAM_REQ:
		hci_le_remote_conn_param_req_evt(hdev, skb);
		break;

6164 6165 6166 6167
	case HCI_EV_LE_DIRECT_ADV_REPORT:
		hci_le_direct_adv_report_evt(hdev, skb);
		break;

6168 6169 6170 6171
	case HCI_EV_LE_PHY_UPDATE_COMPLETE:
		hci_le_phy_update_evt(hdev, skb);
		break;

6172 6173 6174 6175
	case HCI_EV_LE_EXT_ADV_REPORT:
		hci_le_ext_adv_report_evt(hdev, skb);
		break;

6176 6177 6178 6179
	case HCI_EV_LE_ENHANCED_CONN_COMPLETE:
		hci_le_enh_conn_complete_evt(hdev, skb);
		break;

6180 6181 6182 6183
	case HCI_EV_LE_EXT_ADV_SET_TERM:
		hci_le_ext_adv_term_evt(hdev, skb);
		break;

V
Ville Tervo 已提交
6184 6185 6186 6187 6188
	default:
		break;
	}
}

6189 6190 6191 6192 6193 6194 6195 6196 6197 6198
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)) {
6199
		bt_dev_err(hdev, "too short HCI event");
6200 6201 6202 6203 6204 6205 6206 6207 6208 6209 6210 6211
		return false;
	}

	hdr = (void *) skb->data;
	skb_pull(skb, HCI_EVENT_HDR_SIZE);

	if (event) {
		if (hdr->evt != event)
			return false;
		return true;
	}

Z
Zheng Yongjun 已提交
6212
	/* Check if request ended in Command Status - no way to retrieve
6213 6214 6215 6216 6217
	 * any extra parameters in this case.
	 */
	if (hdr->evt == HCI_EV_CMD_STATUS)
		return false;

6218
	if (hdr->evt != HCI_EV_CMD_COMPLETE) {
6219 6220
		bt_dev_err(hdev, "last event is not cmd complete (0x%2.2x)",
			   hdr->evt);
6221 6222 6223 6224
		return false;
	}

	if (skb->len < sizeof(*ev)) {
6225
		bt_dev_err(hdev, "too short cmd_complete event");
6226 6227 6228 6229 6230 6231 6232 6233 6234 6235 6236 6237 6238 6239 6240
		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;
}

6241 6242 6243 6244 6245 6246 6247 6248 6249 6250 6251 6252 6253 6254 6255 6256 6257 6258 6259 6260 6261 6262 6263 6264 6265 6266 6267 6268 6269 6270 6271 6272 6273 6274 6275 6276 6277 6278 6279 6280 6281 6282 6283 6284 6285 6286 6287 6288 6289 6290 6291 6292 6293 6294 6295 6296 6297 6298 6299 6300 6301 6302 6303 6304 6305 6306 6307 6308 6309
static void hci_store_wake_reason(struct hci_dev *hdev, u8 event,
				  struct sk_buff *skb)
{
	struct hci_ev_le_advertising_info *adv;
	struct hci_ev_le_direct_adv_info *direct_adv;
	struct hci_ev_le_ext_adv_report *ext_adv;
	const struct hci_ev_conn_complete *conn_complete = (void *)skb->data;
	const struct hci_ev_conn_request *conn_request = (void *)skb->data;

	hci_dev_lock(hdev);

	/* If we are currently suspended and this is the first BT event seen,
	 * save the wake reason associated with the event.
	 */
	if (!hdev->suspended || hdev->wake_reason)
		goto unlock;

	/* Default to remote wake. Values for wake_reason are documented in the
	 * Bluez mgmt api docs.
	 */
	hdev->wake_reason = MGMT_WAKE_REASON_REMOTE_WAKE;

	/* Once configured for remote wakeup, we should only wake up for
	 * reconnections. It's useful to see which device is waking us up so
	 * keep track of the bdaddr of the connection event that woke us up.
	 */
	if (event == HCI_EV_CONN_REQUEST) {
		bacpy(&hdev->wake_addr, &conn_complete->bdaddr);
		hdev->wake_addr_type = BDADDR_BREDR;
	} else if (event == HCI_EV_CONN_COMPLETE) {
		bacpy(&hdev->wake_addr, &conn_request->bdaddr);
		hdev->wake_addr_type = BDADDR_BREDR;
	} else if (event == HCI_EV_LE_META) {
		struct hci_ev_le_meta *le_ev = (void *)skb->data;
		u8 subevent = le_ev->subevent;
		u8 *ptr = &skb->data[sizeof(*le_ev)];
		u8 num_reports = *ptr;

		if ((subevent == HCI_EV_LE_ADVERTISING_REPORT ||
		     subevent == HCI_EV_LE_DIRECT_ADV_REPORT ||
		     subevent == HCI_EV_LE_EXT_ADV_REPORT) &&
		    num_reports) {
			adv = (void *)(ptr + 1);
			direct_adv = (void *)(ptr + 1);
			ext_adv = (void *)(ptr + 1);

			switch (subevent) {
			case HCI_EV_LE_ADVERTISING_REPORT:
				bacpy(&hdev->wake_addr, &adv->bdaddr);
				hdev->wake_addr_type = adv->bdaddr_type;
				break;
			case HCI_EV_LE_DIRECT_ADV_REPORT:
				bacpy(&hdev->wake_addr, &direct_adv->bdaddr);
				hdev->wake_addr_type = direct_adv->bdaddr_type;
				break;
			case HCI_EV_LE_EXT_ADV_REPORT:
				bacpy(&hdev->wake_addr, &ext_adv->bdaddr);
				hdev->wake_addr_type = ext_adv->bdaddr_type;
				break;
			}
		}
	} else {
		hdev->wake_reason = MGMT_WAKE_REASON_UNEXPECTED;
	}

unlock:
	hci_dev_unlock(hdev);
}

6310 6311 6312
void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_event_hdr *hdr = (void *) skb->data;
6313 6314 6315
	hci_req_complete_t req_complete = NULL;
	hci_req_complete_skb_t req_complete_skb = NULL;
	struct sk_buff *orig_skb = NULL;
6316
	u8 status = 0, event = hdr->evt, req_evt = 0;
6317
	u16 opcode = HCI_OP_NOP;
6318

6319 6320 6321 6322 6323
	if (!event) {
		bt_dev_warn(hdev, "Received unexpected HCI Event 00000000");
		goto done;
	}

6324
	if (hdev->sent_cmd && bt_cb(hdev->sent_cmd)->hci.req_event == event) {
6325
		struct hci_command_hdr *cmd_hdr = (void *) hdev->sent_cmd->data;
6326 6327 6328
		opcode = __le16_to_cpu(cmd_hdr->opcode);
		hci_req_cmd_complete(hdev, opcode, status, &req_complete,
				     &req_complete_skb);
6329
		req_evt = event;
6330 6331
	}

6332 6333 6334 6335 6336 6337 6338 6339 6340 6341 6342
	/* 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);

6343 6344 6345
	/* Store wake reason if we're suspended */
	hci_store_wake_reason(hdev, event, skb);

6346
	switch (event) {
L
Linus Torvalds 已提交
6347 6348 6349 6350 6351 6352 6353 6354
	case HCI_EV_INQUIRY_COMPLETE:
		hci_inquiry_complete_evt(hdev, skb);
		break;

	case HCI_EV_INQUIRY_RESULT:
		hci_inquiry_result_evt(hdev, skb);
		break;

6355 6356
	case HCI_EV_CONN_COMPLETE:
		hci_conn_complete_evt(hdev, skb);
6357 6358
		break;

L
Linus Torvalds 已提交
6359 6360 6361 6362 6363 6364 6365 6366 6367 6368 6369 6370
	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;

6371 6372 6373 6374
	case HCI_EV_REMOTE_NAME:
		hci_remote_name_evt(hdev, skb);
		break;

L
Linus Torvalds 已提交
6375 6376 6377 6378
	case HCI_EV_ENCRYPT_CHANGE:
		hci_encrypt_change_evt(hdev, skb);
		break;

6379 6380 6381 6382 6383 6384 6385 6386 6387
	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:
6388 6389
		hci_cmd_complete_evt(hdev, skb, &opcode, &status,
				     &req_complete, &req_complete_skb);
6390 6391 6392
		break;

	case HCI_EV_CMD_STATUS:
6393 6394
		hci_cmd_status_evt(hdev, skb, &opcode, &status, &req_complete,
				   &req_complete_skb);
6395 6396
		break;

6397 6398 6399 6400
	case HCI_EV_HARDWARE_ERROR:
		hci_hardware_error_evt(hdev, skb);
		break;

6401 6402 6403 6404 6405 6406 6407 6408 6409 6410
	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 已提交
6411 6412 6413 6414 6415 6416 6417 6418 6419 6420 6421 6422 6423 6424 6425 6426 6427 6428
		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;

6429 6430 6431 6432
	case HCI_EV_PKT_TYPE_CHANGE:
		hci_pkt_type_change_evt(hdev, skb);
		break;

6433 6434 6435 6436
	case HCI_EV_PSCAN_REP_MODE:
		hci_pscan_rep_mode_evt(hdev, skb);
		break;

6437 6438
	case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
		hci_inquiry_result_with_rssi_evt(hdev, skb);
6439 6440
		break;

6441 6442
	case HCI_EV_REMOTE_EXT_FEATURES:
		hci_remote_ext_features_evt(hdev, skb);
L
Linus Torvalds 已提交
6443 6444
		break;

6445 6446 6447
	case HCI_EV_SYNC_CONN_COMPLETE:
		hci_sync_conn_complete_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
6448

6449 6450 6451
	case HCI_EV_EXTENDED_INQUIRY_RESULT:
		hci_extended_inquiry_result_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
6452

6453 6454 6455 6456
	case HCI_EV_KEY_REFRESH_COMPLETE:
		hci_key_refresh_complete_evt(hdev, skb);
		break;

6457 6458 6459 6460
	case HCI_EV_IO_CAPA_REQUEST:
		hci_io_capa_request_evt(hdev, skb);
		break;

6461 6462 6463 6464
	case HCI_EV_IO_CAPA_REPLY:
		hci_io_capa_reply_evt(hdev, skb);
		break;

6465 6466 6467 6468
	case HCI_EV_USER_CONFIRM_REQUEST:
		hci_user_confirm_request_evt(hdev, skb);
		break;

6469 6470 6471 6472
	case HCI_EV_USER_PASSKEY_REQUEST:
		hci_user_passkey_request_evt(hdev, skb);
		break;

6473 6474 6475 6476 6477 6478 6479 6480
	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;

6481 6482 6483 6484
	case HCI_EV_SIMPLE_PAIR_COMPLETE:
		hci_simple_pair_complete_evt(hdev, skb);
		break;

6485 6486 6487 6488
	case HCI_EV_REMOTE_HOST_FEATURES:
		hci_remote_host_features_evt(hdev, skb);
		break;

V
Ville Tervo 已提交
6489 6490 6491 6492
	case HCI_EV_LE_META:
		hci_le_meta_evt(hdev, skb);
		break;

6493 6494 6495 6496
	case HCI_EV_REMOTE_OOB_DATA_REQUEST:
		hci_remote_oob_data_request_evt(hdev, skb);
		break;

6497 6498 6499 6500 6501
#if IS_ENABLED(CONFIG_BT_HS)
	case HCI_EV_CHANNEL_SELECTED:
		hci_chan_selected_evt(hdev, skb);
		break;

6502 6503 6504 6505
	case HCI_EV_PHY_LINK_COMPLETE:
		hci_phy_link_complete_evt(hdev, skb);
		break;

6506 6507 6508 6509
	case HCI_EV_LOGICAL_LINK_COMPLETE:
		hci_loglink_complete_evt(hdev, skb);
		break;

6510 6511 6512 6513
	case HCI_EV_DISCONN_LOGICAL_LINK_COMPLETE:
		hci_disconn_loglink_complete_evt(hdev, skb);
		break;

6514 6515 6516
	case HCI_EV_DISCONN_PHY_LINK_COMPLETE:
		hci_disconn_phylink_complete_evt(hdev, skb);
		break;
6517
#endif
6518

6519 6520 6521 6522
	case HCI_EV_NUM_COMP_BLOCKS:
		hci_num_comp_blocks_evt(hdev, skb);
		break;

6523 6524 6525 6526
	case HCI_EV_VENDOR:
		msft_vendor_evt(hdev, skb);
		break;

6527
	default:
6528
		BT_DBG("%s event 0x%2.2x", hdev->name, event);
L
Linus Torvalds 已提交
6529 6530 6531
		break;
	}

6532
	if (req_complete) {
6533
		req_complete(hdev, status, opcode);
6534 6535 6536 6537 6538
	} else if (req_complete_skb) {
		if (!hci_get_cmd_complete(hdev, opcode, req_evt, orig_skb)) {
			kfree_skb(orig_skb);
			orig_skb = NULL;
		}
6539
		req_complete_skb(hdev, status, opcode, orig_skb);
6540
	}
6541

6542
done:
6543
	kfree_skb(orig_skb);
L
Linus Torvalds 已提交
6544 6545 6546
	kfree_skb(skb);
	hdev->stat.evt_rx++;
}