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_remote_name_req(struct hci_dev *hdev, __u8 status)
624 BT_DBG("%s status 0x%x", hdev->name, status);
627 static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
629 struct hci_cp_setup_sync_conn *cp;
630 struct hci_conn *acl, *sco;
633 BT_DBG("%s status 0x%x", hdev->name, status);
638 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
642 handle = __le16_to_cpu(cp->handle);
644 BT_DBG("%s handle %d", hdev->name, handle);
648 acl = hci_conn_hash_lookup_handle(hdev, handle);
649 if (acl && (sco = acl->link)) {
650 sco->state = BT_CLOSED;
652 hci_proto_connect_cfm(sco, status);
656 hci_dev_unlock(hdev);
659 static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
661 struct hci_cp_sniff_mode *cp;
662 struct hci_conn *conn;
664 BT_DBG("%s status 0x%x", hdev->name, status);
669 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
675 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
677 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
679 hci_dev_unlock(hdev);
682 static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
684 struct hci_cp_exit_sniff_mode *cp;
685 struct hci_conn *conn;
687 BT_DBG("%s status 0x%x", hdev->name, status);
692 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
698 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
700 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
702 hci_dev_unlock(hdev);
705 static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
707 __u8 status = *((__u8 *) skb->data);
709 BT_DBG("%s status %d", hdev->name, status);
711 clear_bit(HCI_INQUIRY, &hdev->flags);
713 hci_req_complete(hdev, status);
715 hci_conn_check_pending(hdev);
718 static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
720 struct inquiry_data data;
721 struct inquiry_info *info = (void *) (skb->data + 1);
722 int num_rsp = *((__u8 *) skb->data);
724 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
731 for (; num_rsp; num_rsp--) {
732 bacpy(&data.bdaddr, &info->bdaddr);
733 data.pscan_rep_mode = info->pscan_rep_mode;
734 data.pscan_period_mode = info->pscan_period_mode;
735 data.pscan_mode = info->pscan_mode;
736 memcpy(data.dev_class, info->dev_class, 3);
737 data.clock_offset = info->clock_offset;
739 data.ssp_mode = 0x00;
741 hci_inquiry_cache_update(hdev, &data);
744 hci_dev_unlock(hdev);
747 static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
749 struct hci_ev_conn_complete *ev = (void *) skb->data;
750 struct hci_conn *conn;
752 BT_DBG("%s", hdev->name);
756 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
761 conn->handle = __le16_to_cpu(ev->handle);
762 conn->state = BT_CONNECTED;
764 if (test_bit(HCI_AUTH, &hdev->flags))
765 conn->link_mode |= HCI_LM_AUTH;
767 if (test_bit(HCI_ENCRYPT, &hdev->flags))
768 conn->link_mode |= HCI_LM_ENCRYPT;
770 /* Get remote features */
771 if (conn->type == ACL_LINK) {
772 struct hci_cp_read_remote_features cp;
773 cp.handle = ev->handle;
774 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES, sizeof(cp), &cp);
777 /* Set packet type for incoming connection */
778 if (!conn->out && hdev->hci_ver < 3) {
779 struct hci_cp_change_conn_ptype cp;
780 cp.handle = ev->handle;
781 cp.pkt_type = cpu_to_le16(conn->pkt_type);
782 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
785 /* Update disconnect timer */
790 conn->state = BT_CLOSED;
792 if (conn->type == ACL_LINK) {
793 struct hci_conn *sco = conn->link;
796 if (lmp_esco_capable(hdev))
797 hci_setup_sync(sco, conn->handle);
799 hci_add_sco(sco, conn->handle);
801 hci_proto_connect_cfm(sco, ev->status);
807 hci_proto_connect_cfm(conn, ev->status);
812 hci_dev_unlock(hdev);
814 hci_conn_check_pending(hdev);
817 static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
819 struct hci_ev_conn_request *ev = (void *) skb->data;
820 int mask = hdev->link_mode;
822 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
823 batostr(&ev->bdaddr), ev->link_type);
825 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
827 if (mask & HCI_LM_ACCEPT) {
828 /* Connection accepted */
829 struct inquiry_entry *ie;
830 struct hci_conn *conn;
834 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
835 memcpy(ie->data.dev_class, ev->dev_class, 3);
837 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
839 if (!(conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr))) {
840 BT_ERR("No memmory for new connection");
841 hci_dev_unlock(hdev);
846 memcpy(conn->dev_class, ev->dev_class, 3);
847 conn->state = BT_CONNECT;
849 hci_dev_unlock(hdev);
851 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
852 struct hci_cp_accept_conn_req cp;
854 bacpy(&cp.bdaddr, &ev->bdaddr);
856 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
857 cp.role = 0x00; /* Become master */
859 cp.role = 0x01; /* Remain slave */
861 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
864 struct hci_cp_accept_sync_conn_req cp;
866 bacpy(&cp.bdaddr, &ev->bdaddr);
867 cp.pkt_type = cpu_to_le16(conn->pkt_type);
869 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
870 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
871 cp.max_latency = cpu_to_le16(0xffff);
872 cp.content_format = cpu_to_le16(hdev->voice_setting);
873 cp.retrans_effort = 0xff;
875 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
879 /* Connection rejected */
880 struct hci_cp_reject_conn_req cp;
882 bacpy(&cp.bdaddr, &ev->bdaddr);
884 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
888 static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
890 struct hci_ev_disconn_complete *ev = (void *) skb->data;
891 struct hci_conn *conn;
893 BT_DBG("%s status %d", hdev->name, ev->status);
900 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
902 conn->state = BT_CLOSED;
903 hci_proto_disconn_ind(conn, ev->reason);
907 hci_dev_unlock(hdev);
910 static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
912 struct hci_ev_auth_complete *ev = (void *) skb->data;
913 struct hci_conn *conn;
915 BT_DBG("%s status %d", hdev->name, ev->status);
919 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
922 conn->link_mode |= HCI_LM_AUTH;
924 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
926 hci_auth_cfm(conn, ev->status);
928 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
930 struct hci_cp_set_conn_encrypt cp;
931 cp.handle = cpu_to_le16(conn->handle);
933 hci_send_cmd(conn->hdev,
934 HCI_OP_SET_CONN_ENCRYPT, sizeof(cp), &cp);
936 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
937 hci_encrypt_cfm(conn, ev->status, 0x00);
942 hci_dev_unlock(hdev);
945 static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
947 BT_DBG("%s", hdev->name);
949 hci_conn_check_pending(hdev);
952 static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
954 struct hci_ev_encrypt_change *ev = (void *) skb->data;
955 struct hci_conn *conn;
957 BT_DBG("%s status %d", hdev->name, ev->status);
961 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
965 /* Encryption implies authentication */
966 conn->link_mode |= HCI_LM_AUTH;
967 conn->link_mode |= HCI_LM_ENCRYPT;
969 conn->link_mode &= ~HCI_LM_ENCRYPT;
972 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
974 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
977 hci_dev_unlock(hdev);
980 static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
982 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
983 struct hci_conn *conn;
985 BT_DBG("%s status %d", hdev->name, ev->status);
989 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
992 conn->link_mode |= HCI_LM_SECURE;
994 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
996 hci_key_change_cfm(conn, ev->status);
999 hci_dev_unlock(hdev);
1002 static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1004 struct hci_ev_remote_features *ev = (void *) skb->data;
1005 struct hci_conn *conn;
1007 BT_DBG("%s status %d", hdev->name, ev->status);
1014 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1016 memcpy(conn->features, ev->features, 8);
1018 hci_dev_unlock(hdev);
1021 static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1023 BT_DBG("%s", hdev->name);
1026 static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1028 BT_DBG("%s", hdev->name);
1031 static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1033 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1036 skb_pull(skb, sizeof(*ev));
1038 opcode = __le16_to_cpu(ev->opcode);
1041 case HCI_OP_INQUIRY_CANCEL:
1042 hci_cc_inquiry_cancel(hdev, skb);
1045 case HCI_OP_EXIT_PERIODIC_INQ:
1046 hci_cc_exit_periodic_inq(hdev, skb);
1049 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1050 hci_cc_remote_name_req_cancel(hdev, skb);
1053 case HCI_OP_ROLE_DISCOVERY:
1054 hci_cc_role_discovery(hdev, skb);
1057 case HCI_OP_READ_LINK_POLICY:
1058 hci_cc_read_link_policy(hdev, skb);
1061 case HCI_OP_WRITE_LINK_POLICY:
1062 hci_cc_write_link_policy(hdev, skb);
1065 case HCI_OP_READ_DEF_LINK_POLICY:
1066 hci_cc_read_def_link_policy(hdev, skb);
1069 case HCI_OP_WRITE_DEF_LINK_POLICY:
1070 hci_cc_write_def_link_policy(hdev, skb);
1074 hci_cc_reset(hdev, skb);
1077 case HCI_OP_WRITE_LOCAL_NAME:
1078 hci_cc_write_local_name(hdev, skb);
1081 case HCI_OP_READ_LOCAL_NAME:
1082 hci_cc_read_local_name(hdev, skb);
1085 case HCI_OP_WRITE_AUTH_ENABLE:
1086 hci_cc_write_auth_enable(hdev, skb);
1089 case HCI_OP_WRITE_ENCRYPT_MODE:
1090 hci_cc_write_encrypt_mode(hdev, skb);
1093 case HCI_OP_WRITE_SCAN_ENABLE:
1094 hci_cc_write_scan_enable(hdev, skb);
1097 case HCI_OP_READ_CLASS_OF_DEV:
1098 hci_cc_read_class_of_dev(hdev, skb);
1101 case HCI_OP_WRITE_CLASS_OF_DEV:
1102 hci_cc_write_class_of_dev(hdev, skb);
1105 case HCI_OP_READ_VOICE_SETTING:
1106 hci_cc_read_voice_setting(hdev, skb);
1109 case HCI_OP_WRITE_VOICE_SETTING:
1110 hci_cc_write_voice_setting(hdev, skb);
1113 case HCI_OP_HOST_BUFFER_SIZE:
1114 hci_cc_host_buffer_size(hdev, skb);
1117 case HCI_OP_READ_SSP_MODE:
1118 hci_cc_read_ssp_mode(hdev, skb);
1121 case HCI_OP_WRITE_SSP_MODE:
1122 hci_cc_write_ssp_mode(hdev, skb);
1125 case HCI_OP_READ_LOCAL_VERSION:
1126 hci_cc_read_local_version(hdev, skb);
1129 case HCI_OP_READ_LOCAL_COMMANDS:
1130 hci_cc_read_local_commands(hdev, skb);
1133 case HCI_OP_READ_LOCAL_FEATURES:
1134 hci_cc_read_local_features(hdev, skb);
1137 case HCI_OP_READ_BUFFER_SIZE:
1138 hci_cc_read_buffer_size(hdev, skb);
1141 case HCI_OP_READ_BD_ADDR:
1142 hci_cc_read_bd_addr(hdev, skb);
1146 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1151 atomic_set(&hdev->cmd_cnt, 1);
1152 if (!skb_queue_empty(&hdev->cmd_q))
1153 hci_sched_cmd(hdev);
1157 static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1159 struct hci_ev_cmd_status *ev = (void *) skb->data;
1162 skb_pull(skb, sizeof(*ev));
1164 opcode = __le16_to_cpu(ev->opcode);
1167 case HCI_OP_INQUIRY:
1168 hci_cs_inquiry(hdev, ev->status);
1171 case HCI_OP_CREATE_CONN:
1172 hci_cs_create_conn(hdev, ev->status);
1175 case HCI_OP_ADD_SCO:
1176 hci_cs_add_sco(hdev, ev->status);
1179 case HCI_OP_REMOTE_NAME_REQ:
1180 hci_cs_remote_name_req(hdev, ev->status);
1183 case HCI_OP_SETUP_SYNC_CONN:
1184 hci_cs_setup_sync_conn(hdev, ev->status);
1187 case HCI_OP_SNIFF_MODE:
1188 hci_cs_sniff_mode(hdev, ev->status);
1191 case HCI_OP_EXIT_SNIFF_MODE:
1192 hci_cs_exit_sniff_mode(hdev, ev->status);
1196 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1201 atomic_set(&hdev->cmd_cnt, 1);
1202 if (!skb_queue_empty(&hdev->cmd_q))
1203 hci_sched_cmd(hdev);
1207 static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1209 struct hci_ev_role_change *ev = (void *) skb->data;
1210 struct hci_conn *conn;
1212 BT_DBG("%s status %d", hdev->name, ev->status);
1216 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1220 conn->link_mode &= ~HCI_LM_MASTER;
1222 conn->link_mode |= HCI_LM_MASTER;
1225 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
1227 hci_role_switch_cfm(conn, ev->status, ev->role);
1230 hci_dev_unlock(hdev);
1233 static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
1235 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
1239 skb_pull(skb, sizeof(*ev));
1241 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
1243 if (skb->len < ev->num_hndl * 4) {
1244 BT_DBG("%s bad parameters", hdev->name);
1248 tasklet_disable(&hdev->tx_task);
1250 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
1251 struct hci_conn *conn;
1252 __u16 handle, count;
1254 handle = get_unaligned_le16(ptr++);
1255 count = get_unaligned_le16(ptr++);
1257 conn = hci_conn_hash_lookup_handle(hdev, handle);
1259 conn->sent -= count;
1261 if (conn->type == ACL_LINK) {
1262 if ((hdev->acl_cnt += count) > hdev->acl_pkts)
1263 hdev->acl_cnt = hdev->acl_pkts;
1265 if ((hdev->sco_cnt += count) > hdev->sco_pkts)
1266 hdev->sco_cnt = hdev->sco_pkts;
1273 tasklet_enable(&hdev->tx_task);
1276 static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1278 struct hci_ev_mode_change *ev = (void *) skb->data;
1279 struct hci_conn *conn;
1281 BT_DBG("%s status %d", hdev->name, ev->status);
1285 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1287 conn->mode = ev->mode;
1288 conn->interval = __le16_to_cpu(ev->interval);
1290 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
1291 if (conn->mode == HCI_CM_ACTIVE)
1292 conn->power_save = 1;
1294 conn->power_save = 0;
1298 hci_dev_unlock(hdev);
1301 static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1303 BT_DBG("%s", hdev->name);
1306 static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1308 BT_DBG("%s", hdev->name);
1311 static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
1313 BT_DBG("%s", hdev->name);
1316 static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1318 struct hci_ev_clock_offset *ev = (void *) skb->data;
1319 struct hci_conn *conn;
1321 BT_DBG("%s status %d", hdev->name, ev->status);
1325 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1326 if (conn && !ev->status) {
1327 struct inquiry_entry *ie;
1329 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
1330 ie->data.clock_offset = ev->clock_offset;
1331 ie->timestamp = jiffies;
1335 hci_dev_unlock(hdev);
1338 static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1340 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
1341 struct hci_conn *conn;
1343 BT_DBG("%s status %d", hdev->name, ev->status);
1347 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1348 if (conn && !ev->status)
1349 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
1351 hci_dev_unlock(hdev);
1354 static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
1356 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
1357 struct inquiry_entry *ie;
1359 BT_DBG("%s", hdev->name);
1363 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr))) {
1364 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
1365 ie->timestamp = jiffies;
1368 hci_dev_unlock(hdev);
1371 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
1373 struct inquiry_data data;
1374 int num_rsp = *((__u8 *) skb->data);
1376 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1383 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
1384 struct inquiry_info_with_rssi_and_pscan_mode *info = (void *) (skb->data + 1);
1386 for (; num_rsp; num_rsp--) {
1387 bacpy(&data.bdaddr, &info->bdaddr);
1388 data.pscan_rep_mode = info->pscan_rep_mode;
1389 data.pscan_period_mode = info->pscan_period_mode;
1390 data.pscan_mode = info->pscan_mode;
1391 memcpy(data.dev_class, info->dev_class, 3);
1392 data.clock_offset = info->clock_offset;
1393 data.rssi = info->rssi;
1394 data.ssp_mode = 0x00;
1396 hci_inquiry_cache_update(hdev, &data);
1399 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
1401 for (; num_rsp; num_rsp--) {
1402 bacpy(&data.bdaddr, &info->bdaddr);
1403 data.pscan_rep_mode = info->pscan_rep_mode;
1404 data.pscan_period_mode = info->pscan_period_mode;
1405 data.pscan_mode = 0x00;
1406 memcpy(data.dev_class, info->dev_class, 3);
1407 data.clock_offset = info->clock_offset;
1408 data.rssi = info->rssi;
1409 data.ssp_mode = 0x00;
1411 hci_inquiry_cache_update(hdev, &data);
1415 hci_dev_unlock(hdev);
1418 static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1420 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
1421 struct hci_conn *conn;
1423 BT_DBG("%s", hdev->name);
1425 if (ev->status || ev->page != 0x01)
1430 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1432 struct inquiry_entry *ie;
1434 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst)))
1435 ie->data.ssp_mode = (ev->features[0] & 0x01);
1437 conn->ssp_mode = (ev->features[0] & 0x01);
1440 hci_dev_unlock(hdev);
1443 static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1445 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
1446 struct hci_conn *conn;
1448 BT_DBG("%s status %d", hdev->name, ev->status);
1452 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1454 if (ev->link_type == ESCO_LINK)
1457 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1461 conn->type = SCO_LINK;
1465 conn->handle = __le16_to_cpu(ev->handle);
1466 conn->state = BT_CONNECTED;
1468 conn->state = BT_CLOSED;
1470 hci_proto_connect_cfm(conn, ev->status);
1475 hci_dev_unlock(hdev);
1478 static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
1480 BT_DBG("%s", hdev->name);
1483 static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
1485 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
1486 struct hci_conn *conn;
1488 BT_DBG("%s status %d", hdev->name, ev->status);
1492 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1496 hci_dev_unlock(hdev);
1499 static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1501 struct inquiry_data data;
1502 struct extended_inquiry_info *info = (void *) (skb->data + 1);
1503 int num_rsp = *((__u8 *) skb->data);
1505 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1512 for (; num_rsp; num_rsp--) {
1513 bacpy(&data.bdaddr, &info->bdaddr);
1514 data.pscan_rep_mode = info->pscan_rep_mode;
1515 data.pscan_period_mode = info->pscan_period_mode;
1516 data.pscan_mode = 0x00;
1517 memcpy(data.dev_class, info->dev_class, 3);
1518 data.clock_offset = info->clock_offset;
1519 data.rssi = info->rssi;
1520 data.ssp_mode = 0x01;
1522 hci_inquiry_cache_update(hdev, &data);
1525 hci_dev_unlock(hdev);
1528 static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1530 struct hci_ev_io_capa_request *ev = (void *) skb->data;
1531 struct hci_conn *conn;
1533 BT_DBG("%s", hdev->name);
1537 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1539 hci_conn_hold(conn);
1541 hci_dev_unlock(hdev);
1544 static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1546 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
1547 struct hci_conn *conn;
1549 BT_DBG("%s", hdev->name);
1553 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1557 hci_dev_unlock(hdev);
1560 static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1562 struct hci_ev_remote_host_features *ev = (void *) skb->data;
1563 struct inquiry_entry *ie;
1565 BT_DBG("%s", hdev->name);
1569 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
1570 ie->data.ssp_mode = (ev->features[0] & 0x01);
1572 hci_dev_unlock(hdev);
1575 void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
1577 struct hci_event_hdr *hdr = (void *) skb->data;
1578 __u8 event = hdr->evt;
1580 skb_pull(skb, HCI_EVENT_HDR_SIZE);
1583 case HCI_EV_INQUIRY_COMPLETE:
1584 hci_inquiry_complete_evt(hdev, skb);
1587 case HCI_EV_INQUIRY_RESULT:
1588 hci_inquiry_result_evt(hdev, skb);
1591 case HCI_EV_CONN_COMPLETE:
1592 hci_conn_complete_evt(hdev, skb);
1595 case HCI_EV_CONN_REQUEST:
1596 hci_conn_request_evt(hdev, skb);
1599 case HCI_EV_DISCONN_COMPLETE:
1600 hci_disconn_complete_evt(hdev, skb);
1603 case HCI_EV_AUTH_COMPLETE:
1604 hci_auth_complete_evt(hdev, skb);
1607 case HCI_EV_REMOTE_NAME:
1608 hci_remote_name_evt(hdev, skb);
1611 case HCI_EV_ENCRYPT_CHANGE:
1612 hci_encrypt_change_evt(hdev, skb);
1615 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
1616 hci_change_link_key_complete_evt(hdev, skb);
1619 case HCI_EV_REMOTE_FEATURES:
1620 hci_remote_features_evt(hdev, skb);
1623 case HCI_EV_REMOTE_VERSION:
1624 hci_remote_version_evt(hdev, skb);
1627 case HCI_EV_QOS_SETUP_COMPLETE:
1628 hci_qos_setup_complete_evt(hdev, skb);
1631 case HCI_EV_CMD_COMPLETE:
1632 hci_cmd_complete_evt(hdev, skb);
1635 case HCI_EV_CMD_STATUS:
1636 hci_cmd_status_evt(hdev, skb);
1639 case HCI_EV_ROLE_CHANGE:
1640 hci_role_change_evt(hdev, skb);
1643 case HCI_EV_NUM_COMP_PKTS:
1644 hci_num_comp_pkts_evt(hdev, skb);
1647 case HCI_EV_MODE_CHANGE:
1648 hci_mode_change_evt(hdev, skb);
1651 case HCI_EV_PIN_CODE_REQ:
1652 hci_pin_code_request_evt(hdev, skb);
1655 case HCI_EV_LINK_KEY_REQ:
1656 hci_link_key_request_evt(hdev, skb);
1659 case HCI_EV_LINK_KEY_NOTIFY:
1660 hci_link_key_notify_evt(hdev, skb);
1663 case HCI_EV_CLOCK_OFFSET:
1664 hci_clock_offset_evt(hdev, skb);
1667 case HCI_EV_PKT_TYPE_CHANGE:
1668 hci_pkt_type_change_evt(hdev, skb);
1671 case HCI_EV_PSCAN_REP_MODE:
1672 hci_pscan_rep_mode_evt(hdev, skb);
1675 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
1676 hci_inquiry_result_with_rssi_evt(hdev, skb);
1679 case HCI_EV_REMOTE_EXT_FEATURES:
1680 hci_remote_ext_features_evt(hdev, skb);
1683 case HCI_EV_SYNC_CONN_COMPLETE:
1684 hci_sync_conn_complete_evt(hdev, skb);
1687 case HCI_EV_SYNC_CONN_CHANGED:
1688 hci_sync_conn_changed_evt(hdev, skb);
1691 case HCI_EV_SNIFF_SUBRATE:
1692 hci_sniff_subrate_evt(hdev, skb);
1695 case HCI_EV_EXTENDED_INQUIRY_RESULT:
1696 hci_extended_inquiry_result_evt(hdev, skb);
1699 case HCI_EV_IO_CAPA_REQUEST:
1700 hci_io_capa_request_evt(hdev, skb);
1703 case HCI_EV_SIMPLE_PAIR_COMPLETE:
1704 hci_simple_pair_complete_evt(hdev, skb);
1707 case HCI_EV_REMOTE_HOST_FEATURES:
1708 hci_remote_host_features_evt(hdev, skb);
1712 BT_DBG("%s event 0x%x", hdev->name, event);
1717 hdev->stat.evt_rx++;
1720 /* Generate internal stack event */
1721 void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
1723 struct hci_event_hdr *hdr;
1724 struct hci_ev_stack_internal *ev;
1725 struct sk_buff *skb;
1727 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
1731 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
1732 hdr->evt = HCI_EV_STACK_INTERNAL;
1733 hdr->plen = sizeof(*ev) + dlen;
1735 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
1737 memcpy(ev->data, data, dlen);
1739 bt_cb(skb)->incoming = 1;
1740 __net_timestamp(skb);
1742 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
1743 skb->dev = (void *) hdev;
1744 hci_send_to_sock(hdev, skb);