hci_event.c 86.8 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
   SOFTWARE IS DISCLAIMED.
*/

/* Bluetooth HCI event handling. */

27
#include <linux/export.h>
L
Linus Torvalds 已提交
28 29 30 31
#include <asm/unaligned.h>

#include <net/bluetooth/bluetooth.h>
#include <net/bluetooth/hci_core.h>
32
#include <net/bluetooth/mgmt.h>
L
Linus Torvalds 已提交
33 34 35

/* Handle HCI Event packets */

36
static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
37
{
38
	__u8 status = *((__u8 *) skb->data);
L
Linus Torvalds 已提交
39

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

42 43 44 45
	if (status) {
		hci_dev_lock(hdev);
		mgmt_stop_discovery_failed(hdev, status);
		hci_dev_unlock(hdev);
46
		return;
47
	}
L
Linus Torvalds 已提交
48

49 50
	clear_bit(HCI_INQUIRY, &hdev->flags);

51
	hci_dev_lock(hdev);
52
	hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
53
	hci_dev_unlock(hdev);
54

55
	hci_req_complete(hdev, HCI_OP_INQUIRY_CANCEL, status);
56 57 58

	hci_conn_check_pending(hdev);
}
59

60 61 62 63
static void hci_cc_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

64
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
65 66 67 68 69

	if (status)
		return;

	set_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);
70 71
}

72 73 74
static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
75

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

78 79
	if (status)
		return;
L
Linus Torvalds 已提交
80

81 82
	clear_bit(HCI_PERIODIC_INQ, &hdev->dev_flags);

83 84 85
	hci_conn_check_pending(hdev);
}

86 87
static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev,
					  struct sk_buff *skb)
88 89 90 91 92 93 94 95 96
{
	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;

97
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
98 99 100 101 102 103 104 105 106 107 108 109

	if (rp->status)
		return;

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
	if (conn) {
		if (rp->role)
			conn->link_mode &= ~HCI_LM_MASTER;
		else
			conn->link_mode |= HCI_LM_MASTER;
L
Linus Torvalds 已提交
110
	}
111 112

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

115 116 117 118 119
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;

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

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

134
static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
135
{
136
	struct hci_rp_write_link_policy *rp = (void *) skb->data;
L
Linus Torvalds 已提交
137
	struct hci_conn *conn;
138
	void *sent;
L
Linus Torvalds 已提交
139

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

142 143
	if (rp->status)
		return;
L
Linus Torvalds 已提交
144

145 146 147
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
	if (!sent)
		return;
L
Linus Torvalds 已提交
148

149
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
150

151
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
152
	if (conn)
153
		conn->link_policy = get_unaligned_le16(sent + 2);
L
Linus Torvalds 已提交
154

155 156
	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
157

158 159
static void hci_cc_read_def_link_policy(struct hci_dev *hdev,
					struct sk_buff *skb)
160 161 162
{
	struct hci_rp_read_def_link_policy *rp = (void *) skb->data;

163
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
164 165 166 167 168 169 170

	if (rp->status)
		return;

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

171 172
static void hci_cc_write_def_link_policy(struct hci_dev *hdev,
					 struct sk_buff *skb)
173 174 175 176
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;

177
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
178 179 180 181 182 183 184 185

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

	if (!status)
		hdev->link_policy = get_unaligned_le16(sent);

186
	hci_req_complete(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, status);
187 188
}

189 190 191
static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
192

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

195 196
	clear_bit(HCI_RESET, &hdev->flags);

197
	hci_req_complete(hdev, HCI_OP_RESET, status);
198

199
	/* Reset all non-persistent flags */
200 201
	hdev->dev_flags &= ~(BIT(HCI_LE_SCAN) | BIT(HCI_PENDING_CLASS) |
			     BIT(HCI_PERIODIC_INQ));
202 203

	hdev->discovery.state = DISCOVERY_STOPPED;
204
}
205

206 207 208 209
static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;
210

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

213 214 215
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
	if (!sent)
		return;
216

217 218
	hci_dev_lock(hdev);

219 220
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
		mgmt_set_local_name_complete(hdev, sent, status);
221 222
	else if (!status)
		memcpy(hdev->dev_name, sent, HCI_MAX_NAME_LENGTH);
223

224
	hci_dev_unlock(hdev);
225 226

	hci_req_complete(hdev, HCI_OP_WRITE_LOCAL_NAME, status);
227 228 229 230 231 232
}

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;

233
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
234 235 236 237

	if (rp->status)
		return;

238 239
	if (test_bit(HCI_SETUP, &hdev->dev_flags))
		memcpy(hdev->dev_name, rp->name, HCI_MAX_NAME_LENGTH);
240 241 242 243 244 245 246
}

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

247
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
248 249 250 251 252 253 254 255 256 257 258 259

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

	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 已提交
260
	}
261

262 263 264
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
		mgmt_auth_enable_complete(hdev, status);

265
	hci_req_complete(hdev, HCI_OP_WRITE_AUTH_ENABLE, status);
L
Linus Torvalds 已提交
266 267
}

268
static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
269
{
270
	__u8 status = *((__u8 *) skb->data);
L
Linus Torvalds 已提交
271 272
	void *sent;

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

275 276 277
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
	if (!sent)
		return;
L
Linus Torvalds 已提交
278

279 280 281 282 283 284 285 286
	if (!status) {
		__u8 param = *((__u8 *) sent);

		if (param)
			set_bit(HCI_ENCRYPT, &hdev->flags);
		else
			clear_bit(HCI_ENCRYPT, &hdev->flags);
	}
L
Linus Torvalds 已提交
287

288
	hci_req_complete(hdev, HCI_OP_WRITE_ENCRYPT_MODE, status);
289
}
L
Linus Torvalds 已提交
290

291 292
static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
{
293 294
	__u8 param, status = *((__u8 *) skb->data);
	int old_pscan, old_iscan;
295
	void *sent;
L
Linus Torvalds 已提交
296

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

299 300 301
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
	if (!sent)
		return;
L
Linus Torvalds 已提交
302

303 304
	param = *((__u8 *) sent);

305 306
	hci_dev_lock(hdev);

307
	if (status) {
308
		mgmt_write_scan_failed(hdev, param, status);
309 310 311 312
		hdev->discov_timeout = 0;
		goto done;
	}

313 314 315 316 317 318
	old_pscan = test_and_clear_bit(HCI_PSCAN, &hdev->flags);
	old_iscan = test_and_clear_bit(HCI_ISCAN, &hdev->flags);

	if (param & SCAN_INQUIRY) {
		set_bit(HCI_ISCAN, &hdev->flags);
		if (!old_iscan)
319
			mgmt_discoverable(hdev, 1);
320 321 322
		if (hdev->discov_timeout > 0) {
			int to = msecs_to_jiffies(hdev->discov_timeout * 1000);
			queue_delayed_work(hdev->workqueue, &hdev->discov_off,
323
					   to);
324
		}
325
	} else if (old_iscan)
326
		mgmt_discoverable(hdev, 0);
327 328 329 330

	if (param & SCAN_PAGE) {
		set_bit(HCI_PSCAN, &hdev->flags);
		if (!old_pscan)
331
			mgmt_connectable(hdev, 1);
332
	} else if (old_pscan)
333
		mgmt_connectable(hdev, 0);
L
Linus Torvalds 已提交
334

335
done:
336
	hci_dev_unlock(hdev);
337
	hci_req_complete(hdev, HCI_OP_WRITE_SCAN_ENABLE, status);
338
}
L
Linus Torvalds 已提交
339

340 341 342
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 已提交
343

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

346 347
	if (rp->status)
		return;
L
Linus Torvalds 已提交
348

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

351
	BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
352
	       hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
353
}
L
Linus Torvalds 已提交
354

355 356 357 358
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 已提交
359

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

362 363 364
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
	if (!sent)
		return;
L
Linus Torvalds 已提交
365

366 367 368 369 370 371 372 373 374
	hci_dev_lock(hdev);

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

	if (test_bit(HCI_MGMT, &hdev->dev_flags))
		mgmt_set_class_of_dev_complete(hdev, sent, status);

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

377 378 379 380 381
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;

382
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
383 384 385 386 387 388

	if (rp->status)
		return;

	setting = __le16_to_cpu(rp->voice_setting);

389
	if (hdev->voice_setting == setting)
390 391 392 393
		return;

	hdev->voice_setting = setting;

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

396
	if (hdev->notify)
397 398 399
		hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
}

400 401
static void hci_cc_write_voice_setting(struct hci_dev *hdev,
				       struct sk_buff *skb)
402 403
{
	__u8 status = *((__u8 *) skb->data);
404
	__u16 setting;
405 406
	void *sent;

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

409 410 411
	if (status)
		return;

412 413 414
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
	if (!sent)
		return;
L
Linus Torvalds 已提交
415

416
	setting = get_unaligned_le16(sent);
L
Linus Torvalds 已提交
417

418 419 420 421
	if (hdev->voice_setting == setting)
		return;

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

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

425
	if (hdev->notify)
426
		hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
L
Linus Torvalds 已提交
427 428
}

429
static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
430
{
431
	__u8 status = *((__u8 *) skb->data);
L
Linus Torvalds 已提交
432

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

435
	hci_req_complete(hdev, HCI_OP_HOST_BUFFER_SIZE, status);
436
}
437

438 439 440 441 442
static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);
	void *sent;

443
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
444 445 446 447 448

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

449
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
450 451 452 453 454 455 456
		mgmt_ssp_enable_complete(hdev, *((u8 *) sent), status);
	else if (!status) {
		if (*((u8 *) sent))
			set_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
		else
			clear_bit(HCI_SSP_ENABLED, &hdev->dev_flags);
	}
457 458
}

459 460 461 462 463 464 465 466 467
static u8 hci_get_inquiry_mode(struct hci_dev *hdev)
{
	if (hdev->features[6] & LMP_EXT_INQ)
		return 2;

	if (hdev->features[3] & LMP_RSSI_INQ)
		return 1;

	if (hdev->manufacturer == 11 && hdev->hci_rev == 0x00 &&
468
	    hdev->lmp_subver == 0x0757)
469 470 471 472 473 474 475 476 477 478 479 480
		return 1;

	if (hdev->manufacturer == 15) {
		if (hdev->hci_rev == 0x03 && hdev->lmp_subver == 0x6963)
			return 1;
		if (hdev->hci_rev == 0x09 && hdev->lmp_subver == 0x6963)
			return 1;
		if (hdev->hci_rev == 0x00 && hdev->lmp_subver == 0x6965)
			return 1;
	}

	if (hdev->manufacturer == 31 && hdev->hci_rev == 0x2005 &&
481
	    hdev->lmp_subver == 0x1805)
482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
		return 1;

	return 0;
}

static void hci_setup_inquiry_mode(struct hci_dev *hdev)
{
	u8 mode;

	mode = hci_get_inquiry_mode(hdev);

	hci_send_cmd(hdev, HCI_OP_WRITE_INQUIRY_MODE, 1, &mode);
}

static void hci_setup_event_mask(struct hci_dev *hdev)
{
	/* The second byte is 0xff instead of 0x9f (two reserved bits
	 * disabled) since a Broadcom 1.2 dongle doesn't respond to the
	 * command otherwise */
	u8 events[8] = { 0xff, 0xff, 0xfb, 0xff, 0x00, 0x00, 0x00, 0x00 };

503 504
	/* CSR 1.1 dongles does not accept any bitfield so don't try to set
	 * any event mask for pre 1.2 devices */
505
	if (hdev->hci_ver < BLUETOOTH_VER_1_2)
506 507 508 509 510 511 512
		return;

	events[4] |= 0x01; /* Flow Specification Complete */
	events[4] |= 0x02; /* Inquiry Result with RSSI */
	events[4] |= 0x04; /* Read Remote Extended Features Complete */
	events[5] |= 0x08; /* Synchronous Connection Complete */
	events[5] |= 0x10; /* Synchronous Connection Changed */
513 514

	if (hdev->features[3] & LMP_RSSI_INQ)
515
		events[4] |= 0x02; /* Inquiry Result with RSSI */
516

517
	if (lmp_sniffsubr_capable(hdev))
518 519 520 521 522 523 524 525
		events[5] |= 0x20; /* Sniff Subrating */

	if (hdev->features[5] & LMP_PAUSE_ENC)
		events[5] |= 0x80; /* Encryption Key Refresh Complete */

	if (hdev->features[6] & LMP_EXT_INQ)
		events[5] |= 0x40; /* Extended Inquiry Result */

526
	if (lmp_no_flush_capable(hdev))
527 528 529 530 531
		events[7] |= 0x01; /* Enhanced Flush Complete */

	if (hdev->features[7] & LMP_LSTO)
		events[6] |= 0x80; /* Link Supervision Timeout Changed */

532
	if (lmp_ssp_capable(hdev)) {
533 534 535 536 537 538 539 540 541 542 543 544
		events[6] |= 0x01;	/* IO Capability Request */
		events[6] |= 0x02;	/* IO Capability Response */
		events[6] |= 0x04;	/* User Confirmation Request */
		events[6] |= 0x08;	/* User Passkey Request */
		events[6] |= 0x10;	/* Remote OOB Data Request */
		events[6] |= 0x20;	/* Simple Pairing Complete */
		events[7] |= 0x04;	/* User Passkey Notification */
		events[7] |= 0x08;	/* Keypress Notification */
		events[7] |= 0x10;	/* Remote Host Supported
					 * Features Notification */
	}

545
	if (lmp_le_capable(hdev))
546 547 548 549 550 551 552
		events[7] |= 0x20;	/* LE Meta-Event */

	hci_send_cmd(hdev, HCI_OP_SET_EVENT_MASK, sizeof(events), events);
}

