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 #ifndef CONFIG_BT_HCI_CORE_DEBUG
53 /* Handle HCI Event packets */
55 static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
57 __u8 status = *((__u8 *) skb->data);
59 BT_DBG("%s status 0x%x", hdev->name, status);
64 clear_bit(HCI_INQUIRY, &hdev->flags);
66 hci_req_complete(hdev, status);
68 hci_conn_check_pending(hdev);
71 static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
73 __u8 status = *((__u8 *) skb->data);
75 BT_DBG("%s status 0x%x", hdev->name, status);
80 clear_bit(HCI_INQUIRY, &hdev->flags);
82 hci_conn_check_pending(hdev);
85 static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
87 BT_DBG("%s", hdev->name);
90 static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
92 struct hci_rp_role_discovery *rp = (void *) skb->data;
93 struct hci_conn *conn;
95 BT_DBG("%s status 0x%x", hdev->name, rp->status);
102 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
105 conn->link_mode &= ~HCI_LM_MASTER;
107 conn->link_mode |= HCI_LM_MASTER;
110 hci_dev_unlock(hdev);
113 static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
115 struct hci_rp_read_link_policy *rp = (void *) skb->data;
116 struct hci_conn *conn;
118 BT_DBG("%s status 0x%x", hdev->name, rp->status);
125 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
127 conn->link_policy = __le16_to_cpu(rp->policy);
129 hci_dev_unlock(hdev);
132 static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
134 struct hci_rp_write_link_policy *rp = (void *) skb->data;
135 struct hci_conn *conn;
138 BT_DBG("%s status 0x%x", hdev->name, rp->status);
143 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
149 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
151 conn->link_policy = get_unaligned_le16(sent + 2);
153 hci_dev_unlock(hdev);
156 static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
158 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
160 BT_DBG("%s status 0x%x", hdev->name, rp->status);
165 hdev->link_policy = __le16_to_cpu(rp->policy);
168 static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
170 __u8 status = *((__u8 *) skb->data);
173 BT_DBG("%s status 0x%x", hdev->name, status);
175 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
180 hdev->link_policy = get_unaligned_le16(sent);
182 hci_req_complete(hdev, status);
185 static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
187 __u8 status = *((__u8 *) skb->data);
189 BT_DBG("%s status 0x%x", hdev->name, status);
191 hci_req_complete(hdev, status);
194 static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
196 __u8 status = *((__u8 *) skb->data);
199 BT_DBG("%s status 0x%x", hdev->name, status);
204 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
208 memcpy(hdev->dev_name, sent, 248);
211 static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
213 struct hci_rp_read_local_name *rp = (void *) skb->data;
215 BT_DBG("%s status 0x%x", hdev->name, rp->status);
220 memcpy(hdev->dev_name, rp->name, 248);
223 static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
225 __u8 status = *((__u8 *) skb->data);
228 BT_DBG("%s status 0x%x", hdev->name, status);
230 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
235 __u8 param = *((__u8 *) sent);
237 if (param == AUTH_ENABLED)
238 set_bit(HCI_AUTH, &hdev->flags);
240 clear_bit(HCI_AUTH, &hdev->flags);
243 hci_req_complete(hdev, status);
246 static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
248 __u8 status = *((__u8 *) skb->data);
251 BT_DBG("%s status 0x%x", hdev->name, status);
253 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
258 __u8 param = *((__u8 *) sent);
261 set_bit(HCI_ENCRYPT, &hdev->flags);
263 clear_bit(HCI_ENCRYPT, &hdev->flags);
266 hci_req_complete(hdev, status);
269 static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
271 __u8 status = *((__u8 *) skb->data);
274 BT_DBG("%s status 0x%x", hdev->name, status);
276 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
281 __u8 param = *((__u8 *) sent);
283 clear_bit(HCI_PSCAN, &hdev->flags);
284 clear_bit(HCI_ISCAN, &hdev->flags);
286 if (param & SCAN_INQUIRY)
287 set_bit(HCI_ISCAN, &hdev->flags);
289 if (param & SCAN_PAGE)
290 set_bit(HCI_PSCAN, &hdev->flags);
293 hci_req_complete(hdev, status);
296 static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
298 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
300 BT_DBG("%s status 0x%x", hdev->name, rp->status);
305 memcpy(hdev->dev_class, rp->dev_class, 3);
307 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
308 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
311 static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
313 __u8 status = *((__u8 *) skb->data);
316 BT_DBG("%s status 0x%x", hdev->name, status);
321 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
325 memcpy(hdev->dev_class, sent, 3);
328 static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
330 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
333 BT_DBG("%s status 0x%x", hdev->name, rp->status);
338 setting = __le16_to_cpu(rp->voice_setting);
340 if (hdev->voice_setting == setting)
343 hdev->voice_setting = setting;
345 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
348 tasklet_disable(&hdev->tx_task);
349 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
350 tasklet_enable(&hdev->tx_task);
354 static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
356 __u8 status = *((__u8 *) skb->data);
360 BT_DBG("%s status 0x%x", hdev->name, status);
365 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
369 setting = get_unaligned_le16(sent);
371 if (hdev->voice_setting == setting)
374 hdev->voice_setting = setting;
376 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
379 tasklet_disable(&hdev->tx_task);
380 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
381 tasklet_enable(&hdev->tx_task);
385 static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
387 __u8 status = *((__u8 *) skb->data);
389 BT_DBG("%s status 0x%x", hdev->name, status);
391 hci_req_complete(hdev, status);
394 static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
396 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
398 BT_DBG("%s status 0x%x", hdev->name, rp->status);
403 hdev->ssp_mode = rp->mode;
406 static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
408 __u8 status = *((__u8 *) skb->data);
411 BT_DBG("%s status 0x%x", hdev->name, status);
416 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
420 hdev->ssp_mode = *((__u8 *) sent);
423 static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
425 struct hci_rp_read_local_version *rp = (void *) skb->data;
427 BT_DBG("%s status 0x%x", hdev->name, rp->status);
432 hdev->hci_ver = rp->hci_ver;
433 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
434 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
436 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
438 hdev->hci_ver, hdev->hci_rev);
441 static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
443 struct hci_rp_read_local_commands *rp = (void *) skb->data;
445 BT_DBG("%s status 0x%x", hdev->name, rp->status);
450 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
453 static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
455 struct hci_rp_read_local_features *rp = (void *) skb->data;
457 BT_DBG("%s status 0x%x", hdev->name, rp->status);
462 memcpy(hdev->features, rp->features, 8);
464 /* Adjust default settings according to features
465 * supported by device. */
467 if (hdev->features[0] & LMP_3SLOT)
468 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
470 if (hdev->features[0] & LMP_5SLOT)
471 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
473 if (hdev->features[1] & LMP_HV2) {
474 hdev->pkt_type |= (HCI_HV2);
475 hdev->esco_type |= (ESCO_HV2);
478 if (hdev->features[1] & LMP_HV3) {
479 hdev->pkt_type |= (HCI_HV3);
480 hdev->esco_type |= (ESCO_HV3);
483 if (hdev->features[3] & LMP_ESCO)
484 hdev->esco_type |= (ESCO_EV3);
486 if (hdev->features[4] & LMP_EV4)
487 hdev->esco_type |= (ESCO_EV4);
489 if (hdev->features[4] & LMP_EV5)
490 hdev->esco_type |= (ESCO_EV5);
492 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
493 hdev->features[0], hdev->features[1],
494 hdev->features[2], hdev->features[3],
495 hdev->features[4], hdev->features[5],
496 hdev->features[6], hdev->features[7]);
499 static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
501 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
503 BT_DBG("%s status 0x%x", hdev->name, rp->status);
508 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
509 hdev->sco_mtu = rp->sco_mtu;
510 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
511 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
513 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
518 hdev->acl_cnt = hdev->acl_pkts;
519 hdev->sco_cnt = hdev->sco_pkts;
521 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
522 hdev->acl_mtu, hdev->acl_pkts,
523 hdev->sco_mtu, hdev->sco_pkts);
526 static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
528 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
530 BT_DBG("%s status 0x%x", hdev->name, rp->status);
533 bacpy(&hdev->bdaddr, &rp->bdaddr);
535 hci_req_complete(hdev, rp->status);
538 static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
540 BT_DBG("%s status 0x%x", hdev->name, status);
543 hci_req_complete(hdev, status);
545 hci_conn_check_pending(hdev);
547 set_bit(HCI_INQUIRY, &hdev->flags);
550 static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
552 struct hci_cp_create_conn *cp;
553 struct hci_conn *conn;
555 BT_DBG("%s status 0x%x", hdev->name, status);
557 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
563 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
565 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
568 if (conn && conn->state == BT_CONNECT) {
569 if (status != 0x0c || conn->attempt > 2) {
570 conn->state = BT_CLOSED;
571 hci_proto_connect_cfm(conn, status);
574 conn->state = BT_CONNECT2;
578 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
581 conn->link_mode |= HCI_LM_MASTER;
583 BT_ERR("No memmory for new connection");
587 hci_dev_unlock(hdev);
590 static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
592 struct hci_cp_add_sco *cp;
593 struct hci_conn *acl, *sco;
596 BT_DBG("%s status 0x%x", hdev->name, status);
601 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
605 handle = __le16_to_cpu(cp->handle);
607 BT_DBG("%s handle %d", hdev->name, handle);
611 acl = hci_conn_hash_lookup_handle(hdev, handle);
612 if (acl && (sco = acl->link)) {
613 sco->state = BT_CLOSED;
615 hci_proto_connect_cfm(sco, status);
619 hci_dev_unlock(hdev);
622 static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
624 struct hci_cp_auth_requested *cp;
625 struct hci_conn *conn;
627 BT_DBG("%s status 0x%x", hdev->name, status);
632 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
638 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
640 if (conn->state == BT_CONFIG) {
641 hci_proto_connect_cfm(conn, status);
646 hci_dev_unlock(hdev);
649 static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
651 struct hci_cp_set_conn_encrypt *cp;
652 struct hci_conn *conn;
654 BT_DBG("%s status 0x%x", hdev->name, status);
659 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
665 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
667 if (conn->state == BT_CONFIG) {
668 hci_proto_connect_cfm(conn, status);
673 hci_dev_unlock(hdev);
676 static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
678 BT_DBG("%s status 0x%x", hdev->name, status);
681 static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
683 struct hci_cp_read_remote_features *cp;
684 struct hci_conn *conn;
686 BT_DBG("%s status 0x%x", hdev->name, status);
691 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
697 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
699 if (conn->state == BT_CONFIG) {
700 hci_proto_connect_cfm(conn, status);
705 hci_dev_unlock(hdev);
708 static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
710 struct hci_cp_read_remote_ext_features *cp;
711 struct hci_conn *conn;
713 BT_DBG("%s status 0x%x", hdev->name, status);
718 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
724 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
726 if (conn->state == BT_CONFIG) {
727 hci_proto_connect_cfm(conn, status);
732 hci_dev_unlock(hdev);
735 static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
737 struct hci_cp_setup_sync_conn *cp;
738 struct hci_conn *acl, *sco;
741 BT_DBG("%s status 0x%x", hdev->name, status);
746 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
750 handle = __le16_to_cpu(cp->handle);
752 BT_DBG("%s handle %d", hdev->name, handle);
756 acl = hci_conn_hash_lookup_handle(hdev, handle);
757 if (acl && (sco = acl->link)) {
758 sco->state = BT_CLOSED;
760 hci_proto_connect_cfm(sco, status);
764 hci_dev_unlock(hdev);
767 static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
769 struct hci_cp_sniff_mode *cp;
770 struct hci_conn *conn;
772 BT_DBG("%s status 0x%x", hdev->name, status);
777 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
783 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
785 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
787 hci_dev_unlock(hdev);
790 static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
792 struct hci_cp_exit_sniff_mode *cp;
793 struct hci_conn *conn;
795 BT_DBG("%s status 0x%x", hdev->name, status);
800 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
806 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
808 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
810 hci_dev_unlock(hdev);
813 static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
815 __u8 status = *((__u8 *) skb->data);
817 BT_DBG("%s status %d", hdev->name, status);
819 clear_bit(HCI_INQUIRY, &hdev->flags);
821 hci_req_complete(hdev, status);
823 hci_conn_check_pending(hdev);
826 static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
828 struct inquiry_data data;
829 struct inquiry_info *info = (void *) (skb->data + 1);
830 int num_rsp = *((__u8 *) skb->data);
832 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
839 for (; num_rsp; num_rsp--) {
840 bacpy(&data.bdaddr, &info->bdaddr);
841 data.pscan_rep_mode = info->pscan_rep_mode;
842 data.pscan_period_mode = info->pscan_period_mode;
843 data.pscan_mode = info->pscan_mode;
844 memcpy(data.dev_class, info->dev_class, 3);
845 data.clock_offset = info->clock_offset;
847 data.ssp_mode = 0x00;
849 hci_inquiry_cache_update(hdev, &data);
852 hci_dev_unlock(hdev);
855 static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
857 struct hci_ev_conn_complete *ev = (void *) skb->data;
858 struct hci_conn *conn;
860 BT_DBG("%s", hdev->name);
864 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
869 conn->handle = __le16_to_cpu(ev->handle);
871 if (conn->type == ACL_LINK) {
872 conn->state = BT_CONFIG;
875 conn->state = BT_CONNECTED;
877 if (test_bit(HCI_AUTH, &hdev->flags))
878 conn->link_mode |= HCI_LM_AUTH;
880 if (test_bit(HCI_ENCRYPT, &hdev->flags))
881 conn->link_mode |= HCI_LM_ENCRYPT;
883 /* Get remote features */
884 if (conn->type == ACL_LINK) {
885 struct hci_cp_read_remote_features cp;
886 cp.handle = ev->handle;
887 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
891 /* Set packet type for incoming connection */
892 if (!conn->out && hdev->hci_ver < 3) {
893 struct hci_cp_change_conn_ptype cp;
894 cp.handle = ev->handle;
895 cp.pkt_type = cpu_to_le16(conn->pkt_type);
896 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
900 conn->state = BT_CLOSED;
902 if (conn->type == ACL_LINK) {
903 struct hci_conn *sco = conn->link;
906 if (lmp_esco_capable(hdev))
907 hci_setup_sync(sco, conn->handle);
909 hci_add_sco(sco, conn->handle);
911 hci_proto_connect_cfm(sco, ev->status);
918 hci_proto_connect_cfm(conn, ev->status);
923 hci_dev_unlock(hdev);
925 hci_conn_check_pending(hdev);
928 static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
930 struct hci_ev_conn_request *ev = (void *) skb->data;
931 int mask = hdev->link_mode;
933 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
934 batostr(&ev->bdaddr), ev->link_type);
936 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
938 if (mask & HCI_LM_ACCEPT) {
939 /* Connection accepted */
940 struct inquiry_entry *ie;
941 struct hci_conn *conn;
945 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
946 memcpy(ie->data.dev_class, ev->dev_class, 3);
948 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
950 if (!(conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr))) {
951 BT_ERR("No memmory for new connection");
952 hci_dev_unlock(hdev);
957 memcpy(conn->dev_class, ev->dev_class, 3);
958 conn->state = BT_CONNECT;
960 hci_dev_unlock(hdev);
962 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
963 struct hci_cp_accept_conn_req cp;
965 bacpy(&cp.bdaddr, &ev->bdaddr);
967 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
968 cp.role = 0x00; /* Become master */
970 cp.role = 0x01; /* Remain slave */
972 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
975 struct hci_cp_accept_sync_conn_req cp;
977 bacpy(&cp.bdaddr, &ev->bdaddr);
978 cp.pkt_type = cpu_to_le16(conn->pkt_type);
980 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
981 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
982 cp.max_latency = cpu_to_le16(0xffff);
983 cp.content_format = cpu_to_le16(hdev->voice_setting);
984 cp.retrans_effort = 0xff;
986 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
990 /* Connection rejected */
991 struct hci_cp_reject_conn_req cp;
993 bacpy(&cp.bdaddr, &ev->bdaddr);
995 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
999 static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1001 struct hci_ev_disconn_complete *ev = (void *) skb->data;
1002 struct hci_conn *conn;
1004 BT_DBG("%s status %d", hdev->name, ev->status);
1011 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1013 conn->state = BT_CLOSED;
1014 hci_proto_disconn_ind(conn, ev->reason);
1018 hci_dev_unlock(hdev);
1021 static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1023 struct hci_ev_auth_complete *ev = (void *) skb->data;
1024 struct hci_conn *conn;
1026 BT_DBG("%s status %d", hdev->name, ev->status);
1030 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1033 conn->link_mode |= HCI_LM_AUTH;
1035 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1037 if (conn->state == BT_CONFIG) {
1038 if (!ev->status && hdev->ssp_mode > 0 &&
1039 conn->ssp_mode > 0) {
1040 struct hci_cp_set_conn_encrypt cp;
1041 cp.handle = ev->handle;
1043 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1046 conn->state = BT_CONNECTED;
1047 hci_proto_connect_cfm(conn, ev->status);
1051 hci_auth_cfm(conn, ev->status);
1053 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1055 struct hci_cp_set_conn_encrypt cp;
1056 cp.handle = ev->handle;
1058 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1061 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1062 hci_encrypt_cfm(conn, ev->status, 0x00);
1067 hci_dev_unlock(hdev);
1070 static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1072 BT_DBG("%s", hdev->name);
1074 hci_conn_check_pending(hdev);
1077 static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1079 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1080 struct hci_conn *conn;
1082 BT_DBG("%s status %d", hdev->name, ev->status);
1086 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1090 /* Encryption implies authentication */
1091 conn->link_mode |= HCI_LM_AUTH;
1092 conn->link_mode |= HCI_LM_ENCRYPT;
1094 conn->link_mode &= ~HCI_LM_ENCRYPT;
1097 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1099 if (conn->state == BT_CONFIG) {
1101 conn->state = BT_CONNECTED;
1103 hci_proto_connect_cfm(conn, ev->status);
1106 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
1109 hci_dev_unlock(hdev);
1112 static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1114 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1115 struct hci_conn *conn;
1117 BT_DBG("%s status %d", hdev->name, ev->status);
1121 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1124 conn->link_mode |= HCI_LM_SECURE;
1126 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1128 hci_key_change_cfm(conn, ev->status);
1131 hci_dev_unlock(hdev);
1134 static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1136 struct hci_ev_remote_features *ev = (void *) skb->data;
1137 struct hci_conn *conn;
1139 BT_DBG("%s status %d", hdev->name, ev->status);
1143 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1146 memcpy(conn->features, ev->features, 8);
1148 if (conn->state == BT_CONFIG) {
1149 if (!ev->status && lmp_ssp_capable(hdev) &&
1150 lmp_ssp_capable(conn)) {
1151 struct hci_cp_read_remote_ext_features cp;
1152 cp.handle = ev->handle;
1155 HCI_OP_READ_REMOTE_EXT_FEATURES,
1158 conn->state = BT_CONNECTED;
1159 hci_proto_connect_cfm(conn, ev->status);
1165 hci_dev_unlock(hdev);
1168 static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1170 BT_DBG("%s", hdev->name);
1173 static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1175 BT_DBG("%s", hdev->name);
1178 static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1180 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1183 skb_pull(skb, sizeof(*ev));
1185 opcode = __le16_to_cpu(ev->opcode);
1188 case HCI_OP_INQUIRY_CANCEL:
1189 hci_cc_inquiry_cancel(hdev, skb);
1192 case HCI_OP_EXIT_PERIODIC_INQ:
1193 hci_cc_exit_periodic_inq(hdev, skb);
1196 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1197 hci_cc_remote_name_req_cancel(hdev, skb);
1200 case HCI_OP_ROLE_DISCOVERY:
1201 hci_cc_role_discovery(hdev, skb);
1204 case HCI_OP_READ_LINK_POLICY:
1205 hci_cc_read_link_policy(hdev, skb);
1208 case HCI_OP_WRITE_LINK_POLICY:
1209 hci_cc_write_link_policy(hdev, skb);
1212 case HCI_OP_READ_DEF_LINK_POLICY:
1213 hci_cc_read_def_link_policy(hdev, skb);
1216 case HCI_OP_WRITE_DEF_LINK_POLICY:
1217 hci_cc_write_def_link_policy(hdev, skb);
1221 hci_cc_reset(hdev, skb);
1224 case HCI_OP_WRITE_LOCAL_NAME:
1225 hci_cc_write_local_name(hdev, skb);
1228 case HCI_OP_READ_LOCAL_NAME:
1229 hci_cc_read_local_name(hdev, skb);
1232 case HCI_OP_WRITE_AUTH_ENABLE:
1233 hci_cc_write_auth_enable(hdev, skb);
1236 case HCI_OP_WRITE_ENCRYPT_MODE:
1237 hci_cc_write_encrypt_mode(hdev, skb);
1240 case HCI_OP_WRITE_SCAN_ENABLE:
1241 hci_cc_write_scan_enable(hdev, skb);
1244 case HCI_OP_READ_CLASS_OF_DEV:
1245 hci_cc_read_class_of_dev(hdev, skb);
1248 case HCI_OP_WRITE_CLASS_OF_DEV:
1249 hci_cc_write_class_of_dev(hdev, skb);
1252 case HCI_OP_READ_VOICE_SETTING:
1253 hci_cc_read_voice_setting(hdev, skb);
1256 case HCI_OP_WRITE_VOICE_SETTING:
1257 hci_cc_write_voice_setting(hdev, skb);
1260 case HCI_OP_HOST_BUFFER_SIZE:
1261 hci_cc_host_buffer_size(hdev, skb);
1264 case HCI_OP_READ_SSP_MODE:
1265 hci_cc_read_ssp_mode(hdev, skb);
1268 case HCI_OP_WRITE_SSP_MODE:
1269 hci_cc_write_ssp_mode(hdev, skb);
1272 case HCI_OP_READ_LOCAL_VERSION:
1273 hci_cc_read_local_version(hdev, skb);
1276 case HCI_OP_READ_LOCAL_COMMANDS:
1277 hci_cc_read_local_commands(hdev, skb);
1280 case HCI_OP_READ_LOCAL_FEATURES:
1281 hci_cc_read_local_features(hdev, skb);
1284 case HCI_OP_READ_BUFFER_SIZE:
1285 hci_cc_read_buffer_size(hdev, skb);
1288 case HCI_OP_READ_BD_ADDR:
1289 hci_cc_read_bd_addr(hdev, skb);
1293 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1298 atomic_set(&hdev->cmd_cnt, 1);
1299 if (!skb_queue_empty(&hdev->cmd_q))
1300 hci_sched_cmd(hdev);
1304 static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1306 struct hci_ev_cmd_status *ev = (void *) skb->data;
1309 skb_pull(skb, sizeof(*ev));
1311 opcode = __le16_to_cpu(ev->opcode);
1314 case HCI_OP_INQUIRY:
1315 hci_cs_inquiry(hdev, ev->status);
1318 case HCI_OP_CREATE_CONN:
1319 hci_cs_create_conn(hdev, ev->status);
1322 case HCI_OP_ADD_SCO:
1323 hci_cs_add_sco(hdev, ev->status);
1326 case HCI_OP_AUTH_REQUESTED:
1327 hci_cs_auth_requested(hdev, ev->status);
1330 case HCI_OP_SET_CONN_ENCRYPT:
1331 hci_cs_set_conn_encrypt(hdev, ev->status);
1334 case HCI_OP_REMOTE_NAME_REQ:
1335 hci_cs_remote_name_req(hdev, ev->status);
1338 case HCI_OP_READ_REMOTE_FEATURES:
1339 hci_cs_read_remote_features(hdev, ev->status);
1342 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1343 hci_cs_read_remote_ext_features(hdev, ev->status);
1346 case HCI_OP_SETUP_SYNC_CONN:
1347 hci_cs_setup_sync_conn(hdev, ev->status);
1350 case HCI_OP_SNIFF_MODE:
1351 hci_cs_sniff_mode(hdev, ev->status);
1354 case HCI_OP_EXIT_SNIFF_MODE:
1355 hci_cs_exit_sniff_mode(hdev, ev->status);
1359 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1364 atomic_set(&hdev->cmd_cnt, 1);
1365 if (!skb_queue_empty(&hdev->cmd_q))
1366 hci_sched_cmd(hdev);
1370 static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1372 struct hci_ev_role_change *ev = (void *) skb->data;
1373 struct hci_conn *conn;
1375 BT_DBG("%s status %d", hdev->name, ev->status);
1379 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1383 conn->link_mode &= ~HCI_LM_MASTER;
1385 conn->link_mode |= HCI_LM_MASTER;
1388 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
1390 hci_role_switch_cfm(conn, ev->status, ev->role);
1393 hci_dev_unlock(hdev);
1396 static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
1398 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
1402 skb_pull(skb, sizeof(*ev));
1404 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
1406 if (skb->len < ev->num_hndl * 4) {
1407 BT_DBG("%s bad parameters", hdev->name);
1411 tasklet_disable(&hdev->tx_task);
1413 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
1414 struct hci_conn *conn;
1415 __u16 handle, count;
1417 handle = get_unaligned_le16(ptr++);
1418 count = get_unaligned_le16(ptr++);
1420 conn = hci_conn_hash_lookup_handle(hdev, handle);
1422 conn->sent -= count;
1424 if (conn->type == ACL_LINK) {
1425 if ((hdev->acl_cnt += count) > hdev->acl_pkts)
1426 hdev->acl_cnt = hdev->acl_pkts;
1428 if ((hdev->sco_cnt += count) > hdev->sco_pkts)
1429 hdev->sco_cnt = hdev->sco_pkts;
1436 tasklet_enable(&hdev->tx_task);
1439 static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1441 struct hci_ev_mode_change *ev = (void *) skb->data;
1442 struct hci_conn *conn;
1444 BT_DBG("%s status %d", hdev->name, ev->status);
1448 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1450 conn->mode = ev->mode;
1451 conn->interval = __le16_to_cpu(ev->interval);
1453 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
1454 if (conn->mode == HCI_CM_ACTIVE)
1455 conn->power_save = 1;
1457 conn->power_save = 0;
1461 hci_dev_unlock(hdev);
1464 static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1466 BT_DBG("%s", hdev->name);
1469 static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1471 BT_DBG("%s", hdev->name);
1474 static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
1476 BT_DBG("%s", hdev->name);
1479 static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1481 struct hci_ev_clock_offset *ev = (void *) skb->data;
1482 struct hci_conn *conn;
1484 BT_DBG("%s status %d", hdev->name, ev->status);
1488 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1489 if (conn && !ev->status) {
1490 struct inquiry_entry *ie;
1492 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
1493 ie->data.clock_offset = ev->clock_offset;
1494 ie->timestamp = jiffies;
1498 hci_dev_unlock(hdev);
1501 static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1503 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
1504 struct hci_conn *conn;
1506 BT_DBG("%s status %d", hdev->name, ev->status);
1510 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1511 if (conn && !ev->status)
1512 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
1514 hci_dev_unlock(hdev);
1517 static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
1519 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
1520 struct inquiry_entry *ie;
1522 BT_DBG("%s", hdev->name);
1526 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr))) {
1527 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
1528 ie->timestamp = jiffies;
1531 hci_dev_unlock(hdev);
1534 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
1536 struct inquiry_data data;
1537 int num_rsp = *((__u8 *) skb->data);
1539 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1546 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
1547 struct inquiry_info_with_rssi_and_pscan_mode *info = (void *) (skb->data + 1);
1549 for (; num_rsp; num_rsp--) {
1550 bacpy(&data.bdaddr, &info->bdaddr);
1551 data.pscan_rep_mode = info->pscan_rep_mode;
1552 data.pscan_period_mode = info->pscan_period_mode;
1553 data.pscan_mode = info->pscan_mode;
1554 memcpy(data.dev_class, info->dev_class, 3);
1555 data.clock_offset = info->clock_offset;
1556 data.rssi = info->rssi;
1557 data.ssp_mode = 0x00;
1559 hci_inquiry_cache_update(hdev, &data);
1562 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
1564 for (; num_rsp; num_rsp--) {
1565 bacpy(&data.bdaddr, &info->bdaddr);
1566 data.pscan_rep_mode = info->pscan_rep_mode;
1567 data.pscan_period_mode = info->pscan_period_mode;
1568 data.pscan_mode = 0x00;
1569 memcpy(data.dev_class, info->dev_class, 3);
1570 data.clock_offset = info->clock_offset;
1571 data.rssi = info->rssi;
1572 data.ssp_mode = 0x00;
1574 hci_inquiry_cache_update(hdev, &data);
1578 hci_dev_unlock(hdev);
1581 static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1583 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
1584 struct hci_conn *conn;
1586 BT_DBG("%s", hdev->name);
1590 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1592 if (!ev->status && ev->page == 0x01) {
1593 struct inquiry_entry *ie;
1595 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst)))
1596 ie->data.ssp_mode = (ev->features[0] & 0x01);
1598 conn->ssp_mode = (ev->features[0] & 0x01);
1601 if (conn->state == BT_CONFIG) {
1602 if (!ev->status && hdev->ssp_mode > 0 &&
1603 conn->ssp_mode > 0) {
1605 struct hci_cp_auth_requested cp;
1606 cp.handle = ev->handle;
1608 HCI_OP_AUTH_REQUESTED,
1612 conn->state = BT_CONNECTED;
1613 hci_proto_connect_cfm(conn, ev->status);
1619 hci_dev_unlock(hdev);
1622 static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1624 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
1625 struct hci_conn *conn;
1627 BT_DBG("%s status %d", hdev->name, ev->status);
1631 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1633 if (ev->link_type == ESCO_LINK)
1636 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1640 conn->type = SCO_LINK;
1644 conn->handle = __le16_to_cpu(ev->handle);
1645 conn->state = BT_CONNECTED;
1647 conn->state = BT_CLOSED;
1649 hci_proto_connect_cfm(conn, ev->status);
1654 hci_dev_unlock(hdev);
1657 static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
1659 BT_DBG("%s", hdev->name);
1662 static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
1664 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
1665 struct hci_conn *conn;
1667 BT_DBG("%s status %d", hdev->name, ev->status);
1671 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1675 hci_dev_unlock(hdev);
1678 static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1680 struct inquiry_data data;
1681 struct extended_inquiry_info *info = (void *) (skb->data + 1);
1682 int num_rsp = *((__u8 *) skb->data);
1684 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1691 for (; num_rsp; num_rsp--) {
1692 bacpy(&data.bdaddr, &info->bdaddr);
1693 data.pscan_rep_mode = info->pscan_rep_mode;
1694 data.pscan_period_mode = info->pscan_period_mode;
1695 data.pscan_mode = 0x00;
1696 memcpy(data.dev_class, info->dev_class, 3);
1697 data.clock_offset = info->clock_offset;
1698 data.rssi = info->rssi;
1699 data.ssp_mode = 0x01;
1701 hci_inquiry_cache_update(hdev, &data);
1704 hci_dev_unlock(hdev);
1707 static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1709 struct hci_ev_io_capa_request *ev = (void *) skb->data;
1710 struct hci_conn *conn;
1712 BT_DBG("%s", hdev->name);
1716 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1718 hci_conn_hold(conn);
1720 hci_dev_unlock(hdev);
1723 static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1725 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
1726 struct hci_conn *conn;
1728 BT_DBG("%s", hdev->name);
1732 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1736 hci_dev_unlock(hdev);
1739 static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1741 struct hci_ev_remote_host_features *ev = (void *) skb->data;
1742 struct inquiry_entry *ie;
1744 BT_DBG("%s", hdev->name);
1748 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
1749 ie->data.ssp_mode = (ev->features[0] & 0x01);
1751 hci_dev_unlock(hdev);
1754 void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
1756 struct hci_event_hdr *hdr = (void *) skb->data;
1757 __u8 event = hdr->evt;
1759 skb_pull(skb, HCI_EVENT_HDR_SIZE);
1762 case HCI_EV_INQUIRY_COMPLETE:
1763 hci_inquiry_complete_evt(hdev, skb);
1766 case HCI_EV_INQUIRY_RESULT:
1767 hci_inquiry_result_evt(hdev, skb);
1770 case HCI_EV_CONN_COMPLETE:
1771 hci_conn_complete_evt(hdev, skb);
1774 case HCI_EV_CONN_REQUEST:
1775 hci_conn_request_evt(hdev, skb);
1778 case HCI_EV_DISCONN_COMPLETE:
1779 hci_disconn_complete_evt(hdev, skb);
1782 case HCI_EV_AUTH_COMPLETE:
1783 hci_auth_complete_evt(hdev, skb);
1786 case HCI_EV_REMOTE_NAME:
1787 hci_remote_name_evt(hdev, skb);
1790 case HCI_EV_ENCRYPT_CHANGE:
1791 hci_encrypt_change_evt(hdev, skb);
1794 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
1795 hci_change_link_key_complete_evt(hdev, skb);
1798 case HCI_EV_REMOTE_FEATURES:
1799 hci_remote_features_evt(hdev, skb);
1802 case HCI_EV_REMOTE_VERSION:
1803 hci_remote_version_evt(hdev, skb);
1806 case HCI_EV_QOS_SETUP_COMPLETE:
1807 hci_qos_setup_complete_evt(hdev, skb);
1810 case HCI_EV_CMD_COMPLETE:
1811 hci_cmd_complete_evt(hdev, skb);
1814 case HCI_EV_CMD_STATUS:
1815 hci_cmd_status_evt(hdev, skb);
1818 case HCI_EV_ROLE_CHANGE:
1819 hci_role_change_evt(hdev, skb);
1822 case HCI_EV_NUM_COMP_PKTS:
1823 hci_num_comp_pkts_evt(hdev, skb);
1826 case HCI_EV_MODE_CHANGE:
1827 hci_mode_change_evt(hdev, skb);
1830 case HCI_EV_PIN_CODE_REQ:
1831 hci_pin_code_request_evt(hdev, skb);
1834 case HCI_EV_LINK_KEY_REQ:
1835 hci_link_key_request_evt(hdev, skb);
1838 case HCI_EV_LINK_KEY_NOTIFY:
1839 hci_link_key_notify_evt(hdev, skb);
1842 case HCI_EV_CLOCK_OFFSET:
1843 hci_clock_offset_evt(hdev, skb);
1846 case HCI_EV_PKT_TYPE_CHANGE:
1847 hci_pkt_type_change_evt(hdev, skb);
1850 case HCI_EV_PSCAN_REP_MODE:
1851 hci_pscan_rep_mode_evt(hdev, skb);
1854 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
1855 hci_inquiry_result_with_rssi_evt(hdev, skb);
1858 case HCI_EV_REMOTE_EXT_FEATURES:
1859 hci_remote_ext_features_evt(hdev, skb);
1862 case HCI_EV_SYNC_CONN_COMPLETE:
1863 hci_sync_conn_complete_evt(hdev, skb);
1866 case HCI_EV_SYNC_CONN_CHANGED:
1867 hci_sync_conn_changed_evt(hdev, skb);
1870 case HCI_EV_SNIFF_SUBRATE:
1871 hci_sniff_subrate_evt(hdev, skb);
1874 case HCI_EV_EXTENDED_INQUIRY_RESULT:
1875 hci_extended_inquiry_result_evt(hdev, skb);
1878 case HCI_EV_IO_CAPA_REQUEST:
1879 hci_io_capa_request_evt(hdev, skb);
1882 case HCI_EV_SIMPLE_PAIR_COMPLETE:
1883 hci_simple_pair_complete_evt(hdev, skb);
1886 case HCI_EV_REMOTE_HOST_FEATURES:
1887 hci_remote_host_features_evt(hdev, skb);
1891 BT_DBG("%s event 0x%x", hdev->name, event);
1896 hdev->stat.evt_rx++;
1899 /* Generate internal stack event */
1900 void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
1902 struct hci_event_hdr *hdr;
1903 struct hci_ev_stack_internal *ev;
1904 struct sk_buff *skb;
1906 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
1910 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
1911 hdr->evt = HCI_EV_STACK_INTERNAL;
1912 hdr->plen = sizeof(*ev) + dlen;
1914 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
1916 memcpy(ev->data, data, dlen);
1918 bt_cb(skb)->incoming = 1;
1919 __net_timestamp(skb);
1921 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
1922 skb->dev = (void *) hdev;
1923 hci_send_to_sock(hdev, skb);