2 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (C) 2000-2001 Qualcomm Incorporated
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
15 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
20 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
22 SOFTWARE IS DISCLAIMED.
25 /* Bluetooth HCI event handling. */
27 #include <linux/module.h>
29 #include <linux/types.h>
30 #include <linux/errno.h>
31 #include <linux/kernel.h>
32 #include <linux/slab.h>
33 #include <linux/poll.h>
34 #include <linux/fcntl.h>
35 #include <linux/init.h>
36 #include <linux/skbuff.h>
37 #include <linux/interrupt.h>
38 #include <linux/notifier.h>
41 #include <asm/system.h>
42 #include <asm/uaccess.h>
43 #include <asm/unaligned.h>
45 #include <net/bluetooth/bluetooth.h>
46 #include <net/bluetooth/hci_core.h>
48 /* Handle HCI Event packets */
50 static void hci_cc_inquiry_cancel(struct hci_dev
*hdev
, struct sk_buff
*skb
)
52 __u8 status
= *((__u8
*) skb
->data
);
54 BT_DBG("%s status 0x%x", hdev
->name
, status
);
59 clear_bit(HCI_INQUIRY
, &hdev
->flags
);
61 hci_req_complete(hdev
, status
);
63 hci_conn_check_pending(hdev
);
66 static void hci_cc_exit_periodic_inq(struct hci_dev
*hdev
, struct sk_buff
*skb
)
68 __u8 status
= *((__u8
*) skb
->data
);
70 BT_DBG("%s status 0x%x", hdev
->name
, status
);
75 clear_bit(HCI_INQUIRY
, &hdev
->flags
);
77 hci_conn_check_pending(hdev
);
80 static void hci_cc_remote_name_req_cancel(struct hci_dev
*hdev
, struct sk_buff
*skb
)
82 BT_DBG("%s", hdev
->name
);
85 static void hci_cc_role_discovery(struct hci_dev
*hdev
, struct sk_buff
*skb
)
87 struct hci_rp_role_discovery
*rp
= (void *) skb
->data
;
88 struct hci_conn
*conn
;
90 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
97 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(rp
->handle
));
100 conn
->link_mode
&= ~HCI_LM_MASTER
;
102 conn
->link_mode
|= HCI_LM_MASTER
;
105 hci_dev_unlock(hdev
);
108 static void hci_cc_read_link_policy(struct hci_dev
*hdev
, struct sk_buff
*skb
)
110 struct hci_rp_read_link_policy
*rp
= (void *) skb
->data
;
111 struct hci_conn
*conn
;
113 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
120 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(rp
->handle
));
122 conn
->link_policy
= __le16_to_cpu(rp
->policy
);
124 hci_dev_unlock(hdev
);
127 static void hci_cc_write_link_policy(struct hci_dev
*hdev
, struct sk_buff
*skb
)
129 struct hci_rp_write_link_policy
*rp
= (void *) skb
->data
;
130 struct hci_conn
*conn
;
133 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
138 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_LINK_POLICY
);
144 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(rp
->handle
));
146 conn
->link_policy
= get_unaligned_le16(sent
+ 2);
148 hci_dev_unlock(hdev
);
151 static void hci_cc_read_def_link_policy(struct hci_dev
*hdev
, struct sk_buff
*skb
)
153 struct hci_rp_read_def_link_policy
*rp
= (void *) skb
->data
;
155 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
160 hdev
->link_policy
= __le16_to_cpu(rp
->policy
);
163 static void hci_cc_write_def_link_policy(struct hci_dev
*hdev
, struct sk_buff
*skb
)
165 __u8 status
= *((__u8
*) skb
->data
);
168 BT_DBG("%s status 0x%x", hdev
->name
, status
);
170 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_DEF_LINK_POLICY
);
175 hdev
->link_policy
= get_unaligned_le16(sent
);
177 hci_req_complete(hdev
, status
);
180 static void hci_cc_reset(struct hci_dev
*hdev
, struct sk_buff
*skb
)
182 __u8 status
= *((__u8
*) skb
->data
);
184 BT_DBG("%s status 0x%x", hdev
->name
, status
);
186 hci_req_complete(hdev
, status
);
189 static void hci_cc_write_local_name(struct hci_dev
*hdev
, struct sk_buff
*skb
)
191 __u8 status
= *((__u8
*) skb
->data
);
194 BT_DBG("%s status 0x%x", hdev
->name
, status
);
199 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_LOCAL_NAME
);
203 memcpy(hdev
->dev_name
, sent
, 248);
206 static void hci_cc_read_local_name(struct hci_dev
*hdev
, struct sk_buff
*skb
)
208 struct hci_rp_read_local_name
*rp
= (void *) skb
->data
;
210 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
215 memcpy(hdev
->dev_name
, rp
->name
, 248);
218 static void hci_cc_write_auth_enable(struct hci_dev
*hdev
, struct sk_buff
*skb
)
220 __u8 status
= *((__u8
*) skb
->data
);
223 BT_DBG("%s status 0x%x", hdev
->name
, status
);
225 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_AUTH_ENABLE
);
230 __u8 param
= *((__u8
*) sent
);
232 if (param
== AUTH_ENABLED
)
233 set_bit(HCI_AUTH
, &hdev
->flags
);
235 clear_bit(HCI_AUTH
, &hdev
->flags
);
238 hci_req_complete(hdev
, status
);
241 static void hci_cc_write_encrypt_mode(struct hci_dev
*hdev
, struct sk_buff
*skb
)
243 __u8 status
= *((__u8
*) skb
->data
);
246 BT_DBG("%s status 0x%x", hdev
->name
, status
);
248 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_ENCRYPT_MODE
);
253 __u8 param
= *((__u8
*) sent
);
256 set_bit(HCI_ENCRYPT
, &hdev
->flags
);
258 clear_bit(HCI_ENCRYPT
, &hdev
->flags
);
261 hci_req_complete(hdev
, status
);
264 static void hci_cc_write_scan_enable(struct hci_dev
*hdev
, struct sk_buff
*skb
)
266 __u8 status
= *((__u8
*) skb
->data
);
269 BT_DBG("%s status 0x%x", hdev
->name
, status
);
271 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_SCAN_ENABLE
);
276 __u8 param
= *((__u8
*) sent
);
278 clear_bit(HCI_PSCAN
, &hdev
->flags
);
279 clear_bit(HCI_ISCAN
, &hdev
->flags
);
281 if (param
& SCAN_INQUIRY
)
282 set_bit(HCI_ISCAN
, &hdev
->flags
);
284 if (param
& SCAN_PAGE
)
285 set_bit(HCI_PSCAN
, &hdev
->flags
);
288 hci_req_complete(hdev
, status
);
291 static void hci_cc_read_class_of_dev(struct hci_dev
*hdev
, struct sk_buff
*skb
)
293 struct hci_rp_read_class_of_dev
*rp
= (void *) skb
->data
;
295 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
300 memcpy(hdev
->dev_class
, rp
->dev_class
, 3);
302 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev
->name
,
303 hdev
->dev_class
[2], hdev
->dev_class
[1], hdev
->dev_class
[0]);
306 static void hci_cc_write_class_of_dev(struct hci_dev
*hdev
, struct sk_buff
*skb
)
308 __u8 status
= *((__u8
*) skb
->data
);
311 BT_DBG("%s status 0x%x", hdev
->name
, status
);
316 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_CLASS_OF_DEV
);
320 memcpy(hdev
->dev_class
, sent
, 3);
323 static void hci_cc_read_voice_setting(struct hci_dev
*hdev
, struct sk_buff
*skb
)
325 struct hci_rp_read_voice_setting
*rp
= (void *) skb
->data
;
328 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
333 setting
= __le16_to_cpu(rp
->voice_setting
);
335 if (hdev
->voice_setting
== setting
)
338 hdev
->voice_setting
= setting
;
340 BT_DBG("%s voice setting 0x%04x", hdev
->name
, setting
);
343 tasklet_disable(&hdev
->tx_task
);
344 hdev
->notify(hdev
, HCI_NOTIFY_VOICE_SETTING
);
345 tasklet_enable(&hdev
->tx_task
);
349 static void hci_cc_write_voice_setting(struct hci_dev
*hdev
, struct sk_buff
*skb
)
351 __u8 status
= *((__u8
*) skb
->data
);
355 BT_DBG("%s status 0x%x", hdev
->name
, status
);
360 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_VOICE_SETTING
);
364 setting
= get_unaligned_le16(sent
);
366 if (hdev
->voice_setting
== setting
)
369 hdev
->voice_setting
= setting
;
371 BT_DBG("%s voice setting 0x%04x", hdev
->name
, setting
);
374 tasklet_disable(&hdev
->tx_task
);
375 hdev
->notify(hdev
, HCI_NOTIFY_VOICE_SETTING
);
376 tasklet_enable(&hdev
->tx_task
);
380 static void hci_cc_host_buffer_size(struct hci_dev
*hdev
, struct sk_buff
*skb
)
382 __u8 status
= *((__u8
*) skb
->data
);
384 BT_DBG("%s status 0x%x", hdev
->name
, status
);
386 hci_req_complete(hdev
, status
);
389 static void hci_cc_read_ssp_mode(struct hci_dev
*hdev
, struct sk_buff
*skb
)
391 struct hci_rp_read_ssp_mode
*rp
= (void *) skb
->data
;
393 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
398 hdev
->ssp_mode
= rp
->mode
;
401 static void hci_cc_write_ssp_mode(struct hci_dev
*hdev
, struct sk_buff
*skb
)
403 __u8 status
= *((__u8
*) skb
->data
);
406 BT_DBG("%s status 0x%x", hdev
->name
, status
);
411 sent
= hci_sent_cmd_data(hdev
, HCI_OP_WRITE_SSP_MODE
);
415 hdev
->ssp_mode
= *((__u8
*) sent
);
418 static void hci_cc_read_local_version(struct hci_dev
*hdev
, struct sk_buff
*skb
)
420 struct hci_rp_read_local_version
*rp
= (void *) skb
->data
;
422 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
427 hdev
->hci_ver
= rp
->hci_ver
;
428 hdev
->hci_rev
= __le16_to_cpu(rp
->hci_rev
);
429 hdev
->manufacturer
= __le16_to_cpu(rp
->manufacturer
);
431 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev
->name
,
433 hdev
->hci_ver
, hdev
->hci_rev
);
436 static void hci_cc_read_local_commands(struct hci_dev
*hdev
, struct sk_buff
*skb
)
438 struct hci_rp_read_local_commands
*rp
= (void *) skb
->data
;
440 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
445 memcpy(hdev
->commands
, rp
->commands
, sizeof(hdev
->commands
));
448 static void hci_cc_read_local_features(struct hci_dev
*hdev
, struct sk_buff
*skb
)
450 struct hci_rp_read_local_features
*rp
= (void *) skb
->data
;
452 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
457 memcpy(hdev
->features
, rp
->features
, 8);
459 /* Adjust default settings according to features
460 * supported by device. */
462 if (hdev
->features
[0] & LMP_3SLOT
)
463 hdev
->pkt_type
|= (HCI_DM3
| HCI_DH3
);
465 if (hdev
->features
[0] & LMP_5SLOT
)
466 hdev
->pkt_type
|= (HCI_DM5
| HCI_DH5
);
468 if (hdev
->features
[1] & LMP_HV2
) {
469 hdev
->pkt_type
|= (HCI_HV2
);
470 hdev
->esco_type
|= (ESCO_HV2
);
473 if (hdev
->features
[1] & LMP_HV3
) {
474 hdev
->pkt_type
|= (HCI_HV3
);
475 hdev
->esco_type
|= (ESCO_HV3
);
478 if (hdev
->features
[3] & LMP_ESCO
)
479 hdev
->esco_type
|= (ESCO_EV3
);
481 if (hdev
->features
[4] & LMP_EV4
)
482 hdev
->esco_type
|= (ESCO_EV4
);
484 if (hdev
->features
[4] & LMP_EV5
)
485 hdev
->esco_type
|= (ESCO_EV5
);
487 if (hdev
->features
[5] & LMP_EDR_ESCO_2M
)
488 hdev
->esco_type
|= (ESCO_2EV3
);
490 if (hdev
->features
[5] & LMP_EDR_ESCO_3M
)
491 hdev
->esco_type
|= (ESCO_3EV3
);
493 if (hdev
->features
[5] & LMP_EDR_3S_ESCO
)
494 hdev
->esco_type
|= (ESCO_2EV5
| ESCO_3EV5
);
496 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev
->name
,
497 hdev
->features
[0], hdev
->features
[1],
498 hdev
->features
[2], hdev
->features
[3],
499 hdev
->features
[4], hdev
->features
[5],
500 hdev
->features
[6], hdev
->features
[7]);
503 static void hci_cc_read_buffer_size(struct hci_dev
*hdev
, struct sk_buff
*skb
)
505 struct hci_rp_read_buffer_size
*rp
= (void *) skb
->data
;
507 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
512 hdev
->acl_mtu
= __le16_to_cpu(rp
->acl_mtu
);
513 hdev
->sco_mtu
= rp
->sco_mtu
;
514 hdev
->acl_pkts
= __le16_to_cpu(rp
->acl_max_pkt
);
515 hdev
->sco_pkts
= __le16_to_cpu(rp
->sco_max_pkt
);
517 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE
, &hdev
->quirks
)) {
522 hdev
->acl_cnt
= hdev
->acl_pkts
;
523 hdev
->sco_cnt
= hdev
->sco_pkts
;
525 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev
->name
,
526 hdev
->acl_mtu
, hdev
->acl_pkts
,
527 hdev
->sco_mtu
, hdev
->sco_pkts
);
530 static void hci_cc_read_bd_addr(struct hci_dev
*hdev
, struct sk_buff
*skb
)
532 struct hci_rp_read_bd_addr
*rp
= (void *) skb
->data
;
534 BT_DBG("%s status 0x%x", hdev
->name
, rp
->status
);
537 bacpy(&hdev
->bdaddr
, &rp
->bdaddr
);
539 hci_req_complete(hdev
, rp
->status
);
542 static inline void hci_cs_inquiry(struct hci_dev
*hdev
, __u8 status
)
544 BT_DBG("%s status 0x%x", hdev
->name
, status
);
547 hci_req_complete(hdev
, status
);
549 hci_conn_check_pending(hdev
);
551 set_bit(HCI_INQUIRY
, &hdev
->flags
);
554 static inline void hci_cs_create_conn(struct hci_dev
*hdev
, __u8 status
)
556 struct hci_cp_create_conn
*cp
;
557 struct hci_conn
*conn
;
559 BT_DBG("%s status 0x%x", hdev
->name
, status
);
561 cp
= hci_sent_cmd_data(hdev
, HCI_OP_CREATE_CONN
);
567 conn
= hci_conn_hash_lookup_ba(hdev
, ACL_LINK
, &cp
->bdaddr
);
569 BT_DBG("%s bdaddr %s conn %p", hdev
->name
, batostr(&cp
->bdaddr
), conn
);
572 if (conn
&& conn
->state
== BT_CONNECT
) {
573 if (status
!= 0x0c || conn
->attempt
> 2) {
574 conn
->state
= BT_CLOSED
;
575 hci_proto_connect_cfm(conn
, status
);
578 conn
->state
= BT_CONNECT2
;
582 conn
= hci_conn_add(hdev
, ACL_LINK
, &cp
->bdaddr
);
585 conn
->link_mode
|= HCI_LM_MASTER
;
587 BT_ERR("No memmory for new connection");
591 hci_dev_unlock(hdev
);
594 static void hci_cs_add_sco(struct hci_dev
*hdev
, __u8 status
)
596 struct hci_cp_add_sco
*cp
;
597 struct hci_conn
*acl
, *sco
;
600 BT_DBG("%s status 0x%x", hdev
->name
, status
);
605 cp
= hci_sent_cmd_data(hdev
, HCI_OP_ADD_SCO
);
609 handle
= __le16_to_cpu(cp
->handle
);
611 BT_DBG("%s handle %d", hdev
->name
, handle
);
615 acl
= hci_conn_hash_lookup_handle(hdev
, handle
);
616 if (acl
&& (sco
= acl
->link
)) {
617 sco
->state
= BT_CLOSED
;
619 hci_proto_connect_cfm(sco
, status
);
623 hci_dev_unlock(hdev
);
626 static void hci_cs_auth_requested(struct hci_dev
*hdev
, __u8 status
)
628 struct hci_cp_auth_requested
*cp
;
629 struct hci_conn
*conn
;
631 BT_DBG("%s status 0x%x", hdev
->name
, status
);
636 cp
= hci_sent_cmd_data(hdev
, HCI_OP_AUTH_REQUESTED
);
642 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(cp
->handle
));
644 if (conn
->state
== BT_CONFIG
) {
645 hci_proto_connect_cfm(conn
, status
);
650 hci_dev_unlock(hdev
);
653 static void hci_cs_set_conn_encrypt(struct hci_dev
*hdev
, __u8 status
)
655 struct hci_cp_set_conn_encrypt
*cp
;
656 struct hci_conn
*conn
;
658 BT_DBG("%s status 0x%x", hdev
->name
, status
);
663 cp
= hci_sent_cmd_data(hdev
, HCI_OP_SET_CONN_ENCRYPT
);
669 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(cp
->handle
));
671 if (conn
->state
== BT_CONFIG
) {
672 hci_proto_connect_cfm(conn
, status
);
677 hci_dev_unlock(hdev
);
680 static void hci_cs_remote_name_req(struct hci_dev
*hdev
, __u8 status
)
682 BT_DBG("%s status 0x%x", hdev
->name
, status
);
685 static void hci_cs_read_remote_features(struct hci_dev
*hdev
, __u8 status
)
687 struct hci_cp_read_remote_features
*cp
;
688 struct hci_conn
*conn
;
690 BT_DBG("%s status 0x%x", hdev
->name
, status
);
695 cp
= hci_sent_cmd_data(hdev
, HCI_OP_READ_REMOTE_FEATURES
);
701 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(cp
->handle
));
703 if (conn
->state
== BT_CONFIG
) {
704 hci_proto_connect_cfm(conn
, status
);
709 hci_dev_unlock(hdev
);
712 static void hci_cs_read_remote_ext_features(struct hci_dev
*hdev
, __u8 status
)
714 struct hci_cp_read_remote_ext_features
*cp
;
715 struct hci_conn
*conn
;
717 BT_DBG("%s status 0x%x", hdev
->name
, status
);
722 cp
= hci_sent_cmd_data(hdev
, HCI_OP_READ_REMOTE_EXT_FEATURES
);
728 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(cp
->handle
));
730 if (conn
->state
== BT_CONFIG
) {
731 hci_proto_connect_cfm(conn
, status
);
736 hci_dev_unlock(hdev
);
739 static void hci_cs_setup_sync_conn(struct hci_dev
*hdev
, __u8 status
)
741 struct hci_cp_setup_sync_conn
*cp
;
742 struct hci_conn
*acl
, *sco
;
745 BT_DBG("%s status 0x%x", hdev
->name
, status
);
750 cp
= hci_sent_cmd_data(hdev
, HCI_OP_SETUP_SYNC_CONN
);
754 handle
= __le16_to_cpu(cp
->handle
);
756 BT_DBG("%s handle %d", hdev
->name
, handle
);
760 acl
= hci_conn_hash_lookup_handle(hdev
, handle
);
761 if (acl
&& (sco
= acl
->link
)) {
762 sco
->state
= BT_CLOSED
;
764 hci_proto_connect_cfm(sco
, status
);
768 hci_dev_unlock(hdev
);
771 static void hci_cs_sniff_mode(struct hci_dev
*hdev
, __u8 status
)
773 struct hci_cp_sniff_mode
*cp
;
774 struct hci_conn
*conn
;
776 BT_DBG("%s status 0x%x", hdev
->name
, status
);
781 cp
= hci_sent_cmd_data(hdev
, HCI_OP_SNIFF_MODE
);
787 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(cp
->handle
));
789 clear_bit(HCI_CONN_MODE_CHANGE_PEND
, &conn
->pend
);
791 hci_dev_unlock(hdev
);
794 static void hci_cs_exit_sniff_mode(struct hci_dev
*hdev
, __u8 status
)
796 struct hci_cp_exit_sniff_mode
*cp
;
797 struct hci_conn
*conn
;
799 BT_DBG("%s status 0x%x", hdev
->name
, status
);
804 cp
= hci_sent_cmd_data(hdev
, HCI_OP_EXIT_SNIFF_MODE
);
810 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(cp
->handle
));
812 clear_bit(HCI_CONN_MODE_CHANGE_PEND
, &conn
->pend
);
814 hci_dev_unlock(hdev
);
817 static inline void hci_inquiry_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
819 __u8 status
= *((__u8
*) skb
->data
);
821 BT_DBG("%s status %d", hdev
->name
, status
);
823 clear_bit(HCI_INQUIRY
, &hdev
->flags
);
825 hci_req_complete(hdev
, status
);
827 hci_conn_check_pending(hdev
);
830 static inline void hci_inquiry_result_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
832 struct inquiry_data data
;
833 struct inquiry_info
*info
= (void *) (skb
->data
+ 1);
834 int num_rsp
= *((__u8
*) skb
->data
);
836 BT_DBG("%s num_rsp %d", hdev
->name
, num_rsp
);
843 for (; num_rsp
; num_rsp
--) {
844 bacpy(&data
.bdaddr
, &info
->bdaddr
);
845 data
.pscan_rep_mode
= info
->pscan_rep_mode
;
846 data
.pscan_period_mode
= info
->pscan_period_mode
;
847 data
.pscan_mode
= info
->pscan_mode
;
848 memcpy(data
.dev_class
, info
->dev_class
, 3);
849 data
.clock_offset
= info
->clock_offset
;
851 data
.ssp_mode
= 0x00;
853 hci_inquiry_cache_update(hdev
, &data
);
856 hci_dev_unlock(hdev
);
859 static inline void hci_conn_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
861 struct hci_ev_conn_complete
*ev
= (void *) skb
->data
;
862 struct hci_conn
*conn
;
864 BT_DBG("%s", hdev
->name
);
868 conn
= hci_conn_hash_lookup_ba(hdev
, ev
->link_type
, &ev
->bdaddr
);
870 if (ev
->link_type
!= SCO_LINK
)
873 conn
= hci_conn_hash_lookup_ba(hdev
, ESCO_LINK
, &ev
->bdaddr
);
877 conn
->type
= SCO_LINK
;
881 conn
->handle
= __le16_to_cpu(ev
->handle
);
883 if (conn
->type
== ACL_LINK
) {
884 conn
->state
= BT_CONFIG
;
887 conn
->state
= BT_CONNECTED
;
889 hci_conn_add_sysfs(conn
);
891 if (test_bit(HCI_AUTH
, &hdev
->flags
))
892 conn
->link_mode
|= HCI_LM_AUTH
;
894 if (test_bit(HCI_ENCRYPT
, &hdev
->flags
))
895 conn
->link_mode
|= HCI_LM_ENCRYPT
;
897 /* Get remote features */
898 if (conn
->type
== ACL_LINK
) {
899 struct hci_cp_read_remote_features cp
;
900 cp
.handle
= ev
->handle
;
901 hci_send_cmd(hdev
, HCI_OP_READ_REMOTE_FEATURES
,
905 /* Set packet type for incoming connection */
906 if (!conn
->out
&& hdev
->hci_ver
< 3) {
907 struct hci_cp_change_conn_ptype cp
;
908 cp
.handle
= ev
->handle
;
909 cp
.pkt_type
= cpu_to_le16(conn
->pkt_type
);
910 hci_send_cmd(hdev
, HCI_OP_CHANGE_CONN_PTYPE
,
914 conn
->state
= BT_CLOSED
;
916 if (conn
->type
== ACL_LINK
) {
917 struct hci_conn
*sco
= conn
->link
;
920 if (lmp_esco_capable(hdev
))
921 hci_setup_sync(sco
, conn
->handle
);
923 hci_add_sco(sco
, conn
->handle
);
925 hci_proto_connect_cfm(sco
, ev
->status
);
932 hci_proto_connect_cfm(conn
, ev
->status
);
934 } else if (ev
->link_type
!= ACL_LINK
)
935 hci_proto_connect_cfm(conn
, ev
->status
);
938 hci_dev_unlock(hdev
);
940 hci_conn_check_pending(hdev
);
943 static inline void hci_conn_request_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
945 struct hci_ev_conn_request
*ev
= (void *) skb
->data
;
946 int mask
= hdev
->link_mode
;
948 BT_DBG("%s bdaddr %s type 0x%x", hdev
->name
,
949 batostr(&ev
->bdaddr
), ev
->link_type
);
951 mask
|= hci_proto_connect_ind(hdev
, &ev
->bdaddr
, ev
->link_type
);
953 if (mask
& HCI_LM_ACCEPT
) {
954 /* Connection accepted */
955 struct inquiry_entry
*ie
;
956 struct hci_conn
*conn
;
960 if ((ie
= hci_inquiry_cache_lookup(hdev
, &ev
->bdaddr
)))
961 memcpy(ie
->data
.dev_class
, ev
->dev_class
, 3);
963 conn
= hci_conn_hash_lookup_ba(hdev
, ev
->link_type
, &ev
->bdaddr
);
965 if (!(conn
= hci_conn_add(hdev
, ev
->link_type
, &ev
->bdaddr
))) {
966 BT_ERR("No memmory for new connection");
967 hci_dev_unlock(hdev
);
972 memcpy(conn
->dev_class
, ev
->dev_class
, 3);
973 conn
->state
= BT_CONNECT
;
975 hci_dev_unlock(hdev
);
977 if (ev
->link_type
== ACL_LINK
|| !lmp_esco_capable(hdev
)) {
978 struct hci_cp_accept_conn_req cp
;
980 bacpy(&cp
.bdaddr
, &ev
->bdaddr
);
982 if (lmp_rswitch_capable(hdev
) && (mask
& HCI_LM_MASTER
))
983 cp
.role
= 0x00; /* Become master */
985 cp
.role
= 0x01; /* Remain slave */
987 hci_send_cmd(hdev
, HCI_OP_ACCEPT_CONN_REQ
,
990 struct hci_cp_accept_sync_conn_req cp
;
992 bacpy(&cp
.bdaddr
, &ev
->bdaddr
);
993 cp
.pkt_type
= cpu_to_le16(conn
->pkt_type
);
995 cp
.tx_bandwidth
= cpu_to_le32(0x00001f40);
996 cp
.rx_bandwidth
= cpu_to_le32(0x00001f40);
997 cp
.max_latency
= cpu_to_le16(0xffff);
998 cp
.content_format
= cpu_to_le16(hdev
->voice_setting
);
999 cp
.retrans_effort
= 0xff;
1001 hci_send_cmd(hdev
, HCI_OP_ACCEPT_SYNC_CONN_REQ
,
1005 /* Connection rejected */
1006 struct hci_cp_reject_conn_req cp
;
1008 bacpy(&cp
.bdaddr
, &ev
->bdaddr
);
1010 hci_send_cmd(hdev
, HCI_OP_REJECT_CONN_REQ
, sizeof(cp
), &cp
);
1014 static inline void hci_disconn_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1016 struct hci_ev_disconn_complete
*ev
= (void *) skb
->data
;
1017 struct hci_conn
*conn
;
1019 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1026 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1028 conn
->state
= BT_CLOSED
;
1030 hci_proto_disconn_cfm(conn
, ev
->reason
);
1034 hci_dev_unlock(hdev
);
1037 static inline void hci_auth_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1039 struct hci_ev_auth_complete
*ev
= (void *) skb
->data
;
1040 struct hci_conn
*conn
;
1042 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1046 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1049 conn
->link_mode
|= HCI_LM_AUTH
;
1051 clear_bit(HCI_CONN_AUTH_PEND
, &conn
->pend
);
1053 if (conn
->state
== BT_CONFIG
) {
1054 if (!ev
->status
&& hdev
->ssp_mode
> 0 &&
1055 conn
->ssp_mode
> 0) {
1056 struct hci_cp_set_conn_encrypt cp
;
1057 cp
.handle
= ev
->handle
;
1059 hci_send_cmd(hdev
, HCI_OP_SET_CONN_ENCRYPT
,
1062 conn
->state
= BT_CONNECTED
;
1063 hci_proto_connect_cfm(conn
, ev
->status
);
1067 hci_auth_cfm(conn
, ev
->status
);
1069 if (test_bit(HCI_CONN_ENCRYPT_PEND
, &conn
->pend
)) {
1071 struct hci_cp_set_conn_encrypt cp
;
1072 cp
.handle
= ev
->handle
;
1074 hci_send_cmd(hdev
, HCI_OP_SET_CONN_ENCRYPT
,
1077 clear_bit(HCI_CONN_ENCRYPT_PEND
, &conn
->pend
);
1078 hci_encrypt_cfm(conn
, ev
->status
, 0x00);
1083 hci_dev_unlock(hdev
);
1086 static inline void hci_remote_name_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1088 BT_DBG("%s", hdev
->name
);
1090 hci_conn_check_pending(hdev
);
1093 static inline void hci_encrypt_change_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1095 struct hci_ev_encrypt_change
*ev
= (void *) skb
->data
;
1096 struct hci_conn
*conn
;
1098 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1102 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1106 /* Encryption implies authentication */
1107 conn
->link_mode
|= HCI_LM_AUTH
;
1108 conn
->link_mode
|= HCI_LM_ENCRYPT
;
1110 conn
->link_mode
&= ~HCI_LM_ENCRYPT
;
1113 clear_bit(HCI_CONN_ENCRYPT_PEND
, &conn
->pend
);
1115 if (conn
->state
== BT_CONFIG
) {
1117 conn
->state
= BT_CONNECTED
;
1119 hci_proto_connect_cfm(conn
, ev
->status
);
1122 hci_encrypt_cfm(conn
, ev
->status
, ev
->encrypt
);
1125 hci_dev_unlock(hdev
);
1128 static inline void hci_change_link_key_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1130 struct hci_ev_change_link_key_complete
*ev
= (void *) skb
->data
;
1131 struct hci_conn
*conn
;
1133 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1137 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1140 conn
->link_mode
|= HCI_LM_SECURE
;
1142 clear_bit(HCI_CONN_AUTH_PEND
, &conn
->pend
);
1144 hci_key_change_cfm(conn
, ev
->status
);
1147 hci_dev_unlock(hdev
);
1150 static inline void hci_remote_features_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1152 struct hci_ev_remote_features
*ev
= (void *) skb
->data
;
1153 struct hci_conn
*conn
;
1155 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1159 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1162 memcpy(conn
->features
, ev
->features
, 8);
1164 if (conn
->state
== BT_CONFIG
) {
1165 if (!ev
->status
&& lmp_ssp_capable(hdev
) &&
1166 lmp_ssp_capable(conn
)) {
1167 struct hci_cp_read_remote_ext_features cp
;
1168 cp
.handle
= ev
->handle
;
1171 HCI_OP_READ_REMOTE_EXT_FEATURES
,
1174 conn
->state
= BT_CONNECTED
;
1175 hci_proto_connect_cfm(conn
, ev
->status
);
1181 hci_dev_unlock(hdev
);
1184 static inline void hci_remote_version_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1186 BT_DBG("%s", hdev
->name
);
1189 static inline void hci_qos_setup_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1191 BT_DBG("%s", hdev
->name
);
1194 static inline void hci_cmd_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1196 struct hci_ev_cmd_complete
*ev
= (void *) skb
->data
;
1199 skb_pull(skb
, sizeof(*ev
));
1201 opcode
= __le16_to_cpu(ev
->opcode
);
1204 case HCI_OP_INQUIRY_CANCEL
:
1205 hci_cc_inquiry_cancel(hdev
, skb
);
1208 case HCI_OP_EXIT_PERIODIC_INQ
:
1209 hci_cc_exit_periodic_inq(hdev
, skb
);
1212 case HCI_OP_REMOTE_NAME_REQ_CANCEL
:
1213 hci_cc_remote_name_req_cancel(hdev
, skb
);
1216 case HCI_OP_ROLE_DISCOVERY
:
1217 hci_cc_role_discovery(hdev
, skb
);
1220 case HCI_OP_READ_LINK_POLICY
:
1221 hci_cc_read_link_policy(hdev
, skb
);
1224 case HCI_OP_WRITE_LINK_POLICY
:
1225 hci_cc_write_link_policy(hdev
, skb
);
1228 case HCI_OP_READ_DEF_LINK_POLICY
:
1229 hci_cc_read_def_link_policy(hdev
, skb
);
1232 case HCI_OP_WRITE_DEF_LINK_POLICY
:
1233 hci_cc_write_def_link_policy(hdev
, skb
);
1237 hci_cc_reset(hdev
, skb
);
1240 case HCI_OP_WRITE_LOCAL_NAME
:
1241 hci_cc_write_local_name(hdev
, skb
);
1244 case HCI_OP_READ_LOCAL_NAME
:
1245 hci_cc_read_local_name(hdev
, skb
);
1248 case HCI_OP_WRITE_AUTH_ENABLE
:
1249 hci_cc_write_auth_enable(hdev
, skb
);
1252 case HCI_OP_WRITE_ENCRYPT_MODE
:
1253 hci_cc_write_encrypt_mode(hdev
, skb
);
1256 case HCI_OP_WRITE_SCAN_ENABLE
:
1257 hci_cc_write_scan_enable(hdev
, skb
);
1260 case HCI_OP_READ_CLASS_OF_DEV
:
1261 hci_cc_read_class_of_dev(hdev
, skb
);
1264 case HCI_OP_WRITE_CLASS_OF_DEV
:
1265 hci_cc_write_class_of_dev(hdev
, skb
);
1268 case HCI_OP_READ_VOICE_SETTING
:
1269 hci_cc_read_voice_setting(hdev
, skb
);
1272 case HCI_OP_WRITE_VOICE_SETTING
:
1273 hci_cc_write_voice_setting(hdev
, skb
);
1276 case HCI_OP_HOST_BUFFER_SIZE
:
1277 hci_cc_host_buffer_size(hdev
, skb
);
1280 case HCI_OP_READ_SSP_MODE
:
1281 hci_cc_read_ssp_mode(hdev
, skb
);
1284 case HCI_OP_WRITE_SSP_MODE
:
1285 hci_cc_write_ssp_mode(hdev
, skb
);
1288 case HCI_OP_READ_LOCAL_VERSION
:
1289 hci_cc_read_local_version(hdev
, skb
);
1292 case HCI_OP_READ_LOCAL_COMMANDS
:
1293 hci_cc_read_local_commands(hdev
, skb
);
1296 case HCI_OP_READ_LOCAL_FEATURES
:
1297 hci_cc_read_local_features(hdev
, skb
);
1300 case HCI_OP_READ_BUFFER_SIZE
:
1301 hci_cc_read_buffer_size(hdev
, skb
);
1304 case HCI_OP_READ_BD_ADDR
:
1305 hci_cc_read_bd_addr(hdev
, skb
);
1309 BT_DBG("%s opcode 0x%x", hdev
->name
, opcode
);
1314 atomic_set(&hdev
->cmd_cnt
, 1);
1315 if (!skb_queue_empty(&hdev
->cmd_q
))
1316 hci_sched_cmd(hdev
);
1320 static inline void hci_cmd_status_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1322 struct hci_ev_cmd_status
*ev
= (void *) skb
->data
;
1325 skb_pull(skb
, sizeof(*ev
));
1327 opcode
= __le16_to_cpu(ev
->opcode
);
1330 case HCI_OP_INQUIRY
:
1331 hci_cs_inquiry(hdev
, ev
->status
);
1334 case HCI_OP_CREATE_CONN
:
1335 hci_cs_create_conn(hdev
, ev
->status
);
1338 case HCI_OP_ADD_SCO
:
1339 hci_cs_add_sco(hdev
, ev
->status
);
1342 case HCI_OP_AUTH_REQUESTED
:
1343 hci_cs_auth_requested(hdev
, ev
->status
);
1346 case HCI_OP_SET_CONN_ENCRYPT
:
1347 hci_cs_set_conn_encrypt(hdev
, ev
->status
);
1350 case HCI_OP_REMOTE_NAME_REQ
:
1351 hci_cs_remote_name_req(hdev
, ev
->status
);
1354 case HCI_OP_READ_REMOTE_FEATURES
:
1355 hci_cs_read_remote_features(hdev
, ev
->status
);
1358 case HCI_OP_READ_REMOTE_EXT_FEATURES
:
1359 hci_cs_read_remote_ext_features(hdev
, ev
->status
);
1362 case HCI_OP_SETUP_SYNC_CONN
:
1363 hci_cs_setup_sync_conn(hdev
, ev
->status
);
1366 case HCI_OP_SNIFF_MODE
:
1367 hci_cs_sniff_mode(hdev
, ev
->status
);
1370 case HCI_OP_EXIT_SNIFF_MODE
:
1371 hci_cs_exit_sniff_mode(hdev
, ev
->status
);
1375 BT_DBG("%s opcode 0x%x", hdev
->name
, opcode
);
1380 atomic_set(&hdev
->cmd_cnt
, 1);
1381 if (!skb_queue_empty(&hdev
->cmd_q
))
1382 hci_sched_cmd(hdev
);
1386 static inline void hci_role_change_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1388 struct hci_ev_role_change
*ev
= (void *) skb
->data
;
1389 struct hci_conn
*conn
;
1391 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1395 conn
= hci_conn_hash_lookup_ba(hdev
, ACL_LINK
, &ev
->bdaddr
);
1399 conn
->link_mode
&= ~HCI_LM_MASTER
;
1401 conn
->link_mode
|= HCI_LM_MASTER
;
1404 clear_bit(HCI_CONN_RSWITCH_PEND
, &conn
->pend
);
1406 hci_role_switch_cfm(conn
, ev
->status
, ev
->role
);
1409 hci_dev_unlock(hdev
);
1412 static inline void hci_num_comp_pkts_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1414 struct hci_ev_num_comp_pkts
*ev
= (void *) skb
->data
;
1418 skb_pull(skb
, sizeof(*ev
));
1420 BT_DBG("%s num_hndl %d", hdev
->name
, ev
->num_hndl
);
1422 if (skb
->len
< ev
->num_hndl
* 4) {
1423 BT_DBG("%s bad parameters", hdev
->name
);
1427 tasklet_disable(&hdev
->tx_task
);
1429 for (i
= 0, ptr
= (__le16
*) skb
->data
; i
< ev
->num_hndl
; i
++) {
1430 struct hci_conn
*conn
;
1431 __u16 handle
, count
;
1433 handle
= get_unaligned_le16(ptr
++);
1434 count
= get_unaligned_le16(ptr
++);
1436 conn
= hci_conn_hash_lookup_handle(hdev
, handle
);
1438 conn
->sent
-= count
;
1440 if (conn
->type
== ACL_LINK
) {
1441 if ((hdev
->acl_cnt
+= count
) > hdev
->acl_pkts
)
1442 hdev
->acl_cnt
= hdev
->acl_pkts
;
1444 if ((hdev
->sco_cnt
+= count
) > hdev
->sco_pkts
)
1445 hdev
->sco_cnt
= hdev
->sco_pkts
;
1452 tasklet_enable(&hdev
->tx_task
);
1455 static inline void hci_mode_change_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1457 struct hci_ev_mode_change
*ev
= (void *) skb
->data
;
1458 struct hci_conn
*conn
;
1460 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1464 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1466 conn
->mode
= ev
->mode
;
1467 conn
->interval
= __le16_to_cpu(ev
->interval
);
1469 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND
, &conn
->pend
)) {
1470 if (conn
->mode
== HCI_CM_ACTIVE
)
1471 conn
->power_save
= 1;
1473 conn
->power_save
= 0;
1477 hci_dev_unlock(hdev
);
1480 static inline void hci_pin_code_request_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1482 BT_DBG("%s", hdev
->name
);
1485 static inline void hci_link_key_request_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1487 BT_DBG("%s", hdev
->name
);
1490 static inline void hci_link_key_notify_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1492 BT_DBG("%s", hdev
->name
);
1495 static inline void hci_clock_offset_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1497 struct hci_ev_clock_offset
*ev
= (void *) skb
->data
;
1498 struct hci_conn
*conn
;
1500 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1504 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1505 if (conn
&& !ev
->status
) {
1506 struct inquiry_entry
*ie
;
1508 if ((ie
= hci_inquiry_cache_lookup(hdev
, &conn
->dst
))) {
1509 ie
->data
.clock_offset
= ev
->clock_offset
;
1510 ie
->timestamp
= jiffies
;
1514 hci_dev_unlock(hdev
);
1517 static inline void hci_pkt_type_change_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1519 struct hci_ev_pkt_type_change
*ev
= (void *) skb
->data
;
1520 struct hci_conn
*conn
;
1522 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1526 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1527 if (conn
&& !ev
->status
)
1528 conn
->pkt_type
= __le16_to_cpu(ev
->pkt_type
);
1530 hci_dev_unlock(hdev
);
1533 static inline void hci_pscan_rep_mode_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1535 struct hci_ev_pscan_rep_mode
*ev
= (void *) skb
->data
;
1536 struct inquiry_entry
*ie
;
1538 BT_DBG("%s", hdev
->name
);
1542 if ((ie
= hci_inquiry_cache_lookup(hdev
, &ev
->bdaddr
))) {
1543 ie
->data
.pscan_rep_mode
= ev
->pscan_rep_mode
;
1544 ie
->timestamp
= jiffies
;
1547 hci_dev_unlock(hdev
);
1550 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1552 struct inquiry_data data
;
1553 int num_rsp
= *((__u8
*) skb
->data
);
1555 BT_DBG("%s num_rsp %d", hdev
->name
, num_rsp
);
1562 if ((skb
->len
- 1) / num_rsp
!= sizeof(struct inquiry_info_with_rssi
)) {
1563 struct inquiry_info_with_rssi_and_pscan_mode
*info
= (void *) (skb
->data
+ 1);
1565 for (; num_rsp
; num_rsp
--) {
1566 bacpy(&data
.bdaddr
, &info
->bdaddr
);
1567 data
.pscan_rep_mode
= info
->pscan_rep_mode
;
1568 data
.pscan_period_mode
= info
->pscan_period_mode
;
1569 data
.pscan_mode
= info
->pscan_mode
;
1570 memcpy(data
.dev_class
, info
->dev_class
, 3);
1571 data
.clock_offset
= info
->clock_offset
;
1572 data
.rssi
= info
->rssi
;
1573 data
.ssp_mode
= 0x00;
1575 hci_inquiry_cache_update(hdev
, &data
);
1578 struct inquiry_info_with_rssi
*info
= (void *) (skb
->data
+ 1);
1580 for (; num_rsp
; num_rsp
--) {
1581 bacpy(&data
.bdaddr
, &info
->bdaddr
);
1582 data
.pscan_rep_mode
= info
->pscan_rep_mode
;
1583 data
.pscan_period_mode
= info
->pscan_period_mode
;
1584 data
.pscan_mode
= 0x00;
1585 memcpy(data
.dev_class
, info
->dev_class
, 3);
1586 data
.clock_offset
= info
->clock_offset
;
1587 data
.rssi
= info
->rssi
;
1588 data
.ssp_mode
= 0x00;
1590 hci_inquiry_cache_update(hdev
, &data
);
1594 hci_dev_unlock(hdev
);
1597 static inline void hci_remote_ext_features_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1599 struct hci_ev_remote_ext_features
*ev
= (void *) skb
->data
;
1600 struct hci_conn
*conn
;
1602 BT_DBG("%s", hdev
->name
);
1606 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1608 if (!ev
->status
&& ev
->page
== 0x01) {
1609 struct inquiry_entry
*ie
;
1611 if ((ie
= hci_inquiry_cache_lookup(hdev
, &conn
->dst
)))
1612 ie
->data
.ssp_mode
= (ev
->features
[0] & 0x01);
1614 conn
->ssp_mode
= (ev
->features
[0] & 0x01);
1617 if (conn
->state
== BT_CONFIG
) {
1618 if (!ev
->status
&& hdev
->ssp_mode
> 0 &&
1619 conn
->ssp_mode
> 0 && conn
->out
&&
1620 conn
->sec_level
!= BT_SECURITY_SDP
) {
1621 struct hci_cp_auth_requested cp
;
1622 cp
.handle
= ev
->handle
;
1623 hci_send_cmd(hdev
, HCI_OP_AUTH_REQUESTED
,
1626 conn
->state
= BT_CONNECTED
;
1627 hci_proto_connect_cfm(conn
, ev
->status
);
1633 hci_dev_unlock(hdev
);
1636 static inline void hci_sync_conn_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1638 struct hci_ev_sync_conn_complete
*ev
= (void *) skb
->data
;
1639 struct hci_conn
*conn
;
1641 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1645 conn
= hci_conn_hash_lookup_ba(hdev
, ev
->link_type
, &ev
->bdaddr
);
1647 if (ev
->link_type
== ESCO_LINK
)
1650 conn
= hci_conn_hash_lookup_ba(hdev
, ESCO_LINK
, &ev
->bdaddr
);
1654 conn
->type
= SCO_LINK
;
1657 switch (ev
->status
) {
1659 conn
->handle
= __le16_to_cpu(ev
->handle
);
1660 conn
->state
= BT_CONNECTED
;
1662 hci_conn_add_sysfs(conn
);
1665 case 0x1c: /* SCO interval rejected */
1666 case 0x1f: /* Unspecified error */
1667 if (conn
->out
&& conn
->attempt
< 2) {
1668 conn
->pkt_type
= (hdev
->esco_type
& SCO_ESCO_MASK
) |
1669 (hdev
->esco_type
& EDR_ESCO_MASK
);
1670 hci_setup_sync(conn
, conn
->link
->handle
);
1676 conn
->state
= BT_CLOSED
;
1680 hci_proto_connect_cfm(conn
, ev
->status
);
1685 hci_dev_unlock(hdev
);
1688 static inline void hci_sync_conn_changed_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1690 BT_DBG("%s", hdev
->name
);
1693 static inline void hci_sniff_subrate_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1695 struct hci_ev_sniff_subrate
*ev
= (void *) skb
->data
;
1696 struct hci_conn
*conn
;
1698 BT_DBG("%s status %d", hdev
->name
, ev
->status
);
1702 conn
= hci_conn_hash_lookup_handle(hdev
, __le16_to_cpu(ev
->handle
));
1706 hci_dev_unlock(hdev
);
1709 static inline void hci_extended_inquiry_result_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1711 struct inquiry_data data
;
1712 struct extended_inquiry_info
*info
= (void *) (skb
->data
+ 1);
1713 int num_rsp
= *((__u8
*) skb
->data
);
1715 BT_DBG("%s num_rsp %d", hdev
->name
, num_rsp
);
1722 for (; num_rsp
; num_rsp
--) {
1723 bacpy(&data
.bdaddr
, &info
->bdaddr
);
1724 data
.pscan_rep_mode
= info
->pscan_rep_mode
;
1725 data
.pscan_period_mode
= info
->pscan_period_mode
;
1726 data
.pscan_mode
= 0x00;
1727 memcpy(data
.dev_class
, info
->dev_class
, 3);
1728 data
.clock_offset
= info
->clock_offset
;
1729 data
.rssi
= info
->rssi
;
1730 data
.ssp_mode
= 0x01;
1732 hci_inquiry_cache_update(hdev
, &data
);
1735 hci_dev_unlock(hdev
);
1738 static inline void hci_io_capa_request_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1740 struct hci_ev_io_capa_request
*ev
= (void *) skb
->data
;
1741 struct hci_conn
*conn
;
1743 BT_DBG("%s", hdev
->name
);
1747 conn
= hci_conn_hash_lookup_ba(hdev
, ACL_LINK
, &ev
->bdaddr
);
1749 hci_conn_hold(conn
);
1751 hci_dev_unlock(hdev
);
1754 static inline void hci_simple_pair_complete_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1756 struct hci_ev_simple_pair_complete
*ev
= (void *) skb
->data
;
1757 struct hci_conn
*conn
;
1759 BT_DBG("%s", hdev
->name
);
1763 conn
= hci_conn_hash_lookup_ba(hdev
, ACL_LINK
, &ev
->bdaddr
);
1767 hci_dev_unlock(hdev
);
1770 static inline void hci_remote_host_features_evt(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1772 struct hci_ev_remote_host_features
*ev
= (void *) skb
->data
;
1773 struct inquiry_entry
*ie
;
1775 BT_DBG("%s", hdev
->name
);
1779 if ((ie
= hci_inquiry_cache_lookup(hdev
, &ev
->bdaddr
)))
1780 ie
->data
.ssp_mode
= (ev
->features
[0] & 0x01);
1782 hci_dev_unlock(hdev
);
1785 void hci_event_packet(struct hci_dev
*hdev
, struct sk_buff
*skb
)
1787 struct hci_event_hdr
*hdr
= (void *) skb
->data
;
1788 __u8 event
= hdr
->evt
;
1790 skb_pull(skb
, HCI_EVENT_HDR_SIZE
);
1793 case HCI_EV_INQUIRY_COMPLETE
:
1794 hci_inquiry_complete_evt(hdev
, skb
);
1797 case HCI_EV_INQUIRY_RESULT
:
1798 hci_inquiry_result_evt(hdev
, skb
);
1801 case HCI_EV_CONN_COMPLETE
:
1802 hci_conn_complete_evt(hdev
, skb
);
1805 case HCI_EV_CONN_REQUEST
:
1806 hci_conn_request_evt(hdev
, skb
);
1809 case HCI_EV_DISCONN_COMPLETE
:
1810 hci_disconn_complete_evt(hdev
, skb
);
1813 case HCI_EV_AUTH_COMPLETE
:
1814 hci_auth_complete_evt(hdev
, skb
);
1817 case HCI_EV_REMOTE_NAME
:
1818 hci_remote_name_evt(hdev
, skb
);
1821 case HCI_EV_ENCRYPT_CHANGE
:
1822 hci_encrypt_change_evt(hdev
, skb
);
1825 case HCI_EV_CHANGE_LINK_KEY_COMPLETE
:
1826 hci_change_link_key_complete_evt(hdev
, skb
);
1829 case HCI_EV_REMOTE_FEATURES
:
1830 hci_remote_features_evt(hdev
, skb
);
1833 case HCI_EV_REMOTE_VERSION
:
1834 hci_remote_version_evt(hdev
, skb
);
1837 case HCI_EV_QOS_SETUP_COMPLETE
:
1838 hci_qos_setup_complete_evt(hdev
, skb
);
1841 case HCI_EV_CMD_COMPLETE
:
1842 hci_cmd_complete_evt(hdev
, skb
);
1845 case HCI_EV_CMD_STATUS
:
1846 hci_cmd_status_evt(hdev
, skb
);
1849 case HCI_EV_ROLE_CHANGE
:
1850 hci_role_change_evt(hdev
, skb
);
1853 case HCI_EV_NUM_COMP_PKTS
:
1854 hci_num_comp_pkts_evt(hdev
, skb
);
1857 case HCI_EV_MODE_CHANGE
:
1858 hci_mode_change_evt(hdev
, skb
);
1861 case HCI_EV_PIN_CODE_REQ
:
1862 hci_pin_code_request_evt(hdev
, skb
);
1865 case HCI_EV_LINK_KEY_REQ
:
1866 hci_link_key_request_evt(hdev
, skb
);
1869 case HCI_EV_LINK_KEY_NOTIFY
:
1870 hci_link_key_notify_evt(hdev
, skb
);
1873 case HCI_EV_CLOCK_OFFSET
:
1874 hci_clock_offset_evt(hdev
, skb
);
1877 case HCI_EV_PKT_TYPE_CHANGE
:
1878 hci_pkt_type_change_evt(hdev
, skb
);
1881 case HCI_EV_PSCAN_REP_MODE
:
1882 hci_pscan_rep_mode_evt(hdev
, skb
);
1885 case HCI_EV_INQUIRY_RESULT_WITH_RSSI
:
1886 hci_inquiry_result_with_rssi_evt(hdev
, skb
);
1889 case HCI_EV_REMOTE_EXT_FEATURES
:
1890 hci_remote_ext_features_evt(hdev
, skb
);
1893 case HCI_EV_SYNC_CONN_COMPLETE
:
1894 hci_sync_conn_complete_evt(hdev
, skb
);
1897 case HCI_EV_SYNC_CONN_CHANGED
:
1898 hci_sync_conn_changed_evt(hdev
, skb
);
1901 case HCI_EV_SNIFF_SUBRATE
:
1902 hci_sniff_subrate_evt(hdev
, skb
);
1905 case HCI_EV_EXTENDED_INQUIRY_RESULT
:
1906 hci_extended_inquiry_result_evt(hdev
, skb
);
1909 case HCI_EV_IO_CAPA_REQUEST
:
1910 hci_io_capa_request_evt(hdev
, skb
);
1913 case HCI_EV_SIMPLE_PAIR_COMPLETE
:
1914 hci_simple_pair_complete_evt(hdev
, skb
);
1917 case HCI_EV_REMOTE_HOST_FEATURES
:
1918 hci_remote_host_features_evt(hdev
, skb
);
1922 BT_DBG("%s event 0x%x", hdev
->name
, event
);
1927 hdev
->stat
.evt_rx
++;
1930 /* Generate internal stack event */
1931 void hci_si_event(struct hci_dev
*hdev
, int type
, int dlen
, void *data
)
1933 struct hci_event_hdr
*hdr
;
1934 struct hci_ev_stack_internal
*ev
;
1935 struct sk_buff
*skb
;
1937 skb
= bt_skb_alloc(HCI_EVENT_HDR_SIZE
+ sizeof(*ev
) + dlen
, GFP_ATOMIC
);
1941 hdr
= (void *) skb_put(skb
, HCI_EVENT_HDR_SIZE
);
1942 hdr
->evt
= HCI_EV_STACK_INTERNAL
;
1943 hdr
->plen
= sizeof(*ev
) + dlen
;
1945 ev
= (void *) skb_put(skb
, sizeof(*ev
) + dlen
);
1947 memcpy(ev
->data
, data
, dlen
);
1949 bt_cb(skb
)->incoming
= 1;
1950 __net_timestamp(skb
);
1952 bt_cb(skb
)->pkt_type
= HCI_EVENT_PKT
;
1953 skb
->dev
= (void *) hdev
;
1954 hci_send_to_sock(hdev
, skb
);