static void hci_setup(struct hci_dev *hdev)
{
553 554 555
	if (hdev->dev_type != HCI_BREDR)
		return;

556 557
	hci_setup_event_mask(hdev);

558
	if (hdev->hci_ver > BLUETOOTH_VER_1_1)
559 560
		hci_send_cmd(hdev, HCI_OP_READ_LOCAL_COMMANDS, 0, NULL);

561
	if (lmp_ssp_capable(hdev)) {
562 563 564
		if (test_bit(HCI_SSP_ENABLED, &hdev->dev_flags)) {
			u8 mode = 0x01;
			hci_send_cmd(hdev, HCI_OP_WRITE_SSP_MODE,
565
				     sizeof(mode), &mode);
566 567 568 569 570 571 572 573
		} else {
			struct hci_cp_write_eir cp;

			memset(hdev->eir, 0, sizeof(hdev->eir));
			memset(&cp, 0, sizeof(cp));

			hci_send_cmd(hdev, HCI_OP_WRITE_EIR, sizeof(cp), &cp);
		}
574 575 576 577 578 579 580
	}

	if (hdev->features[3] & LMP_RSSI_INQ)
		hci_setup_inquiry_mode(hdev);

	if (hdev->features[7] & LMP_INQ_TX_PWR)
		hci_send_cmd(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, 0, NULL);
581 582 583 584 585

	if (hdev->features[7] & LMP_EXTFEATURES) {
		struct hci_cp_read_local_ext_features cp;

		cp.page = 0x01;
586 587
		hci_send_cmd(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, sizeof(cp),
			     &cp);
588
	}
589

590 591
	if (test_bit(HCI_LINK_SECURITY, &hdev->dev_flags)) {
		u8 enable = 1;
592 593
		hci_send_cmd(hdev, HCI_OP_WRITE_AUTH_ENABLE, sizeof(enable),
			     &enable);
594
	}
595 596
}

597 598 599
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;
600

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

603
	if (rp->status)
604
		goto done;
605

606
	hdev->hci_ver = rp->hci_ver;
607
	hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
608
	hdev->lmp_ver = rp->lmp_ver;
609
	hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
610
	hdev->lmp_subver = __le16_to_cpu(rp->lmp_subver);
611

612
	BT_DBG("%s manufacturer 0x%4.4x hci ver %d:%d", hdev->name,
613
	       hdev->manufacturer, hdev->hci_ver, hdev->hci_rev);
614 615 616

	if (test_bit(HCI_INIT, &hdev->flags))
		hci_setup(hdev);
617 618 619

done:
	hci_req_complete(hdev, HCI_OP_READ_LOCAL_VERSION, rp->status);
620 621 622 623
}

static void hci_setup_link_policy(struct hci_dev *hdev)
{
624
	struct hci_cp_write_def_link_policy cp;
625 626
	u16 link_policy = 0;

627
	if (lmp_rswitch_capable(hdev))
628 629 630
		link_policy |= HCI_LP_RSWITCH;
	if (hdev->features[0] & LMP_HOLD)
		link_policy |= HCI_LP_HOLD;
631
	if (lmp_sniff_capable(hdev))
632 633 634 635
		link_policy |= HCI_LP_SNIFF;
	if (hdev->features[1] & LMP_PARK)
		link_policy |= HCI_LP_PARK;

636 637
	cp.policy = cpu_to_le16(link_policy);
	hci_send_cmd(hdev, HCI_OP_WRITE_DEF_LINK_POLICY, sizeof(cp), &cp);
638
}
L
Linus Torvalds 已提交
639

640 641
static void hci_cc_read_local_commands(struct hci_dev *hdev,
				       struct sk_buff *skb)
642 643
{
	struct hci_rp_read_local_commands *rp = (void *) skb->data;
L
Linus Torvalds 已提交
644

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

647
	if (rp->status)
648
		goto done;
L
Linus Torvalds 已提交
649

650
	memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
651 652 653 654 655 656

	if (test_bit(HCI_INIT, &hdev->flags) && (hdev->commands[5] & 0x10))
		hci_setup_link_policy(hdev);

done:
	hci_req_complete(hdev, HCI_OP_READ_LOCAL_COMMANDS, rp->status);
657
}
L
Linus Torvalds 已提交
658

659 660
static void hci_cc_read_local_features(struct hci_dev *hdev,
				       struct sk_buff *skb)
661 662
{
	struct hci_rp_read_local_features *rp = (void *) skb->data;
663

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

666 667
	if (rp->status)
		return;
668

669
	memcpy(hdev->features, rp->features, 8);
670

671 672
	/* Adjust default settings according to features
	 * supported by device. */
L
Linus Torvalds 已提交
673

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

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

680 681 682 683
	if (hdev->features[1] & LMP_HV2) {
		hdev->pkt_type  |= (HCI_HV2);
		hdev->esco_type |= (ESCO_HV2);
	}
L
Linus Torvalds 已提交
684

685 686 687 688
	if (hdev->features[1] & LMP_HV3) {
		hdev->pkt_type  |= (HCI_HV3);
		hdev->esco_type |= (ESCO_HV3);
	}
L
Linus Torvalds 已提交
689

690
	if (lmp_esco_capable(hdev))
691
		hdev->esco_type |= (ESCO_EV3);
692

693 694
	if (hdev->features[4] & LMP_EV4)
		hdev->esco_type |= (ESCO_EV4);
695

696 697
	if (hdev->features[4] & LMP_EV5)
		hdev->esco_type |= (ESCO_EV5);
L
Linus Torvalds 已提交
698

699 700 701 702 703 704 705 706 707
	if (hdev->features[5] & LMP_EDR_ESCO_2M)
		hdev->esco_type |= (ESCO_2EV3);

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

	if (hdev->features[5] & LMP_EDR_3S_ESCO)
		hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);

708
	BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
709 710 711 712
	       hdev->features[0], hdev->features[1],
	       hdev->features[2], hdev->features[3],
	       hdev->features[4], hdev->features[5],
	       hdev->features[6], hdev->features[7]);
713
}
L
Linus Torvalds 已提交
714

715 716 717 718 719 720
static void hci_set_le_support(struct hci_dev *hdev)
{
	struct hci_cp_write_le_host_supported cp;

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

721
	if (test_bit(HCI_LE_ENABLED, &hdev->dev_flags)) {
722 723 724 725 726
		cp.le = 1;
		cp.simul = !!(hdev->features[6] & LMP_SIMUL_LE_BR);
	}

	if (cp.le != !!(hdev->host_features[0] & LMP_HOST_LE))
727 728
		hci_send_cmd(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, sizeof(cp),
			     &cp);
729 730
}

731
static void hci_cc_read_local_ext_features(struct hci_dev *hdev,
732
					   struct sk_buff *skb)
733 734 735
{
	struct hci_rp_read_local_ext_features *rp = (void *) skb->data;

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

	if (rp->status)
739
		goto done;
740

741 742 743 744 745 746 747 748
	switch (rp->page) {
	case 0:
		memcpy(hdev->features, rp->features, 8);
		break;
	case 1:
		memcpy(hdev->host_features, rp->features, 8);
		break;
	}
749

750
	if (test_bit(HCI_INIT, &hdev->flags) && lmp_le_capable(hdev))
751 752 753
		hci_set_le_support(hdev);

done:
754 755 756
	hci_req_complete(hdev, HCI_OP_READ_LOCAL_EXT_FEATURES, rp->status);
}

757
static void hci_cc_read_flow_control_mode(struct hci_dev *hdev,
758
					  struct sk_buff *skb)
759 760 761
{
	struct hci_rp_read_flow_control_mode *rp = (void *) skb->data;

762
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
763 764 765 766 767 768 769 770 771

	if (rp->status)
		return;

	hdev->flow_ctl_mode = rp->mode;

	hci_req_complete(hdev, HCI_OP_READ_FLOW_CONTROL_MODE, rp->status);
}

772 773 774
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 已提交
775

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

778 779
	if (rp->status)
		return;
L
Linus Torvalds 已提交
780

781 782 783 784 785 786 787 788
	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 已提交
789
	}
790 791 792 793

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

794 795
	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);
796 797 798 799 800 801
}

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;

802
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
803 804 805 806

	if (!rp->status)
		bacpy(&hdev->bdaddr, &rp->bdaddr);

807 808 809
	hci_req_complete(hdev, HCI_OP_READ_BD_ADDR, rp->status);
}

810
static void hci_cc_read_data_block_size(struct hci_dev *hdev,
811
					struct sk_buff *skb)
812 813 814
{
	struct hci_rp_read_data_block_size *rp = (void *) skb->data;

815
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
816 817 818 819 820 821 822 823 824 825 826

	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,
827
	       hdev->block_cnt, hdev->block_len);
828 829 830 831

	hci_req_complete(hdev, HCI_OP_READ_DATA_BLOCK_SIZE, rp->status);
}

832 833 834 835
static void hci_cc_write_ca_timeout(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

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

	hci_req_complete(hdev, HCI_OP_WRITE_CA_TIMEOUT, status);
839 840
}

841
static void hci_cc_read_local_amp_info(struct hci_dev *hdev,
842
				       struct sk_buff *skb)
843 844 845
{
	struct hci_rp_read_local_amp_info *rp = (void *) skb->data;

846
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864

	if (rp->status)
		return;

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

	hci_req_complete(hdev, HCI_OP_READ_LOCAL_AMP_INFO, rp->status);
}

865
static void hci_cc_delete_stored_link_key(struct hci_dev *hdev,
866
					  struct sk_buff *skb)
867 868 869
{
	__u8 status = *((__u8 *) skb->data);

870
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
871 872 873 874

	hci_req_complete(hdev, HCI_OP_DELETE_STORED_LINK_KEY, status);
}

875 876 877 878
static void hci_cc_set_event_mask(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

879
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
880 881 882 883 884

	hci_req_complete(hdev, HCI_OP_SET_EVENT_MASK, status);
}

static void hci_cc_write_inquiry_mode(struct hci_dev *hdev,
885
				      struct sk_buff *skb)
886 887 888
{
	__u8 status = *((__u8 *) skb->data);

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

	hci_req_complete(hdev, HCI_OP_WRITE_INQUIRY_MODE, status);
}

static void hci_cc_read_inq_rsp_tx_power(struct hci_dev *hdev,
895
					 struct sk_buff *skb)
896
{
897
	struct hci_rp_read_inq_rsp_tx_power *rp = (void *) skb->data;
898

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

	if (!rp->status)
		hdev->inq_tx_power = rp->tx_power;
903

904
	hci_req_complete(hdev, HCI_OP_READ_INQ_RSP_TX_POWER, rp->status);
905 906 907 908 909 910
}

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

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

	hci_req_complete(hdev, HCI_OP_SET_EVENT_FLT, status);
}

916 917 918 919 920 921
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;

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

924 925
	hci_dev_lock(hdev);

926
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
927
		mgmt_pin_code_reply_complete(hdev, &rp->bdaddr, rp->status);
928

929
	if (rp->status)
930
		goto unlock;
931 932 933

	cp = hci_sent_cmd_data(hdev, HCI_OP_PIN_CODE_REPLY);
	if (!cp)
934
		goto unlock;
935 936 937 938

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
	if (conn)
		conn->pin_length = cp->pin_len;
939 940 941

unlock:
	hci_dev_unlock(hdev);
942 943 944 945 946 947
}

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;

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

950 951
	hci_dev_lock(hdev);

952
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
953
		mgmt_pin_code_neg_reply_complete(hdev, &rp->bdaddr,
954
						 rp->status);
955 956

	hci_dev_unlock(hdev);
957
}
958

