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);
873 conn->handle = __le16_to_cpu(ev->handle);
875 if (conn->type == ACL_LINK) {
876 conn->state = BT_CONFIG;
879 conn->state = BT_CONNECTED;
881 hci_conn_add_sysfs(conn);
883 if (test_bit(HCI_AUTH, &hdev->flags))
884 conn->link_mode |= HCI_LM_AUTH;
886 if (test_bit(HCI_ENCRYPT, &hdev->flags))
887 conn->link_mode |= HCI_LM_ENCRYPT;
889 /* Get remote features */
890 if (conn->type == ACL_LINK) {
891 struct hci_cp_read_remote_features cp;
892 cp.handle = ev->handle;
893 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
897 /* Set packet type for incoming connection */
898 if (!conn->out && hdev->hci_ver < 3) {
899 struct hci_cp_change_conn_ptype cp;
900 cp.handle = ev->handle;
901 cp.pkt_type = cpu_to_le16(conn->pkt_type);
902 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
906 conn->state = BT_CLOSED;
908 if (conn->type == ACL_LINK) {
909 struct hci_conn *sco = conn->link;
912 if (lmp_esco_capable(hdev))
913 hci_setup_sync(sco, conn->handle);
915 hci_add_sco(sco, conn->handle);
917 hci_proto_connect_cfm(sco, ev->status);
924 hci_proto_connect_cfm(conn, ev->status);
926 } else if (ev->link_type != ACL_LINK)
927 hci_proto_connect_cfm(conn, ev->status);
930 hci_dev_unlock(hdev);
932 hci_conn_check_pending(hdev);
935 static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
937 struct hci_ev_conn_request *ev = (void *) skb->data;
938 int mask = hdev->link_mode;
940 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
941 batostr(&ev->bdaddr), ev->link_type);
943 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
945 if (mask & HCI_LM_ACCEPT) {
946 /* Connection accepted */
947 struct inquiry_entry *ie;
948 struct hci_conn *conn;
952 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
953 memcpy(ie->data.dev_class, ev->dev_class, 3);
955 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
957 if (!(conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr))) {
958 BT_ERR("No memmory for new connection");
959 hci_dev_unlock(hdev);
964 memcpy(conn->dev_class, ev->dev_class, 3);
965 conn->state = BT_CONNECT;
967 hci_dev_unlock(hdev);
969 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
970 struct hci_cp_accept_conn_req cp;
972 bacpy(&cp.bdaddr, &ev->bdaddr);
974 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
975 cp.role = 0x00; /* Become master */
977 cp.role = 0x01; /* Remain slave */
979 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
982 struct hci_cp_accept_sync_conn_req cp;
984 bacpy(&cp.bdaddr, &ev->bdaddr);
985 cp.pkt_type = cpu_to_le16(conn->pkt_type);
987 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
988 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
989 cp.max_latency = cpu_to_le16(0xffff);
990 cp.content_format = cpu_to_le16(hdev->voice_setting);
991 cp.retrans_effort = 0xff;
993 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
997 /* Connection rejected */
998 struct hci_cp_reject_conn_req cp;
1000 bacpy(&cp.bdaddr, &ev->bdaddr);
1002 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
1006 static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1008 struct hci_ev_disconn_complete *ev = (void *) skb->data;
1009 struct hci_conn *conn;
1011 BT_DBG("%s status %d", hdev->name, ev->status);
1018 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1020 conn->state = BT_CLOSED;
1022 hci_conn_del_sysfs(conn);
1024 hci_proto_disconn_cfm(conn, ev->reason);
1028 hci_dev_unlock(hdev);
1031 static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1033 struct hci_ev_auth_complete *ev = (void *) skb->data;
1034 struct hci_conn *conn;
1036 BT_DBG("%s status %d", hdev->name, ev->status);
1040 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1043 conn->link_mode |= HCI_LM_AUTH;
1045 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1047 if (conn->state == BT_CONFIG) {
1048 if (!ev->status && hdev->ssp_mode > 0 &&
1049 conn->ssp_mode > 0) {
1050 struct hci_cp_set_conn_encrypt cp;
1051 cp.handle = ev->handle;
1053 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1056 conn->state = BT_CONNECTED;
1057 hci_proto_connect_cfm(conn, ev->status);
1061 hci_auth_cfm(conn, ev->status);
1063 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1065 struct hci_cp_set_conn_encrypt cp;
1066 cp.handle = ev->handle;
1068 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1071 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1072 hci_encrypt_cfm(conn, ev->status, 0x00);
1077 hci_dev_unlock(hdev);
1080 static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1082 BT_DBG("%s", hdev->name);
1084 hci_conn_check_pending(hdev);
1087 static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1089 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1090 struct hci_conn *conn;
1092 BT_DBG("%s status %d", hdev->name, ev->status);
1096 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1100 /* Encryption implies authentication */
1101 conn->link_mode |= HCI_LM_AUTH;
1102 conn->link_mode |= HCI_LM_ENCRYPT;
1104 conn->link_mode &= ~HCI_LM_ENCRYPT;
1107 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1109 if (conn->state == BT_CONFIG) {
1111 conn->state = BT_CONNECTED;
1113 hci_proto_connect_cfm(conn, ev->status);
1116 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
1119 hci_dev_unlock(hdev);
1122 static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1124 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1125 struct hci_conn *conn;
1127 BT_DBG("%s status %d", hdev->name, ev->status);
1131 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1134 conn->link_mode |= HCI_LM_SECURE;
1136 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1138 hci_key_change_cfm(conn, ev->status);
1141 hci_dev_unlock(hdev);
1144 static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1146 struct hci_ev_remote_features *ev = (void *) skb->data;
1147 struct hci_conn *conn;
1149 BT_DBG("%s status %d", hdev->name, ev->status);
1153 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1156 memcpy(conn->features, ev->features, 8);
1158 if (conn->state == BT_CONFIG) {
1159 if (!ev->status && lmp_ssp_capable(hdev) &&
1160 lmp_ssp_capable(conn)) {
1161 struct hci_cp_read_remote_ext_features cp;
1162 cp.handle = ev->handle;
1165 HCI_OP_READ_REMOTE_EXT_FEATURES,
1168 conn->state = BT_CONNECTED;
1169 hci_proto_connect_cfm(conn, ev->status);
1175 hci_dev_unlock(hdev);
1178 static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1180 BT_DBG("%s", hdev->name);
1183 static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1185 BT_DBG("%s", hdev->name);
1188 static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1190 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1193 skb_pull(skb, sizeof(*ev));
1195 opcode = __le16_to_cpu(ev->opcode);
1198 case HCI_OP_INQUIRY_CANCEL:
1199 hci_cc_inquiry_cancel(hdev, skb);
1202 case HCI_OP_EXIT_PERIODIC_INQ:
1203 hci_cc_exit_periodic_inq(hdev, skb);
1206 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1207 hci_cc_remote_name_req_cancel(hdev, skb);
1210 case HCI_OP_ROLE_DISCOVERY:
1211 hci_cc_role_discovery(hdev, skb);
1214 case HCI_OP_READ_LINK_POLICY:
1215 hci_cc_read_link_policy(hdev, skb);
1218 case HCI_OP_WRITE_LINK_POLICY:
1219 hci_cc_write_link_policy(hdev, skb);
1222 case HCI_OP_READ_DEF_LINK_POLICY:
1223 hci_cc_read_def_link_policy(hdev, skb);
1226 case HCI_OP_WRITE_DEF_LINK_POLICY:
1227 hci_cc_write_def_link_policy(hdev, skb);
1231 hci_cc_reset(hdev, skb);
1234 case HCI_OP_WRITE_LOCAL_NAME:
1235 hci_cc_write_local_name(hdev, skb);
1238 case HCI_OP_READ_LOCAL_NAME:
1239 hci_cc_read_local_name(hdev, skb);
1242 case HCI_OP_WRITE_AUTH_ENABLE:
1243 hci_cc_write_auth_enable(hdev, skb);
1246 case HCI_OP_WRITE_ENCRYPT_MODE:
1247 hci_cc_write_encrypt_mode(hdev, skb);
1250 case HCI_OP_WRITE_SCAN_ENABLE:
1251 hci_cc_write_scan_enable(hdev, skb);
1254 case HCI_OP_READ_CLASS_OF_DEV:
1255 hci_cc_read_class_of_dev(hdev, skb);
1258 case HCI_OP_WRITE_CLASS_OF_DEV:
1259 hci_cc_write_class_of_dev(hdev, skb);
1262 case HCI_OP_READ_VOICE_SETTING:
1263 hci_cc_read_voice_setting(hdev, skb);
1266 case HCI_OP_WRITE_VOICE_SETTING:
1267 hci_cc_write_voice_setting(hdev, skb);
1270 case HCI_OP_HOST_BUFFER_SIZE:
1271 hci_cc_host_buffer_size(hdev, skb);
1274 case HCI_OP_READ_SSP_MODE:
1275 hci_cc_read_ssp_mode(hdev, skb);
1278 case HCI_OP_WRITE_SSP_MODE:
1279 hci_cc_write_ssp_mode(hdev, skb);
1282 case HCI_OP_READ_LOCAL_VERSION:
1283 hci_cc_read_local_version(hdev, skb);
1286 case HCI_OP_READ_LOCAL_COMMANDS:
1287 hci_cc_read_local_commands(hdev, skb);
1290 case HCI_OP_READ_LOCAL_FEATURES:
1291 hci_cc_read_local_features(hdev, skb);
1294 case HCI_OP_READ_BUFFER_SIZE:
1295 hci_cc_read_buffer_size(hdev, skb);
1298 case HCI_OP_READ_BD_ADDR:
1299 hci_cc_read_bd_addr(hdev, skb);
1303 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1308 atomic_set(&hdev->cmd_cnt, 1);
1309 if (!skb_queue_empty(&hdev->cmd_q))
1310 hci_sched_cmd(hdev);
1314 static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1316 struct hci_ev_cmd_status *ev = (void *) skb->data;
1319 skb_pull(skb, sizeof(*ev));
1321 opcode = __le16_to_cpu(ev->opcode);
1324 case HCI_OP_INQUIRY:
1325 hci_cs_inquiry(hdev, ev->status);
1328 case HCI_OP_CREATE_CONN:
1329 hci_cs_create_conn(hdev, ev->status);
1332 case HCI_OP_ADD_SCO:
1333 hci_cs_add_sco(hdev, ev->status);
1336 case HCI_OP_AUTH_REQUESTED:
1337 hci_cs_auth_requested(hdev, ev->status);
1340 case HCI_OP_SET_CONN_ENCRYPT:
1341 hci_cs_set_conn_encrypt(hdev, ev->status);
1344 case HCI_OP_REMOTE_NAME_REQ:
1345 hci_cs_remote_name_req(hdev, ev->status);
1348 case HCI_OP_READ_REMOTE_FEATURES:
1349 hci_cs_read_remote_features(hdev, ev->status);
1352 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1353 hci_cs_read_remote_ext_features(hdev, ev->status);
1356 case HCI_OP_SETUP_SYNC_CONN:
1357 hci_cs_setup_sync_conn(hdev, ev->status);
1360 case HCI_OP_SNIFF_MODE:
1361 hci_cs_sniff_mode(hdev, ev->status);
1364 case HCI_OP_EXIT_SNIFF_MODE:
1365 hci_cs_exit_sniff_mode(hdev, ev->status);
1369 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1374 atomic_set(&hdev->cmd_cnt, 1);
1375 if (!skb_queue_empty(&hdev->cmd_q))
1376 hci_sched_cmd(hdev);
1380 static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1382 struct hci_ev_role_change *ev = (void *) skb->data;
1383 struct hci_conn *conn;
1385 BT_DBG("%s status %d", hdev->name, ev->status);
1389 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1393 conn->link_mode &= ~HCI_LM_MASTER;
1395 conn->link_mode |= HCI_LM_MASTER;
1398 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
1400 hci_role_switch_cfm(conn, ev->status, ev->role);
1403 hci_dev_unlock(hdev);
1406 static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
1408 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
1412 skb_pull(skb, sizeof(*ev));
1414 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
1416 if (skb->len < ev->num_hndl * 4) {
1417 BT_DBG("%s bad parameters", hdev->name);
1421 tasklet_disable(&hdev->tx_task);
1423 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
1424 struct hci_conn *conn;
1425 __u16 handle, count;
1427 handle = get_unaligned_le16(ptr++);
1428 count = get_unaligned_le16(ptr++);
1430 conn = hci_conn_hash_lookup_handle(hdev, handle);
1432 conn->sent -= count;
1434 if (conn->type == ACL_LINK) {
1435 if ((hdev->acl_cnt += count) > hdev->acl_pkts)
1436 hdev->acl_cnt = hdev->acl_pkts;
1438 if ((hdev->sco_cnt += count) > hdev->sco_pkts)
1439 hdev->sco_cnt = hdev->sco_pkts;
1446 tasklet_enable(&hdev->tx_task);
1449 static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1451 struct hci_ev_mode_change *ev = (void *) skb->data;
1452 struct hci_conn *conn;
1454 BT_DBG("%s status %d", hdev->name, ev->status);
1458 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1460 conn->mode = ev->mode;
1461 conn->interval = __le16_to_cpu(ev->interval);
1463 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
1464 if (conn->mode == HCI_CM_ACTIVE)
1465 conn->power_save = 1;
1467 conn->power_save = 0;
1471 hci_dev_unlock(hdev);
1474 static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1476 BT_DBG("%s", hdev->name);
1479 static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1481 BT_DBG("%s", hdev->name);
1484 static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
1486 BT_DBG("%s", hdev->name);
1489 static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1491 struct hci_ev_clock_offset *ev = (void *) skb->data;
1492 struct hci_conn *conn;
1494 BT_DBG("%s status %d", hdev->name, ev->status);
1498 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1499 if (conn && !ev->status) {
1500 struct inquiry_entry *ie;
1502 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
1503 ie->data.clock_offset = ev->clock_offset;
1504 ie->timestamp = jiffies;
1508 hci_dev_unlock(hdev);
1511 static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1513 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
1514 struct hci_conn *conn;
1516 BT_DBG("%s status %d", hdev->name, ev->status);
1520 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1521 if (conn && !ev->status)
1522 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
1524 hci_dev_unlock(hdev);
1527 static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
1529 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
1530 struct inquiry_entry *ie;
1532 BT_DBG("%s", hdev->name);
1536 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr))) {
1537 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
1538 ie->timestamp = jiffies;
1541 hci_dev_unlock(hdev);
1544 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
1546 struct inquiry_data data;
1547 int num_rsp = *((__u8 *) skb->data);
1549 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1556 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
1557 struct inquiry_info_with_rssi_and_pscan_mode *info = (void *) (skb->data + 1);
1559 for (; num_rsp; num_rsp--) {
1560 bacpy(&data.bdaddr, &info->bdaddr);
1561 data.pscan_rep_mode = info->pscan_rep_mode;
1562 data.pscan_period_mode = info->pscan_period_mode;
1563 data.pscan_mode = info->pscan_mode;
1564 memcpy(data.dev_class, info->dev_class, 3);
1565 data.clock_offset = info->clock_offset;
1566 data.rssi = info->rssi;
1567 data.ssp_mode = 0x00;
1569 hci_inquiry_cache_update(hdev, &data);
1572 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
1574 for (; num_rsp; num_rsp--) {
1575 bacpy(&data.bdaddr, &info->bdaddr);
1576 data.pscan_rep_mode = info->pscan_rep_mode;
1577 data.pscan_period_mode = info->pscan_period_mode;
1578 data.pscan_mode = 0x00;
1579 memcpy(data.dev_class, info->dev_class, 3);
1580 data.clock_offset = info->clock_offset;
1581 data.rssi = info->rssi;
1582 data.ssp_mode = 0x00;
1584 hci_inquiry_cache_update(hdev, &data);
1588 hci_dev_unlock(hdev);
1591 static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1593 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
1594 struct hci_conn *conn;
1596 BT_DBG("%s", hdev->name);
1600 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1602 if (!ev->status && ev->page == 0x01) {
1603 struct inquiry_entry *ie;
1605 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst)))
1606 ie->data.ssp_mode = (ev->features[0] & 0x01);
1608 conn->ssp_mode = (ev->features[0] & 0x01);
1611 if (conn->state == BT_CONFIG) {
1612 if (!ev->status && hdev->ssp_mode > 0 &&
1613 conn->ssp_mode > 0 && conn->out &&
1614 conn->sec_level != BT_SECURITY_SDP) {
1615 struct hci_cp_auth_requested cp;
1616 cp.handle = ev->handle;
1617 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1620 conn->state = BT_CONNECTED;
1621 hci_proto_connect_cfm(conn, ev->status);
1627 hci_dev_unlock(hdev);
1630 static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1632 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
1633 struct hci_conn *conn;
1635 BT_DBG("%s status %d", hdev->name, ev->status);
1639 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1641 if (ev->link_type == ESCO_LINK)
1644 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1648 conn->type = SCO_LINK;
1651 if (conn->out && ev->status == 0x1c && conn->attempt < 2) {
1652 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
1653 (hdev->esco_type & EDR_ESCO_MASK);
1654 hci_setup_sync(conn, conn->link->handle);
1659 conn->handle = __le16_to_cpu(ev->handle);
1660 conn->state = BT_CONNECTED;
1662 hci_conn_add_sysfs(conn);
1664 conn->state = BT_CLOSED;
1666 hci_proto_connect_cfm(conn, ev->status);
1671 hci_dev_unlock(hdev);
1674 static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
1676 BT_DBG("%s", hdev->name);
1679 static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
1681 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
1682 struct hci_conn *conn;
1684 BT_DBG("%s status %d", hdev->name, ev->status);
1688 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1692 hci_dev_unlock(hdev);
1695 static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1697 struct inquiry_data data;
1698 struct extended_inquiry_info *info = (void *) (skb->data + 1);
1699 int num_rsp = *((__u8 *) skb->data);
1701 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1708 for (; num_rsp; num_rsp--) {
1709 bacpy(&data.bdaddr, &info->bdaddr);
1710 data.pscan_rep_mode = info->pscan_rep_mode;
1711 data.pscan_period_mode = info->pscan_period_mode;
1712 data.pscan_mode = 0x00;
1713 memcpy(data.dev_class, info->dev_class, 3);
1714 data.clock_offset = info->clock_offset;
1715 data.rssi = info->rssi;
1716 data.ssp_mode = 0x01;
1718 hci_inquiry_cache_update(hdev, &data);
1721 hci_dev_unlock(hdev);
1724 static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1726 struct hci_ev_io_capa_request *ev = (void *) skb->data;
1727 struct hci_conn *conn;
1729 BT_DBG("%s", hdev->name);
1733 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1735 hci_conn_hold(conn);
1737 hci_dev_unlock(hdev);
1740 static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1742 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
1743 struct hci_conn *conn;
1745 BT_DBG("%s", hdev->name);
1749 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1753 hci_dev_unlock(hdev);
1756 static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1758 struct hci_ev_remote_host_features *ev = (void *) skb->data;
1759 struct inquiry_entry *ie;
1761 BT_DBG("%s", hdev->name);
1765 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
1766 ie->data.ssp_mode = (ev->features[0] & 0x01);
1768 hci_dev_unlock(hdev);
1771 void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
1773 struct hci_event_hdr *hdr = (void *) skb->data;
1774 __u8 event = hdr->evt;
1776 skb_pull(skb, HCI_EVENT_HDR_SIZE);
1779 case HCI_EV_INQUIRY_COMPLETE:
1780 hci_inquiry_complete_evt(hdev, skb);
1783 case HCI_EV_INQUIRY_RESULT:
1784 hci_inquiry_result_evt(hdev, skb);
1787 case HCI_EV_CONN_COMPLETE:
1788 hci_conn_complete_evt(hdev, skb);
1791 case HCI_EV_CONN_REQUEST:
1792 hci_conn_request_evt(hdev, skb);
1795 case HCI_EV_DISCONN_COMPLETE:
1796 hci_disconn_complete_evt(hdev, skb);
1799 case HCI_EV_AUTH_COMPLETE:
1800 hci_auth_complete_evt(hdev, skb);
1803 case HCI_EV_REMOTE_NAME:
1804 hci_remote_name_evt(hdev, skb);
1807 case HCI_EV_ENCRYPT_CHANGE:
1808 hci_encrypt_change_evt(hdev, skb);
1811 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
1812 hci_change_link_key_complete_evt(hdev, skb);
1815 case HCI_EV_REMOTE_FEATURES:
1816 hci_remote_features_evt(hdev, skb);
1819 case HCI_EV_REMOTE_VERSION:
1820 hci_remote_version_evt(hdev, skb);
1823 case HCI_EV_QOS_SETUP_COMPLETE:
1824 hci_qos_setup_complete_evt(hdev, skb);
1827 case HCI_EV_CMD_COMPLETE:
1828 hci_cmd_complete_evt(hdev, skb);
1831 case HCI_EV_CMD_STATUS:
1832 hci_cmd_status_evt(hdev, skb);
1835 case HCI_EV_ROLE_CHANGE:
1836 hci_role_change_evt(hdev, skb);
1839 case HCI_EV_NUM_COMP_PKTS:
1840 hci_num_comp_pkts_evt(hdev, skb);
1843 case HCI_EV_MODE_CHANGE:
1844 hci_mode_change_evt(hdev, skb);
1847 case HCI_EV_PIN_CODE_REQ:
1848 hci_pin_code_request_evt(hdev, skb);
1851 case HCI_EV_LINK_KEY_REQ:
1852 hci_link_key_request_evt(hdev, skb);
1855 case HCI_EV_LINK_KEY_NOTIFY:
1856 hci_link_key_notify_evt(hdev, skb);
1859 case HCI_EV_CLOCK_OFFSET:
1860 hci_clock_offset_evt(hdev, skb);
1863 case HCI_EV_PKT_TYPE_CHANGE:
1864 hci_pkt_type_change_evt(hdev, skb);
1867 case HCI_EV_PSCAN_REP_MODE:
1868 hci_pscan_rep_mode_evt(hdev, skb);
1871 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
1872 hci_inquiry_result_with_rssi_evt(hdev, skb);
1875 case HCI_EV_REMOTE_EXT_FEATURES:
1876 hci_remote_ext_features_evt(hdev, skb);
1879 case HCI_EV_SYNC_CONN_COMPLETE:
1880 hci_sync_conn_complete_evt(hdev, skb);
1883 case HCI_EV_SYNC_CONN_CHANGED:
1884 hci_sync_conn_changed_evt(hdev, skb);
1887 case HCI_EV_SNIFF_SUBRATE:
1888 hci_sniff_subrate_evt(hdev, skb);
1891 case HCI_EV_EXTENDED_INQUIRY_RESULT:
1892 hci_extended_inquiry_result_evt(hdev, skb);
1895 case HCI_EV_IO_CAPA_REQUEST:
1896 hci_io_capa_request_evt(hdev, skb);
1899 case HCI_EV_SIMPLE_PAIR_COMPLETE:
1900 hci_simple_pair_complete_evt(hdev, skb);
1903 case HCI_EV_REMOTE_HOST_FEATURES:
1904 hci_remote_host_features_evt(hdev, skb);
1908 BT_DBG("%s event 0x%x", hdev->name, event);
1913 hdev->stat.evt_rx++;
1916 /* Generate internal stack event */
1917 void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
1919 struct hci_event_hdr *hdr;
1920 struct hci_ev_stack_internal *ev;
1921 struct sk_buff *skb;
1923 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
1927 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
1928 hdr->evt = HCI_EV_STACK_INTERNAL;
1929 hdr->plen = sizeof(*ev) + dlen;
1931 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
1933 memcpy(ev->data, data, dlen);
1935 bt_cb(skb)->incoming = 1;
1936 __net_timestamp(skb);
1938 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
1939 skb->dev = (void *) hdev;
1940 hci_send_to_sock(hdev, skb);