959 960 961 962 963
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;

964
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
965 966 967 968 969 970 971 972 973 974 975 976 977

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

	hci_req_complete(hdev, HCI_OP_LE_READ_BUFFER_SIZE, rp->status);
}
978

979 980 981 982
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;

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

985 986
	hci_dev_lock(hdev);

987
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
988 989
		mgmt_user_confirm_reply_complete(hdev, &rp->bdaddr, ACL_LINK, 0,
						 rp->status);
990 991

	hci_dev_unlock(hdev);
992 993 994
}

static void hci_cc_user_confirm_neg_reply(struct hci_dev *hdev,
995
					  struct sk_buff *skb)
996 997 998
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

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

1001 1002
	hci_dev_lock(hdev);

1003
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
1004
		mgmt_user_confirm_neg_reply_complete(hdev, &rp->bdaddr,
1005
						     ACL_LINK, 0, rp->status);
1006 1007

	hci_dev_unlock(hdev);
1008 1009
}

1010 1011 1012 1013
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;

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

	hci_dev_lock(hdev);

1018
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
1019
		mgmt_user_passkey_reply_complete(hdev, &rp->bdaddr, ACL_LINK,
1020
						 0, rp->status);
1021 1022 1023 1024 1025

	hci_dev_unlock(hdev);
}

static void hci_cc_user_passkey_neg_reply(struct hci_dev *hdev,
1026
					  struct sk_buff *skb)
1027 1028 1029
{
	struct hci_rp_user_confirm_reply *rp = (void *) skb->data;

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

	hci_dev_lock(hdev);

1034
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
1035
		mgmt_user_passkey_neg_reply_complete(hdev, &rp->bdaddr,
1036
						     ACL_LINK, 0, rp->status);
1037 1038 1039 1040

	hci_dev_unlock(hdev);
}

1041
static void hci_cc_read_local_oob_data_reply(struct hci_dev *hdev,
1042
					     struct sk_buff *skb)
1043 1044 1045
{
	struct hci_rp_read_local_oob_data *rp = (void *) skb->data;

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

1048
	hci_dev_lock(hdev);
1049
	mgmt_read_local_oob_data_reply_complete(hdev, rp->hash,
1050
						rp->randomizer, rp->status);
1051
	hci_dev_unlock(hdev);
1052 1053
}

1054 1055 1056 1057
static void hci_cc_le_set_scan_param(struct hci_dev *hdev, struct sk_buff *skb)
{
	__u8 status = *((__u8 *) skb->data);

1058
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
A
Andre Guedes 已提交
1059 1060

	hci_req_complete(hdev, HCI_OP_LE_SET_SCAN_PARAM, status);
1061 1062 1063 1064 1065 1066 1067

	if (status) {
		hci_dev_lock(hdev);
		mgmt_start_discovery_failed(hdev, status);
		hci_dev_unlock(hdev);
		return;
	}
1068 1069
}

1070
static void hci_cc_le_set_scan_enable(struct hci_dev *hdev,
1071
				      struct sk_buff *skb)
1072 1073 1074 1075
{
	struct hci_cp_le_set_scan_enable *cp;
	__u8 status = *((__u8 *) skb->data);

1076
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1077 1078 1079 1080 1081

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

1082 1083
	switch (cp->enable) {
	case LE_SCANNING_ENABLED:
A
Andre Guedes 已提交
1084 1085
		hci_req_complete(hdev, HCI_OP_LE_SET_SCAN_ENABLE, status);

1086 1087 1088 1089
		if (status) {
			hci_dev_lock(hdev);
			mgmt_start_discovery_failed(hdev, status);
			hci_dev_unlock(hdev);
A
Andre Guedes 已提交
1090
			return;
1091
		}
A
Andre Guedes 已提交
1092

1093 1094
		set_bit(HCI_LE_SCAN, &hdev->dev_flags);

1095
		hci_dev_lock(hdev);
1096
		hci_discovery_set_state(hdev, DISCOVERY_FINDING);
1097
		hci_dev_unlock(hdev);
1098 1099 1100
		break;

	case LE_SCANNING_DISABLED:
1101 1102 1103 1104
		if (status) {
			hci_dev_lock(hdev);
			mgmt_stop_discovery_failed(hdev, status);
			hci_dev_unlock(hdev);
A
Andre Guedes 已提交
1105
			return;
1106
		}
A
Andre Guedes 已提交
1107

1108 1109
		clear_bit(HCI_LE_SCAN, &hdev->dev_flags);

1110 1111
		if (hdev->discovery.type == DISCOV_TYPE_INTERLEAVED &&
		    hdev->discovery.state == DISCOVERY_FINDING) {
1112 1113 1114 1115 1116 1117 1118
			mgmt_interleaved_discovery(hdev);
		} else {
			hci_dev_lock(hdev);
			hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
			hci_dev_unlock(hdev);
		}

1119 1120 1121 1122 1123
		break;

	default:
		BT_ERR("Used reserved LE_Scan_Enable param %d", cp->enable);
		break;
1124
	}
1125 1126
}

1127 1128 1129 1130
static void hci_cc_le_ltk_reply(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_rp_le_ltk_reply *rp = (void *) skb->data;

1131
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142

	if (rp->status)
		return;

	hci_req_complete(hdev, HCI_OP_LE_LTK_REPLY, rp->status);
}

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

1143
	BT_DBG("%s status 0x%2.2x", hdev->name, rp->status);
1144 1145 1146 1147 1148 1149 1150

	if (rp->status)
		return;

	hci_req_complete(hdev, HCI_OP_LE_LTK_NEG_REPLY, rp->status);
}

1151 1152
static void hci_cc_write_le_host_supported(struct hci_dev *hdev,
					   struct sk_buff *skb)
1153
{
1154
	struct hci_cp_write_le_host_supported *sent;
1155 1156
	__u8 status = *((__u8 *) skb->data);

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

1159
	sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED);
1160
	if (!sent)
1161 1162
		return;

1163 1164 1165 1166 1167 1168 1169 1170
	if (!status) {
		if (sent->le)
			hdev->host_features[0] |= LMP_HOST_LE;
		else
			hdev->host_features[0] &= ~LMP_HOST_LE;
	}

	if (test_bit(HCI_MGMT, &hdev->dev_flags) &&
1171
	    !test_bit(HCI_INIT, &hdev->flags))
1172 1173 1174
		mgmt_le_enable_complete(hdev, sent->le, status);

	hci_req_complete(hdev, HCI_OP_WRITE_LE_HOST_SUPPORTED, status);
1175 1176
}

1177
static void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
1178
{
1179
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1180 1181

	if (status) {
1182
		hci_req_complete(hdev, HCI_OP_INQUIRY, status);
1183
		hci_conn_check_pending(hdev);
1184
		hci_dev_lock(hdev);
1185
		if (test_bit(HCI_MGMT, &hdev->dev_flags))
1186
			mgmt_start_discovery_failed(hdev, status);
1187
		hci_dev_unlock(hdev);
1188 1189 1190
		return;
	}

1191 1192
	set_bit(HCI_INQUIRY, &hdev->flags);

1193
	hci_dev_lock(hdev);
1194
	hci_discovery_set_state(hdev, DISCOVERY_FINDING);
1195
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
1196 1197
}

1198
static void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1199
{
1200
	struct hci_cp_create_conn *cp;
L
Linus Torvalds 已提交
1201 1202
	struct hci_conn *conn;

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

	cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
L
Linus Torvalds 已提交
1206 1207 1208 1209 1210 1211 1212
	if (!cp)
		return;

	hci_dev_lock(hdev);

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

1213
	BT_DBG("%s bdaddr %s hcon %p", hdev->name, batostr(&cp->bdaddr), conn);
L
Linus Torvalds 已提交
1214 1215 1216

	if (status) {
		if (conn && conn->state == BT_CONNECT) {
1217 1218 1219 1220 1221 1222
			if (status != 0x0c || conn->attempt > 2) {
				conn->state = BT_CLOSED;
				hci_proto_connect_cfm(conn, status);
				hci_conn_del(conn);
			} else
				conn->state = BT_CONNECT2;
L
Linus Torvalds 已提交
1223 1224 1225 1226 1227
		}
	} else {
		if (!conn) {
			conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
			if (conn) {
1228
				conn->out = true;
L
Linus Torvalds 已提交
1229 1230
				conn->link_mode |= HCI_LM_MASTER;
			} else
1231
				BT_ERR("No memory for new connection");
L
Linus Torvalds 已提交
1232 1233 1234 1235 1236 1237
		}
	}

	hci_dev_unlock(hdev);
}

1238
static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1239
{
1240 1241 1242
	struct hci_cp_add_sco *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;
L
Linus Torvalds 已提交
1243

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

1246 1247
	if (!status)
		return;
L
Linus Torvalds 已提交
1248

1249 1250 1251
	cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
	if (!cp)
		return;
L
Linus Torvalds 已提交
1252

1253
	handle = __le16_to_cpu(cp->handle);
L
Linus Torvalds 已提交
1254

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

1257
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
1258

1259
	acl = hci_conn_hash_lookup_handle(hdev, handle);
1260 1261 1262 1263
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;
L
Linus Torvalds 已提交
1264

1265 1266 1267
			hci_proto_connect_cfm(sco, status);
			hci_conn_del(sco);
		}
1268
	}
L
Linus Torvalds 已提交
1269

1270 1271
	hci_dev_unlock(hdev);
}
L
Linus Torvalds 已提交
1272

1273 1274 1275 1276 1277
static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_auth_requested *cp;
	struct hci_conn *conn;

1278
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304

	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) {
			hci_proto_connect_cfm(conn, status);
			hci_conn_put(conn);
		}
	}

	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;

1305
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326

	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) {
			hci_proto_connect_cfm(conn, status);
			hci_conn_put(conn);
		}
	}

	hci_dev_unlock(hdev);
}

1327
static int hci_outgoing_auth_needed(struct hci_dev *hdev,
1328
				    struct hci_conn *conn)
1329 1330 1331 1332
{
	if (conn->state != BT_CONFIG || !conn->out)
		return 0;

1333
	if (conn->pending_sec_level == BT_SECURITY_SDP)
1334 1335 1336
		return 0;

	/* Only request authentication for SSP connections or non-SSP
1337
	 * devices with sec_level HIGH or if MITM protection is requested */
1338 1339
	if (!hci_conn_ssp_enabled(conn) && !(conn->auth_type & 0x01) &&
	    conn->pending_sec_level != BT_SECURITY_HIGH)
1340 1341 1342 1343 1344
		return 0;

	return 1;
}

1345
static int hci_resolve_name(struct hci_dev *hdev,
1346
				   struct inquiry_entry *e)
1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359
{
	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);
}

1360
static bool hci_resolve_next_name(struct hci_dev *hdev)
1361 1362 1363 1364
{
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;

1365 1366 1367 1368
	if (list_empty(&discov->resolve))
		return false;

	e = hci_inquiry_cache_lookup_resolve(hdev, BDADDR_ANY, NAME_NEEDED);
1369 1370 1371
	if (!e)
		return false;

1372 1373 1374 1375 1376 1377 1378 1379 1380
	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,
1381
				   bdaddr_t *bdaddr, u8 *name, u8 name_len)
1382 1383 1384 1385 1386
{
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;

	if (conn && !test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
1387 1388
		mgmt_device_connected(hdev, bdaddr, ACL_LINK, 0x00, 0, name,
				      name_len, conn->dev_class);
1389 1390 1391 1392

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

1393 1394 1395 1396 1397 1398 1399
	if (discov->state == DISCOVERY_STOPPING)
		goto discov_complete;

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

	e = hci_inquiry_cache_lookup_resolve(hdev, bdaddr, NAME_PENDING);
1400 1401 1402 1403 1404 1405 1406 1407 1408
	/* 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) {
1409
		e->name_state = NAME_KNOWN;
1410 1411
		mgmt_remote_name(hdev, bdaddr, ACL_LINK, 0x00,
				 e->data.rssi, name, name_len);
1412 1413
	} else {
		e->name_state = NAME_NOT_KNOWN;
1414 1415
	}

1416
	if (hci_resolve_next_name(hdev))
1417 1418 1419 1420 1421 1422
		return;

discov_complete:
	hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
}

1423 1424
static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
{
1425 1426 1427
	struct hci_cp_remote_name_req *cp;
	struct hci_conn *conn;

1428
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440

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

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

1443
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
1444
		hci_check_pending_name(hdev, conn, &cp->bdaddr, NULL, 0);
1445

1446 1447 1448 1449 1450 1451
	if (!conn)
		goto unlock;

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

1452
	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
1453 1454 1455 1456 1457
		struct hci_cp_auth_requested cp;
		cp.handle = __cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
	}

1458
unlock:
1459
	hci_dev_unlock(hdev);
1460
}
L
Linus Torvalds 已提交
1461

1462 1463 1464 1465 1466
static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_read_remote_features *cp;
	struct hci_conn *conn;

1467
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493

	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) {
			hci_proto_connect_cfm(conn, status);
			hci_conn_put(conn);
		}
	}

	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;

1494
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515

	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) {
			hci_proto_connect_cfm(conn, status);
			hci_conn_put(conn);
		}
	}

	hci_dev_unlock(hdev);
}

1516 1517
static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
{
1518 1519 1520 1521
	struct hci_cp_setup_sync_conn *cp;
	struct hci_conn *acl, *sco;
	__u16 handle;

1522
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1523 1524 1525 1526 1527 1528 1529 1530 1531 1532

	if (!status)
		return;

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

	handle = __le16_to_cpu(cp->handle);

1533
	BT_DBG("%s handle 0x%4.4x", hdev->name, handle);
1534 1535 1536 1537

	hci_dev_lock(hdev);

	acl = hci_conn_hash_lookup_handle(hdev, handle);
1538 1539 1540 1541
	if (acl) {
		sco = acl->link;
		if (sco) {
			sco->state = BT_CLOSED;
1542

1543 1544 1545
			hci_proto_connect_cfm(sco, status);
			hci_conn_del(sco);
		}
1546 1547 1548
	}

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

1551
static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
L
Linus Torvalds 已提交
1552
{
1553 1554
	struct hci_cp_sniff_mode *cp;
	struct hci_conn *conn;
L
Linus Torvalds 已提交
1555

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

1558 1559
	if (!status)
		return;
1560

1561 1562 1563
	cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
	if (!cp)
		return;
1564

1565
	hci_dev_lock(hdev);
1566

1567
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1568
	if (conn) {
1569
		clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
1570

1571
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
1572 1573 1574
			hci_sco_setup(conn, status);
	}

1575 1576
	hci_dev_unlock(hdev);
}
1577

1578 1579 1580 1581
static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
{
	struct hci_cp_exit_sniff_mode *cp;
	struct hci_conn *conn;
1582

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

1585 1586
	if (!status)
		return;
1587

1588 1589 1590
	cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
	if (!cp)
		return;
1591

1592
	hci_dev_lock(hdev);
L
Linus Torvalds 已提交
1593

1594
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
1595
	if (conn) {
1596
		clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->flags);
L
Linus Torvalds 已提交
1597

1598
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
1599 1600 1601
			hci_sco_setup(conn, status);
	}

1602
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
1603 1604
}

1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621
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));
	if (conn)
		mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
1622
				       conn->dst_type, status);
1623 1624 1625 1626

	hci_dev_unlock(hdev);
}

V
Ville Tervo 已提交
1627 1628 1629 1630
static void hci_cs_le_create_conn(struct hci_dev *hdev, __u8 status)
{
	struct hci_conn *conn;

1631
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
V
Ville Tervo 已提交
1632

1633 1634
	if (status) {
		hci_dev_lock(hdev);
V
Ville Tervo 已提交
1635

1636
		conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
1637 1638 1639 1640
		if (!conn) {
			hci_dev_unlock(hdev);
			return;
		}
V
Ville Tervo 已提交
1641

1642
		BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&conn->dst),
1643
		       conn);
V
Ville Tervo 已提交
1644

1645
		conn->state = BT_CLOSED;
1646
		mgmt_connect_failed(hdev, &conn->dst, conn->type,
1647 1648 1649
				    conn->dst_type, status);
		hci_proto_connect_cfm(conn, status);
		hci_conn_del(conn);
V
Ville Tervo 已提交
1650

1651 1652
		hci_dev_unlock(hdev);
	}
V
Ville Tervo 已提交
1653 1654
}

1655 1656
static void hci_cs_le_start_enc(struct hci_dev *hdev, u8 status)
{
1657
	BT_DBG("%s status 0x%2.2x", hdev->name, status);
1658 1659
}

1660
static void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
1661 1662
{
	__u8 status = *((__u8 *) skb->data);
1663 1664
	struct discovery_state *discov = &hdev->discovery;
	struct inquiry_entry *e;
L
Linus Torvalds 已提交
1665

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

1668
	hci_req_complete(hdev, HCI_OP_INQUIRY, status);
1669

1670
	hci_conn_check_pending(hdev);
1671 1672 1673 1674

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

1675
	if (!test_bit(HCI_MGMT, &hdev->dev_flags))
1676 1677
		return;

1678
	hci_dev_lock(hdev);
1679

1680
	if (discov->state != DISCOVERY_FINDING)
1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696
		goto unlock;

	if (list_empty(&discov->resolve)) {
		hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
		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 {
		hci_discovery_set_state(hdev, DISCOVERY_STOPPED);
	}

unlock:
1697
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
1698 1699
}

1700
static void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
1701
{
1702
	struct inquiry_data data;
1703
	struct inquiry_info *info = (void *) (skb->data + 1);
L
Linus Torvalds 已提交
1704 1705 1706 1707
	int num_rsp = *((__u8 *) skb->data);

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

1708 1709 1710
	if (!num_rsp)
		return;

1711 1712 1713
	if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
		return;

L
Linus Torvalds 已提交
1714
	hci_dev_lock(hdev);
1715

1716
	for (; num_rsp; num_rsp--, info++) {
1717
		bool name_known, ssp;
1718

L
Linus Torvalds 已提交
1719 1720 1721 1722 1723 1724 1725
		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		= 0x00;
1726
		data.ssp_mode		= 0x00;
1727

1728
		name_known = hci_inquiry_cache_update(hdev, &data, false, &ssp);
1729
		mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
1730 1731
				  info->dev_class, 0, !name_known, ssp, NULL,
				  0);
L
Linus Torvalds 已提交
1732
	}
1733

L
Linus Torvalds 已提交
1734 1735 1736
	hci_dev_unlock(hdev);
}

1737
static void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
1738
{
1739 1740
	struct hci_ev_conn_complete *ev = (void *) skb->data;
	struct hci_conn *conn;
L
Linus Torvalds 已提交
1741 1742 1743 1744 1745 1746

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

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1747 1748 1749 1750 1751 1752 1753 1754 1755 1756
	if (!conn) {
		if (ev->link_type != SCO_LINK)
			goto unlock;

		conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
		if (!conn)
			goto unlock;

		conn->type = SCO_LINK;
	}
L
Linus Torvalds 已提交
1757 1758 1759

	if (!ev->status) {
		conn->handle = __le16_to_cpu(ev->handle);
1760 1761 1762 1763

		if (conn->type == ACL_LINK) {
			conn->state = BT_CONFIG;
			hci_conn_hold(conn);
1764 1765 1766 1767 1768 1769

			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;
1770 1771
		} else
			conn->state = BT_CONNECTED;
L
Linus Torvalds 已提交
1772

1773
		hci_conn_hold_device(conn);
1774 1775
		hci_conn_add_sysfs(conn);

L
Linus Torvalds 已提交
1776 1777 1778 1779 1780 1781
		if (test_bit(HCI_AUTH, &hdev->flags))
			conn->link_mode |= HCI_LM_AUTH;

		if (test_bit(HCI_ENCRYPT, &hdev->flags))
			conn->link_mode |= HCI_LM_ENCRYPT;

1782 1783 1784 1785
		/* Get remote features */
		if (conn->type == ACL_LINK) {
			struct hci_cp_read_remote_features cp;
			cp.handle = ev->handle;
1786
			hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
1787
				     sizeof(cp), &cp);
1788 1789
		}

L
Linus Torvalds 已提交
1790
		/* Set packet type for incoming connection */
1791
		if (!conn->out && hdev->hci_ver < BLUETOOTH_VER_2_0) {
L
Linus Torvalds 已提交
1792 1793
			struct hci_cp_change_conn_ptype cp;
			cp.handle = ev->handle;
1794
			cp.pkt_type = cpu_to_le16(conn->pkt_type);
1795 1796
			hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE, sizeof(cp),
				     &cp);
L
Linus Torvalds 已提交
1797
		}
1798
	} else {
L
Linus Torvalds 已提交
1799
		conn->state = BT_CLOSED;
1800
		if (conn->type == ACL_LINK)
1801
			mgmt_connect_failed(hdev, &ev->bdaddr, conn->type,
1802
					    conn->dst_type, ev->status);
1803
	}
L
Linus Torvalds 已提交
1804

1805 1806
	if (conn->type == ACL_LINK)
		hci_sco_setup(conn, ev->status);
L
Linus Torvalds 已提交
1807

1808 1809
	if (ev->status) {
		hci_proto_connect_cfm(conn, ev->status);
L
Linus Torvalds 已提交
1810
		hci_conn_del(conn);
1811 1812
	} else if (ev->link_type != ACL_LINK)
		hci_proto_connect_cfm(conn, ev->status);
L
Linus Torvalds 已提交
1813

1814
unlock:
L
Linus Torvalds 已提交
1815 1816
	hci_dev_unlock(hdev);

1817
	hci_conn_check_pending(hdev);
L
Linus Torvalds 已提交
1818 1819
}

1820
static void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
1821
{
1822 1823
	struct hci_ev_conn_request *ev = (void *) skb->data;
	int mask = hdev->link_mode;
L
Linus Torvalds 已提交
1824

1825 1826
	BT_DBG("%s bdaddr %s type 0x%x", hdev->name, batostr(&ev->bdaddr),
	       ev->link_type);
L
Linus Torvalds 已提交
1827

1828
	mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
L
Linus Torvalds 已提交
1829

1830
	if ((mask & HCI_LM_ACCEPT) &&
1831
	    !hci_blacklist_lookup(hdev, &ev->bdaddr)) {
1832
		/* Connection accepted */
1833
		struct inquiry_entry *ie;
L
Linus Torvalds 已提交
1834 1835
		struct hci_conn *conn;

1836
		hci_dev_lock(hdev);
1837

1838 1839
		ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
		if (ie)
1840 1841
			memcpy(ie->data.dev_class, ev->dev_class, 3);

1842 1843
		conn = hci_conn_hash_lookup_ba(hdev, ev->link_type,
					       &ev->bdaddr);
1844
		if (!conn) {
1845 1846
			conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr);
			if (!conn) {
1847
				BT_ERR("No memory for new connection");
1848 1849
				hci_dev_unlock(hdev);
				return;
L
Linus Torvalds 已提交
1850 1851
			}
		}
1852

1853 1854
		memcpy(conn->dev_class, ev->dev_class, 3);
		conn->state = BT_CONNECT;
1855

1856
		hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
1857

1858 1859
		if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
			struct hci_cp_accept_conn_req cp;
L
Linus Torvalds 已提交
1860

1861 1862 1863 1864 1865 1866 1867
			bacpy(&cp.bdaddr, &ev->bdaddr);

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

1868 1869
			hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ, sizeof(cp),
				     &cp);
1870 1871 1872 1873
		} else {
			struct hci_cp_accept_sync_conn_req cp;

			bacpy(&cp.bdaddr, &ev->bdaddr);
1874
			cp.pkt_type = cpu_to_le16(conn->pkt_type);
1875

1876 1877 1878
			cp.tx_bandwidth   = __constant_cpu_to_le32(0x00001f40);
			cp.rx_bandwidth   = __constant_cpu_to_le32(0x00001f40);
			cp.max_latency    = __constant_cpu_to_le16(0xffff);
1879 1880
			cp.content_format = cpu_to_le16(hdev->voice_setting);
			cp.retrans_effort = 0xff;
L
Linus Torvalds 已提交
1881

1882
			hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1883
				     sizeof(cp), &cp);
1884
		}
1885 1886 1887
	} else {
		/* Connection rejected */
		struct hci_cp_reject_conn_req cp;
L
Linus Torvalds 已提交
1888

1889
		bacpy(&cp.bdaddr, &ev->bdaddr);
1890
		cp.reason = HCI_ERROR_REJ_BAD_ADDR;
1891
		hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
L
Linus Torvalds 已提交
1892 1893 1894
	}
}

1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910
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;
	}
}

1911
static void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1912
{
1913
	struct hci_ev_disconn_complete *ev = (void *) skb->data;
1914 1915
	struct hci_conn *conn;

1916
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
1917 1918 1919 1920

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1921 1922
	if (!conn)
		goto unlock;
1923

1924 1925
	if (ev->status == 0)
		conn->state = BT_CLOSED;
1926

1927
	if (test_and_clear_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags) &&
1928
	    (conn->type == ACL_LINK || conn->type == LE_LINK)) {
1929
		if (ev->status) {
1930
			mgmt_disconnect_failed(hdev, &conn->dst, conn->type,
1931
					       conn->dst_type, ev->status);
1932 1933 1934
		} else {
			u8 reason = hci_to_mgmt_reason(ev->reason);

1935
			mgmt_device_disconnected(hdev, &conn->dst, conn->type,
1936 1937
						 conn->dst_type, reason);
		}
1938
	}
1939

1940
	if (ev->status == 0) {
1941 1942
		if (conn->type == ACL_LINK && conn->flush_key)
			hci_remove_link_key(hdev, &conn->dst);
1943 1944 1945
		hci_proto_disconn_cfm(conn, ev->reason);
		hci_conn_del(conn);
	}
1946 1947

unlock:
1948 1949 1950
	hci_dev_unlock(hdev);
}

1951
static void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
1952
{
1953
	struct hci_ev_auth_complete *ev = (void *) skb->data;
1954
	struct hci_conn *conn;
L
Linus Torvalds 已提交
1955

1956
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
1957 1958 1959

	hci_dev_lock(hdev);

1960
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1961 1962 1963 1964
	if (!conn)
		goto unlock;

	if (!ev->status) {
1965
		if (!hci_conn_ssp_enabled(conn) &&
1966
		    test_bit(HCI_CONN_REAUTH_PEND, &conn->flags)) {
1967
			BT_INFO("re-auth of legacy device is not possible.");
1968
		} else {
1969 1970
			conn->link_mode |= HCI_LM_AUTH;
			conn->sec_level = conn->pending_sec_level;
1971
		}
1972
	} else {
1973
		mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
1974
				 ev->status);
1975
	}
L
Linus Torvalds 已提交
1976

1977 1978
	clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
	clear_bit(HCI_CONN_REAUTH_PEND, &conn->flags);
L
Linus Torvalds 已提交
1979

1980
	if (conn->state == BT_CONFIG) {
1981
		if (!ev->status && hci_conn_ssp_enabled(conn)) {
1982 1983 1984 1985
			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),
1986
				     &cp);
1987
		} else {
1988 1989
			conn->state = BT_CONNECTED;
			hci_proto_connect_cfm(conn, ev->status);
1990 1991
			hci_conn_put(conn);
		}
1992 1993
	} else {
		hci_auth_cfm(conn, ev->status);
1994

1995 1996 1997 1998 1999
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
		hci_conn_put(conn);
	}

2000
	if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags)) {
2001 2002 2003 2004 2005
		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),
2006
				     &cp);
2007
		} else {
2008
			clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
2009
			hci_encrypt_cfm(conn, ev->status, 0x00);
L
Linus Torvalds 已提交
2010 2011 2012
		}
	}

2013
unlock:
L
Linus Torvalds 已提交
2014 2015 2016
	hci_dev_unlock(hdev);
}

2017
static void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2018
{
2019 2020 2021
	struct hci_ev_remote_name *ev = (void *) skb->data;
	struct hci_conn *conn;

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

2024
	hci_conn_check_pending(hdev);
2025 2026 2027

	hci_dev_lock(hdev);

2028
	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2029

2030 2031
	if (!test_bit(HCI_MGMT, &hdev->dev_flags))
		goto check_auth;
2032

2033 2034
	if (ev->status == 0)
		hci_check_pending_name(hdev, conn, &ev->bdaddr, ev->name,
2035
				       strnlen(ev->name, HCI_MAX_NAME_LENGTH));
2036 2037 2038 2039
	else
		hci_check_pending_name(hdev, conn, &ev->bdaddr, NULL, 0);

check_auth:
2040 2041 2042 2043 2044 2045
	if (!conn)
		goto unlock;

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

2046
	if (!test_and_set_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
2047 2048 2049 2050 2051
		struct hci_cp_auth_requested cp;
		cp.handle = __cpu_to_le16(conn->handle);
		hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED, sizeof(cp), &cp);
	}

2052
unlock:
2053
	hci_dev_unlock(hdev);
2054 2055
}

2056
static void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2057 2058 2059 2060
{
	struct hci_ev_encrypt_change *ev = (void *) skb->data;
	struct hci_conn *conn;

2061
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
2062 2063 2064

	hci_dev_lock(hdev);

2065
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
2066 2067
	if (conn) {
		if (!ev->status) {
2068 2069 2070
			if (ev->encrypt) {
				/* Encryption implies authentication */
				conn->link_mode |= HCI_LM_AUTH;
L
Linus Torvalds 已提交
2071
				conn->link_mode |= HCI_LM_ENCRYPT;
2072
				conn->sec_level = conn->pending_sec_level;
2073
			} else
L
Linus Torvalds 已提交
2074 2075 2076
				conn->link_mode &= ~HCI_LM_ENCRYPT;
		}

2077
		clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->flags);
L
Linus Torvalds 已提交
2078

2079
		if (ev->status && conn->state == BT_CONNECTED) {
2080
			hci_acl_disconn(conn, HCI_ERROR_AUTH_FAILURE);
2081 2082 2083 2084
			hci_conn_put(conn);
			goto unlock;
		}

2085 2086 2087 2088 2089 2090 2091 2092
		if (conn->state == BT_CONFIG) {
			if (!ev->status)
				conn->state = BT_CONNECTED;

			hci_proto_connect_cfm(conn, ev->status);
			hci_conn_put(conn);
		} else
			hci_encrypt_cfm(conn, ev->status, ev->encrypt);
L
Linus Torvalds 已提交
2093 2094
	}

2095
unlock:
L
Linus Torvalds 已提交
2096 2097 2098
	hci_dev_unlock(hdev);
}

2099 2100
static void hci_change_link_key_complete_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
L
Linus Torvalds 已提交
2101
{
2102
	struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
2103
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2104

2105
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
2106 2107 2108

	hci_dev_lock(hdev);

2109
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
2110 2111 2112 2113
	if (conn) {
		if (!ev->status)
			conn->link_mode |= HCI_LM_SECURE;

2114
		clear_bit(HCI_CONN_AUTH_PEND, &conn->flags);
L
Linus Torvalds 已提交
2115 2116 2117 2118 2119 2120 2121

		hci_key_change_cfm(conn, ev->status);
	}

	hci_dev_unlock(hdev);
}

2122 2123
static void hci_remote_features_evt(struct hci_dev *hdev,
				    struct sk_buff *skb)
L
Linus Torvalds 已提交
2124
{
2125 2126 2127
	struct hci_ev_remote_features *ev = (void *) skb->data;
	struct hci_conn *conn;

2128
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2129 2130 2131 2132

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2133 2134
	if (!conn)
		goto unlock;
2135

2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146
	if (!ev->status)
		memcpy(conn->features, ev->features, 8);

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

	if (!ev->status && lmp_ssp_capable(hdev) && lmp_ssp_capable(conn)) {
		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,
2147
			     sizeof(cp), &cp);
2148 2149 2150
		goto unlock;
	}

2151
	if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
2152 2153 2154 2155 2156
		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);
2157 2158
	} else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
		mgmt_device_connected(hdev, &conn->dst, conn->type,
2159 2160
				      conn->dst_type, 0, NULL, 0,
				      conn->dev_class);
2161

2162
	if (!hci_outgoing_auth_needed(hdev, conn)) {
2163 2164 2165
		conn->state = BT_CONNECTED;
		hci_proto_connect_cfm(conn, ev->status);
		hci_conn_put(conn);
2166
	}
2167

2168
unlock:
2169
	hci_dev_unlock(hdev);
L
Linus Torvalds 已提交
2170 2171
}

2172
static void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2173
{
2174
	BT_DBG("%s", hdev->name);
L
Linus Torvalds 已提交
2175 2176
}

2177 2178
static void hci_qos_setup_complete_evt(struct hci_dev *hdev,
				       struct sk_buff *skb)
L
Linus Torvalds 已提交
2179
{
2180
	BT_DBG("%s", hdev->name);
L
Linus Torvalds 已提交
2181 2182
}

2183
static void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196
{
	struct hci_ev_cmd_complete *ev = (void *) skb->data;
	__u16 opcode;

	skb_pull(skb, sizeof(*ev));

	opcode = __le16_to_cpu(ev->opcode);

	switch (opcode) {
	case HCI_OP_INQUIRY_CANCEL:
		hci_cc_inquiry_cancel(hdev, skb);
		break;

2197 2198 2199 2200
	case HCI_OP_PERIODIC_INQ:
		hci_cc_periodic_inq(hdev, skb);
		break;

2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212
	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;

2213 2214 2215 2216
	case HCI_OP_READ_LINK_POLICY:
		hci_cc_read_link_policy(hdev, skb);
		break;

2217 2218 2219 2220
	case HCI_OP_WRITE_LINK_POLICY:
		hci_cc_write_link_policy(hdev, skb);
		break;

2221 2222 2223 2224 2225 2226 2227 2228
	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;

2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268 2269 2270 2271 2272
	case HCI_OP_RESET:
		hci_cc_reset(hdev, skb);
		break;

	case HCI_OP_WRITE_LOCAL_NAME:
		hci_cc_write_local_name(hdev, skb);
		break;

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

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

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

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

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

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

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

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

	case HCI_OP_HOST_BUFFER_SIZE:
		hci_cc_host_buffer_size(hdev, skb);
		break;

2273 2274 2275 2276
	case HCI_OP_WRITE_SSP_MODE:
		hci_cc_write_ssp_mode(hdev, skb);
		break;

2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288
	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;

2289 2290 2291 2292
	case HCI_OP_READ_LOCAL_EXT_FEATURES:
		hci_cc_read_local_ext_features(hdev, skb);
		break;

2293 2294 2295 2296 2297 2298 2299 2300
	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;

2301 2302 2303 2304
	case HCI_OP_READ_DATA_BLOCK_SIZE:
		hci_cc_read_data_block_size(hdev, skb);
		break;

2305 2306 2307 2308
	case HCI_OP_WRITE_CA_TIMEOUT:
		hci_cc_write_ca_timeout(hdev, skb);
		break;

2309 2310 2311 2312
	case HCI_OP_READ_FLOW_CONTROL_MODE:
		hci_cc_read_flow_control_mode(hdev, skb);
		break;

2313 2314 2315 2316
	case HCI_OP_READ_LOCAL_AMP_INFO:
		hci_cc_read_local_amp_info(hdev, skb);
		break;

2317 2318 2319 2320
	case HCI_OP_DELETE_STORED_LINK_KEY:
		hci_cc_delete_stored_link_key(hdev, skb);
		break;

2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336
	case HCI_OP_SET_EVENT_MASK:
		hci_cc_set_event_mask(hdev, skb);
		break;

	case HCI_OP_WRITE_INQUIRY_MODE:
		hci_cc_write_inquiry_mode(hdev, skb);
		break;

	case HCI_OP_READ_INQ_RSP_TX_POWER:
		hci_cc_read_inq_rsp_tx_power(hdev, skb);
		break;

	case HCI_OP_SET_EVENT_FLT:
		hci_cc_set_event_flt(hdev, skb);
		break;

2337 2338 2339 2340 2341 2342 2343 2344
	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;

2345 2346 2347 2348
	case HCI_OP_READ_LOCAL_OOB_DATA:
		hci_cc_read_local_oob_data_reply(hdev, skb);
		break;

2349 2350 2351 2352
	case HCI_OP_LE_READ_BUFFER_SIZE:
		hci_cc_le_read_buffer_size(hdev, skb);
		break;

2353 2354 2355 2356 2357 2358 2359 2360
	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;

2361 2362 2363 2364 2365 2366
	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);
2367
		break;
2368 2369 2370

	case HCI_OP_LE_SET_SCAN_PARAM:
		hci_cc_le_set_scan_param(hdev, skb);
2371 2372
		break;

2373 2374 2375 2376
	case HCI_OP_LE_SET_SCAN_ENABLE:
		hci_cc_le_set_scan_enable(hdev, skb);
		break;

2377 2378 2379 2380 2381 2382 2383 2384
	case HCI_OP_LE_LTK_REPLY:
		hci_cc_le_ltk_reply(hdev, skb);
		break;

	case HCI_OP_LE_LTK_NEG_REPLY:
		hci_cc_le_ltk_neg_reply(hdev, skb);
		break;

2385 2386 2387 2388
	case HCI_OP_WRITE_LE_HOST_SUPPORTED:
		hci_cc_write_le_host_supported(hdev, skb);
		break;

2389
	default:
2390
		BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
2391 2392 2393
		break;
	}

2394 2395 2396
	if (ev->opcode != HCI_OP_NOP)
		del_timer(&hdev->cmd_timer);

2397 2398 2399
	if (ev->ncmd) {
		atomic_set(&hdev->cmd_cnt, 1);
		if (!skb_queue_empty(&hdev->cmd_q))
2400
			queue_work(hdev->workqueue, &hdev->cmd_work);
2401 2402 2403
	}
}

2404
static void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425
{
	struct hci_ev_cmd_status *ev = (void *) skb->data;
	__u16 opcode;

	skb_pull(skb, sizeof(*ev));

	opcode = __le16_to_cpu(ev->opcode);

	switch (opcode) {
	case HCI_OP_INQUIRY:
		hci_cs_inquiry(hdev, ev->status);
		break;

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

	case HCI_OP_ADD_SCO:
		hci_cs_add_sco(hdev, ev->status);
		break;

2426 2427 2428 2429 2430 2431 2432 2433
	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;

2434 2435 2436 2437
	case HCI_OP_REMOTE_NAME_REQ:
		hci_cs_remote_name_req(hdev, ev->status);
		break;

2438 2439 2440 2441 2442 2443 2444 2445
	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;

2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457
	case HCI_OP_SETUP_SYNC_CONN:
		hci_cs_setup_sync_conn(hdev, ev->status);
		break;

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

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

2458
	case HCI_OP_DISCONNECT:
2459
		hci_cs_disconnect(hdev, ev->status);
2460 2461
		break;

V
Ville Tervo 已提交
2462 2463 2464 2465
	case HCI_OP_LE_CREATE_CONN:
		hci_cs_le_create_conn(hdev, ev->status);
		break;

2466 2467 2468 2469
	case HCI_OP_LE_START_ENC:
		hci_cs_le_start_enc(hdev, ev->status);
		break;

2470
	default:
2471
		BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode);
2472 2473 2474
		break;
	}

2475 2476 2477
	if (ev->opcode != HCI_OP_NOP)
		del_timer(&hdev->cmd_timer);

2478
	if (ev->ncmd && !test_bit(HCI_RESET, &hdev->flags)) {
2479 2480
		atomic_set(&hdev->cmd_cnt, 1);
		if (!skb_queue_empty(&hdev->cmd_q))
2481
			queue_work(hdev->workqueue, &hdev->cmd_work);
2482 2483 2484
	}
}

2485
static void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2486 2487 2488 2489
{
	struct hci_ev_role_change *ev = (void *) skb->data;
	struct hci_conn *conn;

2490
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (conn) {
		if (!ev->status) {
			if (ev->role)
				conn->link_mode &= ~HCI_LM_MASTER;
			else
				conn->link_mode |= HCI_LM_MASTER;
		}

2503
		clear_bit(HCI_CONN_RSWITCH_PEND, &conn->flags);
2504 2505 2506 2507 2508 2509 2510

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

	hci_dev_unlock(hdev);
}

2511
static void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
2512 2513 2514 2515
{
	struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
	int i;

2516 2517 2518 2519 2520
	if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_PACKET_BASED) {
		BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
		return;
	}

2521
	if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
2522
	    ev->num_hndl * sizeof(struct hci_comp_pkts_info)) {
2523 2524 2525 2526
		BT_DBG("%s bad parameters", hdev->name);
		return;
	}

2527 2528
	BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);

2529 2530
	for (i = 0; i < ev->num_hndl; i++) {
		struct hci_comp_pkts_info *info = &ev->handles[i];
2531 2532 2533
		struct hci_conn *conn;
		__u16  handle, count;

2534 2535
		handle = __le16_to_cpu(info->handle);
		count  = __le16_to_cpu(info->count);
2536 2537

		conn = hci_conn_hash_lookup_handle(hdev, handle);
2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555
		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 已提交
2556 2557
				hdev->acl_cnt += count;
				if (hdev->acl_cnt > hdev->acl_pkts)
2558 2559
					hdev->acl_cnt = hdev->acl_pkts;
			}
2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570
			break;

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

		default:
			BT_ERR("Unknown type %d conn %p", conn->type, conn);
			break;
2571 2572 2573
		}
	}

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

2577
static void hci_num_comp_blocks_evt(struct hci_dev *hdev, struct sk_buff *skb)
2578 2579 2580 2581 2582 2583 2584 2585 2586 2587
{
	struct hci_ev_num_comp_blocks *ev = (void *) skb->data;
	int i;

	if (hdev->flow_ctl_mode != HCI_FLOW_CTL_MODE_BLOCK_BASED) {
		BT_ERR("Wrong event for mode %d", hdev->flow_ctl_mode);
		return;
	}

	if (skb->len < sizeof(*ev) || skb->len < sizeof(*ev) +
2588
	    ev->num_hndl * sizeof(struct hci_comp_blocks_info)) {
2589 2590 2591 2592 2593
		BT_DBG("%s bad parameters", hdev->name);
		return;
	}

	BT_DBG("%s num_blocks %d num_hndl %d", hdev->name, ev->num_blocks,
2594
	       ev->num_hndl);
2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625

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

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

		conn = hci_conn_hash_lookup_handle(hdev, handle);
		if (!conn)
			continue;

		conn->sent -= block_count;

		switch (conn->type) {
		case ACL_LINK:
			hdev->block_cnt += block_count;
			if (hdev->block_cnt > hdev->num_blocks)
				hdev->block_cnt = hdev->num_blocks;
			break;

		default:
			BT_ERR("Unknown type %d conn %p", conn->type, conn);
			break;
		}
	}

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

2626
static void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2627
{
2628
	struct hci_ev_mode_change *ev = (void *) skb->data;
2629 2630
	struct hci_conn *conn;

2631
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2632 2633 2634 2635

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2636 2637 2638 2639
	if (conn) {
		conn->mode = ev->mode;
		conn->interval = __le16_to_cpu(ev->interval);

2640 2641
		if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND,
					&conn->flags)) {
2642
			if (conn->mode == HCI_CM_ACTIVE)
2643
				set_bit(HCI_CONN_POWER_SAVE, &conn->flags);
2644
			else
2645
				clear_bit(HCI_CONN_POWER_SAVE, &conn->flags);
2646
		}
2647

2648
		if (test_and_clear_bit(HCI_CONN_SCO_SETUP_PEND, &conn->flags))
2649
			hci_sco_setup(conn, ev->status);
2650 2651 2652 2653 2654
	}

	hci_dev_unlock(hdev);
}

2655
static void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2656
{
2657 2658 2659
	struct hci_ev_pin_code_req *ev = (void *) skb->data;
	struct hci_conn *conn;

2660
	BT_DBG("%s", hdev->name);
2661 2662 2663 2664

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2665 2666 2667 2668
	if (!conn)
		goto unlock;

	if (conn->state == BT_CONNECTED) {
2669 2670 2671 2672 2673
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_PAIRING_TIMEOUT;
		hci_conn_put(conn);
	}

2674
	if (!test_bit(HCI_PAIRABLE, &hdev->dev_flags))
2675
		hci_send_cmd(hdev, HCI_OP_PIN_CODE_NEG_REPLY,
2676
			     sizeof(ev->bdaddr), &ev->bdaddr);
2677
	else if (test_bit(HCI_MGMT, &hdev->dev_flags)) {
2678 2679 2680 2681 2682 2683 2684
		u8 secure;

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

2685
		mgmt_pin_code_request(hdev, &ev->bdaddr, secure);
2686
	}
2687

2688
unlock:
2689
	hci_dev_unlock(hdev);
2690 2691
}

2692
static void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
2693
{
2694 2695 2696 2697 2698
	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;

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

2701
	if (!test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
2702 2703 2704 2705 2706 2707 2708
		return;

	hci_dev_lock(hdev);

	key = hci_find_link_key(hdev, &ev->bdaddr);
	if (!key) {
		BT_DBG("%s link key not found for %s", hdev->name,
2709
		       batostr(&ev->bdaddr));
2710 2711 2712 2713
		goto not_found;
	}

	BT_DBG("%s found key type %u for %s", hdev->name, key->type,
2714
	       batostr(&ev->bdaddr));
2715

2716
	if (!test_bit(HCI_DEBUG_KEYS, &hdev->dev_flags) &&
2717
	    key->type == HCI_LK_DEBUG_COMBINATION) {
2718 2719 2720 2721 2722
		BT_DBG("%s ignoring debug key", hdev->name);
		goto not_found;
	}

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
2723 2724
	if (conn) {
		if (key->type == HCI_LK_UNAUTH_COMBINATION &&
2725
		    conn->auth_type != 0xff && (conn->auth_type & 0x01)) {
2726 2727 2728
			BT_DBG("%s ignoring unauthenticated key", hdev->name);
			goto not_found;
		}
2729

2730
		if (key->type == HCI_LK_COMBINATION && key->pin_len < 16 &&
2731
		    conn->pending_sec_level == BT_SECURITY_HIGH) {
2732 2733
			BT_DBG("%s ignoring key unauthenticated for high security",
			       hdev->name);
2734 2735 2736 2737 2738
			goto not_found;
		}

		conn->key_type = key->type;
		conn->pin_length = key->pin_len;
2739 2740 2741
	}

	bacpy(&cp.bdaddr, &ev->bdaddr);
2742
	memcpy(cp.link_key, key->val, HCI_LINK_KEY_SIZE);
2743 2744 2745 2746 2747 2748 2749 2750 2751 2752

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

2755
static void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
2756
{
2757 2758
	struct hci_ev_link_key_notify *ev = (void *) skb->data;
	struct hci_conn *conn;
2759
	u8 pin_len = 0;
2760

2761
	BT_DBG("%s", hdev->name);
2762 2763 2764 2765 2766 2767 2768

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
	if (conn) {
		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
2769
		pin_len = conn->pin_length;
2770 2771 2772 2773

		if (ev->key_type != HCI_LK_CHANGED_COMBINATION)
			conn->key_type = ev->key_type;

2774 2775 2776
		hci_conn_put(conn);
	}

2777
	if (test_bit(HCI_LINK_KEYS, &hdev->dev_flags))
2778
		hci_add_link_key(hdev, conn, 1, &ev->bdaddr, ev->link_key,
2779
				 ev->key_type, pin_len);
2780

2781
	hci_dev_unlock(hdev);
2782 2783
}

2784
static void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
L
Linus Torvalds 已提交
2785
{
2786
	struct hci_ev_clock_offset *ev = (void *) skb->data;
2787
	struct hci_conn *conn;
L
Linus Torvalds 已提交
2788

2789
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
L
Linus Torvalds 已提交
2790 2791 2792

	hci_dev_lock(hdev);

2793
	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
L
Linus Torvalds 已提交
2794 2795 2796
	if (conn && !ev->status) {
		struct inquiry_entry *ie;

2797 2798
		ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
		if (ie) {
L
Linus Torvalds 已提交
2799 2800 2801 2802 2803 2804 2805 2806
			ie->data.clock_offset = ev->clock_offset;
			ie->timestamp = jiffies;
		}
	}

	hci_dev_unlock(hdev);
}

2807
static void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
2808 2809 2810 2811
{
	struct hci_ev_pkt_type_change *ev = (void *) skb->data;
	struct hci_conn *conn;

2812
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2813 2814 2815 2816 2817 2818 2819 2820 2821 2822

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

2823
static void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
2824
{
2825
	struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
2826 2827 2828 2829 2830 2831
	struct inquiry_entry *ie;

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

	hci_dev_lock(hdev);

2832 2833
	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie) {
2834 2835 2836 2837 2838 2839 2840
		ie->data.pscan_rep_mode = ev->pscan_rep_mode;
		ie->timestamp = jiffies;
	}

	hci_dev_unlock(hdev);
}

2841 2842
static void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev,
					     struct sk_buff *skb)
2843 2844 2845
{
	struct inquiry_data data;
	int num_rsp = *((__u8 *) skb->data);
2846
	bool name_known, ssp;
2847 2848 2849 2850 2851 2852

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

	if (!num_rsp)
		return;

2853 2854 2855
	if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
		return;

2856 2857 2858
	hci_dev_lock(hdev);

	if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
2859 2860
		struct inquiry_info_with_rssi_and_pscan_mode *info;
		info = (void *) (skb->data + 1);
2861

2862
		for (; num_rsp; num_rsp--, info++) {
2863 2864 2865 2866 2867 2868 2869
			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;
2870
			data.ssp_mode		= 0x00;
2871 2872

			name_known = hci_inquiry_cache_update(hdev, &data,
2873
							      false, &ssp);
2874
			mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
2875 2876
					  info->dev_class, info->rssi,
					  !name_known, ssp, NULL, 0);
2877 2878 2879 2880
		}
	} else {
		struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);

2881
		for (; num_rsp; num_rsp--, info++) {
2882 2883 2884 2885 2886 2887 2888
			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;
2889
			data.ssp_mode		= 0x00;
2890
			name_known = hci_inquiry_cache_update(hdev, &data,
2891
							      false, &ssp);
2892
			mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
2893 2894
					  info->dev_class, info->rssi,
					  !name_known, ssp, NULL, 0);
2895 2896 2897 2898 2899 2900
		}
	}

	hci_dev_unlock(hdev);
}

2901 2902
static void hci_remote_ext_features_evt(struct hci_dev *hdev,
					struct sk_buff *skb)
2903
{
2904 2905 2906
	struct hci_ev_remote_ext_features *ev = (void *) skb->data;
	struct hci_conn *conn;

2907
	BT_DBG("%s", hdev->name);
2908 2909 2910 2911

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
2912 2913
	if (!conn)
		goto unlock;
2914

2915 2916
	if (!ev->status && ev->page == 0x01) {
		struct inquiry_entry *ie;
2917

2918 2919
		ie = hci_inquiry_cache_lookup(hdev, &conn->dst);
		if (ie)
2920
			ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
2921

2922
		if (ev->features[0] & LMP_HOST_SSP)
2923
			set_bit(HCI_CONN_SSP_ENABLED, &conn->flags);
2924 2925 2926 2927 2928
	}

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

2929
	if (!ev->status && !test_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags)) {
2930 2931 2932 2933 2934
		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);
2935 2936
	} else if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
		mgmt_device_connected(hdev, &conn->dst, conn->type,
2937 2938
				      conn->dst_type, 0, NULL, 0,
				      conn->dev_class);
2939

2940
	if (!hci_outgoing_auth_needed(hdev, conn)) {
2941 2942 2943
		conn->state = BT_CONNECTED;
		hci_proto_connect_cfm(conn, ev->status);
		hci_conn_put(conn);
2944 2945
	}

2946
unlock:
2947
	hci_dev_unlock(hdev);
2948 2949
}

2950 2951
static void hci_sync_conn_complete_evt(struct hci_dev *hdev,
				       struct sk_buff *skb)
2952
{
2953 2954 2955
	struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

2956
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
2957 2958 2959 2960

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
2961 2962 2963 2964 2965 2966 2967 2968 2969 2970
	if (!conn) {
		if (ev->link_type == ESCO_LINK)
			goto unlock;

		conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
		if (!conn)
			goto unlock;

		conn->type = SCO_LINK;
	}
2971

2972 2973
	switch (ev->status) {
	case 0x00:
2974 2975
		conn->handle = __le16_to_cpu(ev->handle);
		conn->state  = BT_CONNECTED;
2976

2977
		hci_conn_hold_device(conn);
2978
		hci_conn_add_sysfs(conn);
2979 2980
		break;

2981
	case 0x11:	/* Unsupported Feature or Parameter Value */
2982
	case 0x1c:	/* SCO interval rejected */
2983
	case 0x1a:	/* Unsupported Remote Feature */
2984 2985 2986 2987 2988 2989 2990 2991 2992 2993
	case 0x1f:	/* Unspecified error */
		if (conn->out && conn->attempt < 2) {
			conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
					(hdev->esco_type & EDR_ESCO_MASK);
			hci_setup_sync(conn, conn->link->handle);
			goto unlock;
		}
		/* fall through */

	default:
2994
		conn->state = BT_CLOSED;
2995 2996
		break;
	}
2997 2998 2999 3000 3001 3002 3003

	hci_proto_connect_cfm(conn, ev->status);
	if (ev->status)
		hci_conn_del(conn);

unlock:
	hci_dev_unlock(hdev);
3004 3005
}

3006
static void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
3007 3008 3009 3010
{
	BT_DBG("%s", hdev->name);
}

3011
static void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
3012
{
3013
	struct hci_ev_sniff_subrate *ev = (void *) skb->data;
3014

3015
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
3016 3017
}

3018 3019
static void hci_extended_inquiry_result_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
L
Linus Torvalds 已提交
3020
{
3021 3022 3023
	struct inquiry_data data;
	struct extended_inquiry_info *info = (void *) (skb->data + 1);
	int num_rsp = *((__u8 *) skb->data);
3024
	size_t eir_len;
L
Linus Torvalds 已提交
3025

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

3028 3029
	if (!num_rsp)
		return;
L
Linus Torvalds 已提交
3030

3031 3032 3033
	if (test_bit(HCI_PERIODIC_INQ, &hdev->dev_flags))
		return;

3034 3035
	hci_dev_lock(hdev);

3036
	for (; num_rsp; num_rsp--, info++) {
3037
		bool name_known, ssp;
3038

3039
		bacpy(&data.bdaddr, &info->bdaddr);
3040 3041 3042
		data.pscan_rep_mode	= info->pscan_rep_mode;
		data.pscan_period_mode	= info->pscan_period_mode;
		data.pscan_mode		= 0x00;
3043
		memcpy(data.dev_class, info->dev_class, 3);
3044 3045
		data.clock_offset	= info->clock_offset;
		data.rssi		= info->rssi;
3046
		data.ssp_mode		= 0x01;
3047

3048
		if (test_bit(HCI_MGMT, &hdev->dev_flags))
3049
			name_known = eir_has_data_type(info->data,
3050 3051
						       sizeof(info->data),
						       EIR_NAME_COMPLETE);
3052 3053 3054
		else
			name_known = true;

3055
		name_known = hci_inquiry_cache_update(hdev, &data, name_known,
3056
						      &ssp);
3057
		eir_len = eir_get_length(info->data, sizeof(info->data));
3058
		mgmt_device_found(hdev, &info->bdaddr, ACL_LINK, 0x00,
3059
				  info->dev_class, info->rssi, !name_known,
3060
				  ssp, info->data, eir_len);
3061 3062 3063 3064
	}

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

3066 3067 3068 3069 3070 3071
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;

3072
	BT_DBG("%s status 0x%2.2x handle 0x%4.4x", hdev->name, ev->status,
3073 3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109
	       __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;

	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) {
		hci_acl_disconn(conn, HCI_ERROR_AUTH_FAILURE);
		hci_conn_put(conn);
		goto unlock;
	}

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

		hci_proto_connect_cfm(conn, ev->status);
		hci_conn_put(conn);
	} else {
		hci_auth_cfm(conn, ev->status);

		hci_conn_hold(conn);
		conn->disc_timeout = HCI_DISCONN_TIMEOUT;
		hci_conn_put(conn);
	}

unlock:
	hci_dev_unlock(hdev);
}

3110
static u8 hci_get_auth_req(struct hci_conn *conn)
3111 3112 3113 3114 3115 3116 3117 3118 3119 3120 3121 3122 3123
{
	/* If remote requests dedicated bonding follow that lead */
	if (conn->remote_auth == 0x02 || conn->remote_auth == 0x03) {
		/* If both remote and local IO capabilities allow MITM
		 * protection then require it, otherwise don't */
		if (conn->remote_cap == 0x03 || conn->io_capability == 0x03)
			return 0x02;
		else
			return 0x03;
	}

	/* If remote requests no-bonding follow that lead */
	if (conn->remote_auth == 0x00 || conn->remote_auth == 0x01)
3124
		return conn->remote_auth | (conn->auth_type & 0x01);
3125 3126 3127 3128

	return conn->auth_type;
}

3129
static void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
3130 3131 3132 3133 3134 3135 3136 3137 3138
{
	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);
3139 3140 3141 3142 3143
	if (!conn)
		goto unlock;

	hci_conn_hold(conn);

3144
	if (!test_bit(HCI_MGMT, &hdev->dev_flags))
3145 3146
		goto unlock;

3147
	if (test_bit(HCI_PAIRABLE, &hdev->dev_flags) ||
3148
	    (conn->remote_auth & ~0x01) == HCI_AT_NO_BONDING) {
3149 3150 3151
		struct hci_cp_io_capability_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
3152 3153 3154 3155
		/* Change the IO capability from KeyboardDisplay
		 * to DisplayYesNo as it is not supported by BT spec. */
		cp.capability = (conn->io_capability == 0x04) ?
						0x01 : conn->io_capability;
3156 3157
		conn->auth_type = hci_get_auth_req(conn);
		cp.authentication = conn->auth_type;
3158

3159 3160
		if (hci_find_remote_oob_data(hdev, &conn->dst) &&
		    (conn->out || test_bit(HCI_CONN_REMOTE_OOB, &conn->flags)))
3161 3162 3163 3164
			cp.oob_data = 0x01;
		else
			cp.oob_data = 0x00;

3165
		hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_REPLY,
3166
			     sizeof(cp), &cp);
3167 3168 3169 3170
	} else {
		struct hci_cp_io_capability_neg_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
3171
		cp.reason = HCI_ERROR_PAIRING_NOT_ALLOWED;
3172

3173
		hci_send_cmd(hdev, HCI_OP_IO_CAPABILITY_NEG_REPLY,
3174
			     sizeof(cp), &cp);
3175 3176 3177 3178 3179 3180
	}

unlock:
	hci_dev_unlock(hdev);
}

3181
static void hci_io_capa_reply_evt(struct hci_dev *hdev, struct sk_buff *skb)
3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195
{
	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;
3196 3197
	if (ev->oob_data)
		set_bit(HCI_CONN_REMOTE_OOB, &conn->flags);
3198 3199

unlock:
3200 3201 3202
	hci_dev_unlock(hdev);
}

3203 3204
static void hci_user_confirm_request_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
3205 3206
{
	struct hci_ev_user_confirm_req *ev = (void *) skb->data;
3207
	int loc_mitm, rem_mitm, confirm_hint = 0;
3208
	struct hci_conn *conn;
3209 3210 3211 3212 3213

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

	hci_dev_lock(hdev);

3214
	if (!test_bit(HCI_MGMT, &hdev->dev_flags))
3215
		goto unlock;
3216

3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230 3231
	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
	 * (it has NoInputNoOutput) then reject the confirmation
	 * request. The only exception is when we're dedicated bonding
	 * initiators (connect_cfm_cb set) since then we always have the MITM
	 * bit set. */
	if (!conn->connect_cfm_cb && loc_mitm && conn->remote_cap == 0x03) {
		BT_DBG("Rejecting request: remote device can't provide MITM");
		hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_NEG_REPLY,
3232
			     sizeof(ev->bdaddr), &ev->bdaddr);
3233 3234 3235 3236 3237
		goto unlock;
	}

	/* If no side requires MITM protection; auto-accept */
	if ((!loc_mitm || conn->remote_cap == 0x03) &&
3238
	    (!rem_mitm || conn->io_capability == 0x03)) {
3239 3240 3241 3242

		/* If we're not the initiators request authorization to
		 * proceed from user space (mgmt_user_confirm with
		 * confirm_hint set to 1). */
3243
		if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags)) {
3244 3245 3246 3247 3248
			BT_DBG("Confirming auto-accept as acceptor");
			confirm_hint = 1;
			goto confirm;
		}

3249
		BT_DBG("Auto-accept of user confirmation with %ums delay",
3250
		       hdev->auto_accept_delay);
3251 3252 3253 3254 3255 3256 3257

		if (hdev->auto_accept_delay > 0) {
			int delay = msecs_to_jiffies(hdev->auto_accept_delay);
			mod_timer(&conn->auto_accept_timer, jiffies + delay);
			goto unlock;
		}

3258
		hci_send_cmd(hdev, HCI_OP_USER_CONFIRM_REPLY,
3259
			     sizeof(ev->bdaddr), &ev->bdaddr);
3260 3261 3262
		goto unlock;
	}

3263
confirm:
3264
	mgmt_user_confirm_request(hdev, &ev->bdaddr, ACL_LINK, 0, ev->passkey,
3265
				  confirm_hint);
3266 3267

unlock:
3268 3269 3270
	hci_dev_unlock(hdev);
}

3271 3272
static void hci_user_passkey_request_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
3273 3274 3275 3276 3277
{
	struct hci_ev_user_passkey_req *ev = (void *) skb->data;

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

3278
	if (test_bit(HCI_MGMT, &hdev->dev_flags))
3279
		mgmt_user_passkey_request(hdev, &ev->bdaddr, ACL_LINK, 0);
3280 3281
}

3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303 3304 3305 3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324 3325 3326 3327 3328 3329 3330 3331 3332 3333 3334 3335 3336 3337 3338 3339 3340
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;

	if (test_bit(HCI_MGMT, &hdev->dev_flags))
		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;
	}

	if (test_bit(HCI_MGMT, &hdev->dev_flags))
		mgmt_user_passkey_notify(hdev, &conn->dst, conn->type,
					 conn->dst_type, conn->passkey_notify,
					 conn->passkey_entered);
}

3341 3342
static void hci_simple_pair_complete_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
3343 3344 3345 3346 3347 3348 3349 3350 3351
{
	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);
3352 3353 3354 3355 3356 3357 3358 3359
	if (!conn)
		goto unlock;

	/* 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 */
3360
	if (!test_bit(HCI_CONN_AUTH_PEND, &conn->flags) && ev->status)
3361
		mgmt_auth_failed(hdev, &conn->dst, conn->type, conn->dst_type,
3362
				 ev->status);
3363

3364 3365 3366
	hci_conn_put(conn);

unlock:
3367 3368 3369
	hci_dev_unlock(hdev);
}

3370 3371
static void hci_remote_host_features_evt(struct hci_dev *hdev,
					 struct sk_buff *skb)
3372 3373 3374 3375 3376 3377 3378 3379
{
	struct hci_ev_remote_host_features *ev = (void *) skb->data;
	struct inquiry_entry *ie;

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

	hci_dev_lock(hdev);

3380 3381
	ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr);
	if (ie)
3382
		ie->data.ssp_mode = (ev->features[0] & LMP_HOST_SSP);
3383 3384 3385 3386

	hci_dev_unlock(hdev);
}

3387 3388
static void hci_remote_oob_data_request_evt(struct hci_dev *hdev,
					    struct sk_buff *skb)
3389 3390 3391 3392 3393 3394 3395 3396
{
	struct hci_ev_remote_oob_data_request *ev = (void *) skb->data;
	struct oob_data *data;

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

	hci_dev_lock(hdev);

3397
	if (!test_bit(HCI_MGMT, &hdev->dev_flags))
3398 3399
		goto unlock;

3400 3401 3402 3403 3404 3405 3406 3407 3408
	data = hci_find_remote_oob_data(hdev, &ev->bdaddr);
	if (data) {
		struct hci_cp_remote_oob_data_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
		memcpy(cp.hash, data->hash, sizeof(cp.hash));
		memcpy(cp.randomizer, data->randomizer, sizeof(cp.randomizer));

		hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_REPLY, sizeof(cp),
3409
			     &cp);
3410 3411 3412 3413 3414
	} else {
		struct hci_cp_remote_oob_data_neg_reply cp;

		bacpy(&cp.bdaddr, &ev->bdaddr);
		hci_send_cmd(hdev, HCI_OP_REMOTE_OOB_DATA_NEG_REPLY, sizeof(cp),
3415
			     &cp);
3416 3417
	}

3418
unlock:
3419 3420 3421
	hci_dev_unlock(hdev);
}

3422
static void hci_le_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
V
Ville Tervo 已提交
3423 3424 3425 3426
{
	struct hci_ev_le_conn_complete *ev = (void *) skb->data;
	struct hci_conn *conn;

3427
	BT_DBG("%s status 0x%2.2x", hdev->name, ev->status);
V
Ville Tervo 已提交
3428 3429 3430

	hci_dev_lock(hdev);

3431
	conn = hci_conn_hash_lookup_state(hdev, LE_LINK, BT_CONNECT);
3432 3433 3434 3435
	if (!conn) {
		conn = hci_conn_add(hdev, LE_LINK, &ev->bdaddr);
		if (!conn) {
			BT_ERR("No memory for new connection");
A
Andre Guedes 已提交
3436
			goto unlock;
3437
		}
3438 3439

		conn->dst_type = ev->bdaddr_type;
3440 3441 3442 3443 3444

		if (ev->role == LE_CONN_ROLE_MASTER) {
			conn->out = true;
			conn->link_mode |= HCI_LM_MASTER;
		}
3445
	}
V
Ville Tervo 已提交
3446

3447 3448 3449 3450 3451 3452 3453 3454 3455
	if (ev->status) {
		mgmt_connect_failed(hdev, &conn->dst, conn->type,
				    conn->dst_type, ev->status);
		hci_proto_connect_cfm(conn, ev->status);
		conn->state = BT_CLOSED;
		hci_conn_del(conn);
		goto unlock;
	}

3456 3457
	if (!test_and_set_bit(HCI_CONN_MGMT_CONNECTED, &conn->flags))
		mgmt_device_connected(hdev, &ev->bdaddr, conn->type,
3458
				      conn->dst_type, 0, NULL, 0, NULL);
3459

3460
	conn->sec_level = BT_SECURITY_LOW;
V
Ville Tervo 已提交
3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472
	conn->handle = __le16_to_cpu(ev->handle);
	conn->state = BT_CONNECTED;

	hci_conn_hold_device(conn);
	hci_conn_add_sysfs(conn);

	hci_proto_connect_cfm(conn, ev->status);

unlock:
	hci_dev_unlock(hdev);
}

3473
static void hci_le_adv_report_evt(struct hci_dev *hdev, struct sk_buff *skb)
3474
{
3475 3476
	u8 num_reports = skb->data[0];
	void *ptr = &skb->data[1];
A
Andre Guedes 已提交
3477
	s8 rssi;
3478 3479 3480

	hci_dev_lock(hdev);

3481 3482
	while (num_reports--) {
		struct hci_ev_le_advertising_info *ev = ptr;
3483

A
Andre Guedes 已提交
3484 3485
		rssi = ev->data[ev->length];
		mgmt_device_found(hdev, &ev->bdaddr, LE_LINK, ev->bdaddr_type,
3486
				  NULL, rssi, 0, 1, ev->data, ev->length);
A
Andre Guedes 已提交
3487

3488
		ptr += sizeof(*ev) + ev->length + 1;
3489 3490 3491 3492 3493
	}

	hci_dev_unlock(hdev);
}

3494
static void hci_le_ltk_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
3495 3496 3497
{
	struct hci_ev_le_ltk_req *ev = (void *) skb->data;
	struct hci_cp_le_ltk_reply cp;
3498
	struct hci_cp_le_ltk_neg_reply neg;
3499
	struct hci_conn *conn;
3500
	struct smp_ltk *ltk;
3501

3502
	BT_DBG("%s handle 0x%4.4x", hdev->name, __le16_to_cpu(ev->handle));
3503 3504 3505 3506

	hci_dev_lock(hdev);

	conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
3507 3508
	if (conn == NULL)
		goto not_found;
3509

3510 3511 3512 3513 3514
	ltk = hci_find_ltk(hdev, ev->ediv, ev->random);
	if (ltk == NULL)
		goto not_found;

	memcpy(cp.ltk, ltk->val, sizeof(ltk->val));
3515
	cp.handle = cpu_to_le16(conn->handle);
3516 3517 3518

	if (ltk->authenticated)
		conn->sec_level = BT_SECURITY_HIGH;
3519 3520 3521

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

3522 3523 3524 3525 3526
	if (ltk->type & HCI_SMP_STK) {
		list_del(&ltk->list);
		kfree(ltk);
	}

3527
	hci_dev_unlock(hdev);
3528 3529 3530 3531 3532 3533 3534

	return;

not_found:
	neg.handle = ev->handle;
	hci_send_cmd(hdev, HCI_OP_LE_LTK_NEG_REPLY, sizeof(neg), &neg);
	hci_dev_unlock(hdev);
3535 3536
}

3537
static void hci_le_meta_evt(struct hci_dev *hdev, struct sk_buff *skb)
V
Ville Tervo 已提交
3538 3539 3540 3541 3542 3543 3544 3545 3546 3547
{
	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;

3548 3549 3550 3551
	case HCI_EV_LE_ADVERTISING_REPORT:
		hci_le_adv_report_evt(hdev, skb);
		break;

3552 3553 3554 3555
	case HCI_EV_LE_LTK_REQ:
		hci_le_ltk_request_evt(hdev, skb);
		break;

V
Ville Tervo 已提交
3556 3557 3558 3559 3560
	default:
		break;
	}
}

3561 3562 3563 3564 3565 3566 3567 3568
void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
{
	struct hci_event_hdr *hdr = (void *) skb->data;
	__u8 event = hdr->evt;

	skb_pull(skb, HCI_EVENT_HDR_SIZE);

	switch (event) {
L
Linus Torvalds 已提交
3569 3570 3571 3572 3573 3574 3575 3576
	case HCI_EV_INQUIRY_COMPLETE:
		hci_inquiry_complete_evt(hdev, skb);
		break;

	case HCI_EV_INQUIRY_RESULT:
		hci_inquiry_result_evt(hdev, skb);
		break;

3577 3578
	case HCI_EV_CONN_COMPLETE:
		hci_conn_complete_evt(hdev, skb);
3579 3580
		break;

L
Linus Torvalds 已提交
3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591 3592
	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;

3593 3594 3595 3596
	case HCI_EV_REMOTE_NAME:
		hci_remote_name_evt(hdev, skb);
		break;

L
Linus Torvalds 已提交
3597 3598 3599 3600
	case HCI_EV_ENCRYPT_CHANGE:
		hci_encrypt_change_evt(hdev, skb);
		break;

3601 3602 3603 3604 3605 3606 3607 3608 3609 3610 3611 3612 3613 3614 3615 3616 3617 3618 3619 3620 3621 3622 3623 3624 3625 3626 3627 3628 3629 3630 3631 3632 3633 3634
	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_REMOTE_VERSION:
		hci_remote_version_evt(hdev, skb);
		break;

	case HCI_EV_QOS_SETUP_COMPLETE:
		hci_qos_setup_complete_evt(hdev, skb);
		break;

	case HCI_EV_CMD_COMPLETE:
		hci_cmd_complete_evt(hdev, skb);
		break;

	case HCI_EV_CMD_STATUS:
		hci_cmd_status_evt(hdev, skb);
		break;

	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 已提交
3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652
		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;

3653 3654 3655 3656
	case HCI_EV_PKT_TYPE_CHANGE:
		hci_pkt_type_change_evt(hdev, skb);
		break;

3657 3658 3659 3660
	case HCI_EV_PSCAN_REP_MODE:
		hci_pscan_rep_mode_evt(hdev, skb);
		break;

3661 3662
	case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
		hci_inquiry_result_with_rssi_evt(hdev, skb);
3663 3664
		break;

3665 3666
	case HCI_EV_REMOTE_EXT_FEATURES:
		hci_remote_ext_features_evt(hdev, skb);
L
Linus Torvalds 已提交
3667 3668
		break;

3669 3670 3671
	case HCI_EV_SYNC_CONN_COMPLETE:
		hci_sync_conn_complete_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
3672

3673 3674 3675
	case HCI_EV_SYNC_CONN_CHANGED:
		hci_sync_conn_changed_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
3676

3677 3678 3679
	case HCI_EV_SNIFF_SUBRATE:
		hci_sniff_subrate_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
3680

3681 3682 3683
	case HCI_EV_EXTENDED_INQUIRY_RESULT:
		hci_extended_inquiry_result_evt(hdev, skb);
		break;
L
Linus Torvalds 已提交
3684

3685 3686 3687 3688
	case HCI_EV_KEY_REFRESH_COMPLETE:
		hci_key_refresh_complete_evt(hdev, skb);
		break;

3689 3690 3691 3692
	case HCI_EV_IO_CAPA_REQUEST:
		hci_io_capa_request_evt(hdev, skb);
		break;

3693 3694 3695 3696
	case HCI_EV_IO_CAPA_REPLY:
		hci_io_capa_reply_evt(hdev, skb);
		break;

3697 3698 3699 3700
	case HCI_EV_USER_CONFIRM_REQUEST:
		hci_user_confirm_request_evt(hdev, skb);
		break;

3701 3702 3703 3704
	case HCI_EV_USER_PASSKEY_REQUEST:
		hci_user_passkey_request_evt(hdev, skb);
		break;

3705 3706 3707 3708 3709 3710 3711 3712
	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;

3713 3714 3715 3716
	case HCI_EV_SIMPLE_PAIR_COMPLETE:
		hci_simple_pair_complete_evt(hdev, skb);
		break;

3717 3718 3719 3720
	case HCI_EV_REMOTE_HOST_FEATURES:
		hci_remote_host_features_evt(hdev, skb);
		break;

V
Ville Tervo 已提交
3721 3722 3723 3724
	case HCI_EV_LE_META:
		hci_le_meta_evt(hdev, skb);
		break;

3725 3726 3727 3728
	case HCI_EV_REMOTE_OOB_DATA_REQUEST:
		hci_remote_oob_data_request_evt(hdev, skb);
		break;

3729 3730 3731 3732
	case HCI_EV_NUM_COMP_BLOCKS:
		hci_num_comp_blocks_evt(hdev, skb);
		break;

3733
	default:
3734
		BT_DBG("%s event 0x%2.2x", hdev->name, event);
L
Linus Torvalds 已提交
3735 3736 3737 3738 3739 3740
		break;
	}

	kfree_skb(skb);
	hdev->stat.evt_rx++;
}