2 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (C) 2000-2001 Qualcomm Incorporated
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
15 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
20 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
22 SOFTWARE IS DISCLAIMED.
25 /* Bluetooth HCI event handling. */
27 #include <linux/module.h>
29 #include <linux/types.h>
30 #include <linux/errno.h>
31 #include <linux/kernel.h>
32 #include <linux/slab.h>
33 #include <linux/poll.h>
34 #include <linux/fcntl.h>
35 #include <linux/init.h>
36 #include <linux/skbuff.h>
37 #include <linux/interrupt.h>
38 #include <linux/notifier.h>
41 #include <asm/system.h>
42 #include <asm/uaccess.h>
43 #include <asm/unaligned.h>
45 #include <net/bluetooth/bluetooth.h>
46 #include <net/bluetooth/hci_core.h>
48 /* Handle HCI Event packets */
50 static void hci_cc_inquiry_cancel(struct hci_dev *hdev, struct sk_buff *skb)
52 __u8 status = *((__u8 *) skb->data);
54 BT_DBG("%s status 0x%x", hdev->name, status);
59 clear_bit(HCI_INQUIRY, &hdev->flags);
61 hci_req_complete(hdev, status);
63 hci_conn_check_pending(hdev);
66 static void hci_cc_exit_periodic_inq(struct hci_dev *hdev, struct sk_buff *skb)
68 __u8 status = *((__u8 *) skb->data);
70 BT_DBG("%s status 0x%x", hdev->name, status);
75 clear_bit(HCI_INQUIRY, &hdev->flags);
77 hci_conn_check_pending(hdev);
80 static void hci_cc_remote_name_req_cancel(struct hci_dev *hdev, struct sk_buff *skb)
82 BT_DBG("%s", hdev->name);
85 static void hci_cc_role_discovery(struct hci_dev *hdev, struct sk_buff *skb)
87 struct hci_rp_role_discovery *rp = (void *) skb->data;
88 struct hci_conn *conn;
90 BT_DBG("%s status 0x%x", hdev->name, rp->status);
97 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
100 conn->link_mode &= ~HCI_LM_MASTER;
102 conn->link_mode |= HCI_LM_MASTER;
105 hci_dev_unlock(hdev);
108 static void hci_cc_read_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
110 struct hci_rp_read_link_policy *rp = (void *) skb->data;
111 struct hci_conn *conn;
113 BT_DBG("%s status 0x%x", hdev->name, rp->status);
120 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
122 conn->link_policy = __le16_to_cpu(rp->policy);
124 hci_dev_unlock(hdev);
127 static void hci_cc_write_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
129 struct hci_rp_write_link_policy *rp = (void *) skb->data;
130 struct hci_conn *conn;
133 BT_DBG("%s status 0x%x", hdev->name, rp->status);
138 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LINK_POLICY);
144 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rp->handle));
146 conn->link_policy = get_unaligned_le16(sent + 2);
148 hci_dev_unlock(hdev);
151 static void hci_cc_read_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
153 struct hci_rp_read_def_link_policy *rp = (void *) skb->data;
155 BT_DBG("%s status 0x%x", hdev->name, rp->status);
160 hdev->link_policy = __le16_to_cpu(rp->policy);
163 static void hci_cc_write_def_link_policy(struct hci_dev *hdev, struct sk_buff *skb)
165 __u8 status = *((__u8 *) skb->data);
168 BT_DBG("%s status 0x%x", hdev->name, status);
170 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_DEF_LINK_POLICY);
175 hdev->link_policy = get_unaligned_le16(sent);
177 hci_req_complete(hdev, status);
180 static void hci_cc_reset(struct hci_dev *hdev, struct sk_buff *skb)
182 __u8 status = *((__u8 *) skb->data);
184 BT_DBG("%s status 0x%x", hdev->name, status);
186 hci_req_complete(hdev, status);
189 static void hci_cc_write_local_name(struct hci_dev *hdev, struct sk_buff *skb)
191 __u8 status = *((__u8 *) skb->data);
194 BT_DBG("%s status 0x%x", hdev->name, status);
199 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_LOCAL_NAME);
203 memcpy(hdev->dev_name, sent, 248);
206 static void hci_cc_read_local_name(struct hci_dev *hdev, struct sk_buff *skb)
208 struct hci_rp_read_local_name *rp = (void *) skb->data;
210 BT_DBG("%s status 0x%x", hdev->name, rp->status);
215 memcpy(hdev->dev_name, rp->name, 248);
218 static void hci_cc_write_auth_enable(struct hci_dev *hdev, struct sk_buff *skb)
220 __u8 status = *((__u8 *) skb->data);
223 BT_DBG("%s status 0x%x", hdev->name, status);
225 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_AUTH_ENABLE);
230 __u8 param = *((__u8 *) sent);
232 if (param == AUTH_ENABLED)
233 set_bit(HCI_AUTH, &hdev->flags);
235 clear_bit(HCI_AUTH, &hdev->flags);
238 hci_req_complete(hdev, status);
241 static void hci_cc_write_encrypt_mode(struct hci_dev *hdev, struct sk_buff *skb)
243 __u8 status = *((__u8 *) skb->data);
246 BT_DBG("%s status 0x%x", hdev->name, status);
248 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_ENCRYPT_MODE);
253 __u8 param = *((__u8 *) sent);
256 set_bit(HCI_ENCRYPT, &hdev->flags);
258 clear_bit(HCI_ENCRYPT, &hdev->flags);
261 hci_req_complete(hdev, status);
264 static void hci_cc_write_scan_enable(struct hci_dev *hdev, struct sk_buff *skb)
266 __u8 status = *((__u8 *) skb->data);
269 BT_DBG("%s status 0x%x", hdev->name, status);
271 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SCAN_ENABLE);
276 __u8 param = *((__u8 *) sent);
278 clear_bit(HCI_PSCAN, &hdev->flags);
279 clear_bit(HCI_ISCAN, &hdev->flags);
281 if (param & SCAN_INQUIRY)
282 set_bit(HCI_ISCAN, &hdev->flags);
284 if (param & SCAN_PAGE)
285 set_bit(HCI_PSCAN, &hdev->flags);
288 hci_req_complete(hdev, status);
291 static void hci_cc_read_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
293 struct hci_rp_read_class_of_dev *rp = (void *) skb->data;
295 BT_DBG("%s status 0x%x", hdev->name, rp->status);
300 memcpy(hdev->dev_class, rp->dev_class, 3);
302 BT_DBG("%s class 0x%.2x%.2x%.2x", hdev->name,
303 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);
306 static void hci_cc_write_class_of_dev(struct hci_dev *hdev, struct sk_buff *skb)
308 __u8 status = *((__u8 *) skb->data);
311 BT_DBG("%s status 0x%x", hdev->name, status);
316 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_CLASS_OF_DEV);
320 memcpy(hdev->dev_class, sent, 3);
323 static void hci_cc_read_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
325 struct hci_rp_read_voice_setting *rp = (void *) skb->data;
328 BT_DBG("%s status 0x%x", hdev->name, rp->status);
333 setting = __le16_to_cpu(rp->voice_setting);
335 if (hdev->voice_setting == setting)
338 hdev->voice_setting = setting;
340 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
343 tasklet_disable(&hdev->tx_task);
344 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
345 tasklet_enable(&hdev->tx_task);
349 static void hci_cc_write_voice_setting(struct hci_dev *hdev, struct sk_buff *skb)
351 __u8 status = *((__u8 *) skb->data);
355 BT_DBG("%s status 0x%x", hdev->name, status);
360 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_VOICE_SETTING);
364 setting = get_unaligned_le16(sent);
366 if (hdev->voice_setting == setting)
369 hdev->voice_setting = setting;
371 BT_DBG("%s voice setting 0x%04x", hdev->name, setting);
374 tasklet_disable(&hdev->tx_task);
375 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
376 tasklet_enable(&hdev->tx_task);
380 static void hci_cc_host_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
382 __u8 status = *((__u8 *) skb->data);
384 BT_DBG("%s status 0x%x", hdev->name, status);
386 hci_req_complete(hdev, status);
389 static void hci_cc_read_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
391 struct hci_rp_read_ssp_mode *rp = (void *) skb->data;
393 BT_DBG("%s status 0x%x", hdev->name, rp->status);
398 hdev->ssp_mode = rp->mode;
401 static void hci_cc_write_ssp_mode(struct hci_dev *hdev, struct sk_buff *skb)
403 __u8 status = *((__u8 *) skb->data);
406 BT_DBG("%s status 0x%x", hdev->name, status);
411 sent = hci_sent_cmd_data(hdev, HCI_OP_WRITE_SSP_MODE);
415 hdev->ssp_mode = *((__u8 *) sent);
418 static void hci_cc_read_local_version(struct hci_dev *hdev, struct sk_buff *skb)
420 struct hci_rp_read_local_version *rp = (void *) skb->data;
422 BT_DBG("%s status 0x%x", hdev->name, rp->status);
427 hdev->hci_ver = rp->hci_ver;
428 hdev->hci_rev = __le16_to_cpu(rp->hci_rev);
429 hdev->manufacturer = __le16_to_cpu(rp->manufacturer);
431 BT_DBG("%s manufacturer %d hci ver %d:%d", hdev->name,
433 hdev->hci_ver, hdev->hci_rev);
436 static void hci_cc_read_local_commands(struct hci_dev *hdev, struct sk_buff *skb)
438 struct hci_rp_read_local_commands *rp = (void *) skb->data;
440 BT_DBG("%s status 0x%x", hdev->name, rp->status);
445 memcpy(hdev->commands, rp->commands, sizeof(hdev->commands));
448 static void hci_cc_read_local_features(struct hci_dev *hdev, struct sk_buff *skb)
450 struct hci_rp_read_local_features *rp = (void *) skb->data;
452 BT_DBG("%s status 0x%x", hdev->name, rp->status);
457 memcpy(hdev->features, rp->features, 8);
459 /* Adjust default settings according to features
460 * supported by device. */
462 if (hdev->features[0] & LMP_3SLOT)
463 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
465 if (hdev->features[0] & LMP_5SLOT)
466 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
468 if (hdev->features[1] & LMP_HV2) {
469 hdev->pkt_type |= (HCI_HV2);
470 hdev->esco_type |= (ESCO_HV2);
473 if (hdev->features[1] & LMP_HV3) {
474 hdev->pkt_type |= (HCI_HV3);
475 hdev->esco_type |= (ESCO_HV3);
478 if (hdev->features[3] & LMP_ESCO)
479 hdev->esco_type |= (ESCO_EV3);
481 if (hdev->features[4] & LMP_EV4)
482 hdev->esco_type |= (ESCO_EV4);
484 if (hdev->features[4] & LMP_EV5)
485 hdev->esco_type |= (ESCO_EV5);
487 if (hdev->features[5] & LMP_EDR_ESCO_2M)
488 hdev->esco_type |= (ESCO_2EV3);
490 if (hdev->features[5] & LMP_EDR_ESCO_3M)
491 hdev->esco_type |= (ESCO_3EV3);
493 if (hdev->features[5] & LMP_EDR_3S_ESCO)
494 hdev->esco_type |= (ESCO_2EV5 | ESCO_3EV5);
496 BT_DBG("%s features 0x%.2x%.2x%.2x%.2x%.2x%.2x%.2x%.2x", hdev->name,
497 hdev->features[0], hdev->features[1],
498 hdev->features[2], hdev->features[3],
499 hdev->features[4], hdev->features[5],
500 hdev->features[6], hdev->features[7]);
503 static void hci_cc_read_buffer_size(struct hci_dev *hdev, struct sk_buff *skb)
505 struct hci_rp_read_buffer_size *rp = (void *) skb->data;
507 BT_DBG("%s status 0x%x", hdev->name, rp->status);
512 hdev->acl_mtu = __le16_to_cpu(rp->acl_mtu);
513 hdev->sco_mtu = rp->sco_mtu;
514 hdev->acl_pkts = __le16_to_cpu(rp->acl_max_pkt);
515 hdev->sco_pkts = __le16_to_cpu(rp->sco_max_pkt);
517 if (test_bit(HCI_QUIRK_FIXUP_BUFFER_SIZE, &hdev->quirks)) {
522 hdev->acl_cnt = hdev->acl_pkts;
523 hdev->sco_cnt = hdev->sco_pkts;
525 BT_DBG("%s acl mtu %d:%d sco mtu %d:%d", hdev->name,
526 hdev->acl_mtu, hdev->acl_pkts,
527 hdev->sco_mtu, hdev->sco_pkts);
530 static void hci_cc_read_bd_addr(struct hci_dev *hdev, struct sk_buff *skb)
532 struct hci_rp_read_bd_addr *rp = (void *) skb->data;
534 BT_DBG("%s status 0x%x", hdev->name, rp->status);
537 bacpy(&hdev->bdaddr, &rp->bdaddr);
539 hci_req_complete(hdev, rp->status);
542 static inline void hci_cs_inquiry(struct hci_dev *hdev, __u8 status)
544 BT_DBG("%s status 0x%x", hdev->name, status);
547 hci_req_complete(hdev, status);
549 hci_conn_check_pending(hdev);
551 set_bit(HCI_INQUIRY, &hdev->flags);
554 static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
556 struct hci_cp_create_conn *cp;
557 struct hci_conn *conn;
559 BT_DBG("%s status 0x%x", hdev->name, status);
561 cp = hci_sent_cmd_data(hdev, HCI_OP_CREATE_CONN);
567 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
569 BT_DBG("%s bdaddr %s conn %p", hdev->name, batostr(&cp->bdaddr), conn);
572 if (conn && conn->state == BT_CONNECT) {
573 if (status != 0x0c || conn->attempt > 2) {
574 conn->state = BT_CLOSED;
575 hci_proto_connect_cfm(conn, status);
578 conn->state = BT_CONNECT2;
582 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
585 conn->link_mode |= HCI_LM_MASTER;
587 BT_ERR("No memmory for new connection");
591 hci_dev_unlock(hdev);
594 static void hci_cs_add_sco(struct hci_dev *hdev, __u8 status)
596 struct hci_cp_add_sco *cp;
597 struct hci_conn *acl, *sco;
600 BT_DBG("%s status 0x%x", hdev->name, status);
605 cp = hci_sent_cmd_data(hdev, HCI_OP_ADD_SCO);
609 handle = __le16_to_cpu(cp->handle);
611 BT_DBG("%s handle %d", hdev->name, handle);
615 acl = hci_conn_hash_lookup_handle(hdev, handle);
616 if (acl && (sco = acl->link)) {
617 sco->state = BT_CLOSED;
619 hci_proto_connect_cfm(sco, status);
623 hci_dev_unlock(hdev);
626 static void hci_cs_auth_requested(struct hci_dev *hdev, __u8 status)
628 struct hci_cp_auth_requested *cp;
629 struct hci_conn *conn;
631 BT_DBG("%s status 0x%x", hdev->name, status);
636 cp = hci_sent_cmd_data(hdev, HCI_OP_AUTH_REQUESTED);
642 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
644 if (conn->state == BT_CONFIG) {
645 hci_proto_connect_cfm(conn, status);
650 hci_dev_unlock(hdev);
653 static void hci_cs_set_conn_encrypt(struct hci_dev *hdev, __u8 status)
655 struct hci_cp_set_conn_encrypt *cp;
656 struct hci_conn *conn;
658 BT_DBG("%s status 0x%x", hdev->name, status);
663 cp = hci_sent_cmd_data(hdev, HCI_OP_SET_CONN_ENCRYPT);
669 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
671 if (conn->state == BT_CONFIG) {
672 hci_proto_connect_cfm(conn, status);
677 hci_dev_unlock(hdev);
680 static void hci_cs_remote_name_req(struct hci_dev *hdev, __u8 status)
682 BT_DBG("%s status 0x%x", hdev->name, status);
685 static void hci_cs_read_remote_features(struct hci_dev *hdev, __u8 status)
687 struct hci_cp_read_remote_features *cp;
688 struct hci_conn *conn;
690 BT_DBG("%s status 0x%x", hdev->name, status);
695 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_FEATURES);
701 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
703 if (conn->state == BT_CONFIG) {
704 hci_proto_connect_cfm(conn, status);
709 hci_dev_unlock(hdev);
712 static void hci_cs_read_remote_ext_features(struct hci_dev *hdev, __u8 status)
714 struct hci_cp_read_remote_ext_features *cp;
715 struct hci_conn *conn;
717 BT_DBG("%s status 0x%x", hdev->name, status);
722 cp = hci_sent_cmd_data(hdev, HCI_OP_READ_REMOTE_EXT_FEATURES);
728 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
730 if (conn->state == BT_CONFIG) {
731 hci_proto_connect_cfm(conn, status);
736 hci_dev_unlock(hdev);
739 static void hci_cs_setup_sync_conn(struct hci_dev *hdev, __u8 status)
741 struct hci_cp_setup_sync_conn *cp;
742 struct hci_conn *acl, *sco;
745 BT_DBG("%s status 0x%x", hdev->name, status);
750 cp = hci_sent_cmd_data(hdev, HCI_OP_SETUP_SYNC_CONN);
754 handle = __le16_to_cpu(cp->handle);
756 BT_DBG("%s handle %d", hdev->name, handle);
760 acl = hci_conn_hash_lookup_handle(hdev, handle);
761 if (acl && (sco = acl->link)) {
762 sco->state = BT_CLOSED;
764 hci_proto_connect_cfm(sco, status);
768 hci_dev_unlock(hdev);
771 static void hci_cs_sniff_mode(struct hci_dev *hdev, __u8 status)
773 struct hci_cp_sniff_mode *cp;
774 struct hci_conn *conn;
776 BT_DBG("%s status 0x%x", hdev->name, status);
781 cp = hci_sent_cmd_data(hdev, HCI_OP_SNIFF_MODE);
787 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
789 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
791 hci_dev_unlock(hdev);
794 static void hci_cs_exit_sniff_mode(struct hci_dev *hdev, __u8 status)
796 struct hci_cp_exit_sniff_mode *cp;
797 struct hci_conn *conn;
799 BT_DBG("%s status 0x%x", hdev->name, status);
804 cp = hci_sent_cmd_data(hdev, HCI_OP_EXIT_SNIFF_MODE);
810 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(cp->handle));
812 clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend);
814 hci_dev_unlock(hdev);
817 static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
819 __u8 status = *((__u8 *) skb->data);
821 BT_DBG("%s status %d", hdev->name, status);
823 clear_bit(HCI_INQUIRY, &hdev->flags);
825 hci_req_complete(hdev, status);
827 hci_conn_check_pending(hdev);
830 static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
832 struct inquiry_data data;
833 struct inquiry_info *info = (void *) (skb->data + 1);
834 int num_rsp = *((__u8 *) skb->data);
836 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
843 for (; num_rsp; num_rsp--) {
844 bacpy(&data.bdaddr, &info->bdaddr);
845 data.pscan_rep_mode = info->pscan_rep_mode;
846 data.pscan_period_mode = info->pscan_period_mode;
847 data.pscan_mode = info->pscan_mode;
848 memcpy(data.dev_class, info->dev_class, 3);
849 data.clock_offset = info->clock_offset;
851 data.ssp_mode = 0x00;
853 hci_inquiry_cache_update(hdev, &data);
856 hci_dev_unlock(hdev);
859 static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
861 struct hci_ev_conn_complete *ev = (void *) skb->data;
862 struct hci_conn *conn;
864 BT_DBG("%s", hdev->name);
868 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
870 if (ev->link_type != SCO_LINK)
873 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
877 conn->type = SCO_LINK;
881 conn->handle = __le16_to_cpu(ev->handle);
883 if (conn->type == ACL_LINK) {
884 conn->state = BT_CONFIG;
886 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
888 conn->state = BT_CONNECTED;
890 hci_conn_hold_device(conn);
891 hci_conn_add_sysfs(conn);
893 if (test_bit(HCI_AUTH, &hdev->flags))
894 conn->link_mode |= HCI_LM_AUTH;
896 if (test_bit(HCI_ENCRYPT, &hdev->flags))
897 conn->link_mode |= HCI_LM_ENCRYPT;
899 /* Get remote features */
900 if (conn->type == ACL_LINK) {
901 struct hci_cp_read_remote_features cp;
902 cp.handle = ev->handle;
903 hci_send_cmd(hdev, HCI_OP_READ_REMOTE_FEATURES,
907 /* Set packet type for incoming connection */
908 if (!conn->out && hdev->hci_ver < 3) {
909 struct hci_cp_change_conn_ptype cp;
910 cp.handle = ev->handle;
911 cp.pkt_type = cpu_to_le16(conn->pkt_type);
912 hci_send_cmd(hdev, HCI_OP_CHANGE_CONN_PTYPE,
916 conn->state = BT_CLOSED;
918 if (conn->type == ACL_LINK) {
919 struct hci_conn *sco = conn->link;
922 if (lmp_esco_capable(hdev))
923 hci_setup_sync(sco, conn->handle);
925 hci_add_sco(sco, conn->handle);
927 hci_proto_connect_cfm(sco, ev->status);
934 hci_proto_connect_cfm(conn, ev->status);
936 } else if (ev->link_type != ACL_LINK)
937 hci_proto_connect_cfm(conn, ev->status);
940 hci_dev_unlock(hdev);
942 hci_conn_check_pending(hdev);
945 static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
947 struct hci_ev_conn_request *ev = (void *) skb->data;
948 int mask = hdev->link_mode;
950 BT_DBG("%s bdaddr %s type 0x%x", hdev->name,
951 batostr(&ev->bdaddr), ev->link_type);
953 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
955 if (mask & HCI_LM_ACCEPT) {
956 /* Connection accepted */
957 struct inquiry_entry *ie;
958 struct hci_conn *conn;
962 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
963 memcpy(ie->data.dev_class, ev->dev_class, 3);
965 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
967 if (!(conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr))) {
968 BT_ERR("No memmory for new connection");
969 hci_dev_unlock(hdev);
974 memcpy(conn->dev_class, ev->dev_class, 3);
975 conn->state = BT_CONNECT;
977 hci_dev_unlock(hdev);
979 if (ev->link_type == ACL_LINK || !lmp_esco_capable(hdev)) {
980 struct hci_cp_accept_conn_req cp;
982 bacpy(&cp.bdaddr, &ev->bdaddr);
984 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
985 cp.role = 0x00; /* Become master */
987 cp.role = 0x01; /* Remain slave */
989 hci_send_cmd(hdev, HCI_OP_ACCEPT_CONN_REQ,
992 struct hci_cp_accept_sync_conn_req cp;
994 bacpy(&cp.bdaddr, &ev->bdaddr);
995 cp.pkt_type = cpu_to_le16(conn->pkt_type);
997 cp.tx_bandwidth = cpu_to_le32(0x00001f40);
998 cp.rx_bandwidth = cpu_to_le32(0x00001f40);
999 cp.max_latency = cpu_to_le16(0xffff);
1000 cp.content_format = cpu_to_le16(hdev->voice_setting);
1001 cp.retrans_effort = 0xff;
1003 hci_send_cmd(hdev, HCI_OP_ACCEPT_SYNC_CONN_REQ,
1007 /* Connection rejected */
1008 struct hci_cp_reject_conn_req cp;
1010 bacpy(&cp.bdaddr, &ev->bdaddr);
1012 hci_send_cmd(hdev, HCI_OP_REJECT_CONN_REQ, sizeof(cp), &cp);
1016 static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1018 struct hci_ev_disconn_complete *ev = (void *) skb->data;
1019 struct hci_conn *conn;
1021 BT_DBG("%s status %d", hdev->name, ev->status);
1028 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1030 conn->state = BT_CLOSED;
1032 hci_proto_disconn_cfm(conn, ev->reason);
1036 hci_dev_unlock(hdev);
1039 static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1041 struct hci_ev_auth_complete *ev = (void *) skb->data;
1042 struct hci_conn *conn;
1044 BT_DBG("%s status %d", hdev->name, ev->status);
1048 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1051 conn->link_mode |= HCI_LM_AUTH;
1053 conn->sec_level = BT_SECURITY_LOW;
1055 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1057 if (conn->state == BT_CONFIG) {
1058 if (!ev->status && hdev->ssp_mode > 0 &&
1059 conn->ssp_mode > 0) {
1060 struct hci_cp_set_conn_encrypt cp;
1061 cp.handle = ev->handle;
1063 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1066 conn->state = BT_CONNECTED;
1067 hci_proto_connect_cfm(conn, ev->status);
1071 hci_auth_cfm(conn, ev->status);
1073 hci_conn_hold(conn);
1074 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1078 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
1080 struct hci_cp_set_conn_encrypt cp;
1081 cp.handle = ev->handle;
1083 hci_send_cmd(hdev, HCI_OP_SET_CONN_ENCRYPT,
1086 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1087 hci_encrypt_cfm(conn, ev->status, 0x00);
1092 hci_dev_unlock(hdev);
1095 static inline void hci_remote_name_evt(struct hci_dev *hdev, struct sk_buff *skb)
1097 BT_DBG("%s", hdev->name);
1099 hci_conn_check_pending(hdev);
1102 static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1104 struct hci_ev_encrypt_change *ev = (void *) skb->data;
1105 struct hci_conn *conn;
1107 BT_DBG("%s status %d", hdev->name, ev->status);
1111 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1115 /* Encryption implies authentication */
1116 conn->link_mode |= HCI_LM_AUTH;
1117 conn->link_mode |= HCI_LM_ENCRYPT;
1119 conn->link_mode &= ~HCI_LM_ENCRYPT;
1122 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
1124 if (conn->state == BT_CONFIG) {
1126 conn->state = BT_CONNECTED;
1128 hci_proto_connect_cfm(conn, ev->status);
1131 hci_encrypt_cfm(conn, ev->status, ev->encrypt);
1134 hci_dev_unlock(hdev);
1137 static inline void hci_change_link_key_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1139 struct hci_ev_change_link_key_complete *ev = (void *) skb->data;
1140 struct hci_conn *conn;
1142 BT_DBG("%s status %d", hdev->name, ev->status);
1146 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1149 conn->link_mode |= HCI_LM_SECURE;
1151 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
1153 hci_key_change_cfm(conn, ev->status);
1156 hci_dev_unlock(hdev);
1159 static inline void hci_remote_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1161 struct hci_ev_remote_features *ev = (void *) skb->data;
1162 struct hci_conn *conn;
1164 BT_DBG("%s status %d", hdev->name, ev->status);
1168 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1171 memcpy(conn->features, ev->features, 8);
1173 if (conn->state == BT_CONFIG) {
1174 if (!ev->status && lmp_ssp_capable(hdev) &&
1175 lmp_ssp_capable(conn)) {
1176 struct hci_cp_read_remote_ext_features cp;
1177 cp.handle = ev->handle;
1180 HCI_OP_READ_REMOTE_EXT_FEATURES,
1183 conn->state = BT_CONNECTED;
1184 hci_proto_connect_cfm(conn, ev->status);
1190 hci_dev_unlock(hdev);
1193 static inline void hci_remote_version_evt(struct hci_dev *hdev, struct sk_buff *skb)
1195 BT_DBG("%s", hdev->name);
1198 static inline void hci_qos_setup_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1200 BT_DBG("%s", hdev->name);
1203 static inline void hci_cmd_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1205 struct hci_ev_cmd_complete *ev = (void *) skb->data;
1208 skb_pull(skb, sizeof(*ev));
1210 opcode = __le16_to_cpu(ev->opcode);
1213 case HCI_OP_INQUIRY_CANCEL:
1214 hci_cc_inquiry_cancel(hdev, skb);
1217 case HCI_OP_EXIT_PERIODIC_INQ:
1218 hci_cc_exit_periodic_inq(hdev, skb);
1221 case HCI_OP_REMOTE_NAME_REQ_CANCEL:
1222 hci_cc_remote_name_req_cancel(hdev, skb);
1225 case HCI_OP_ROLE_DISCOVERY:
1226 hci_cc_role_discovery(hdev, skb);
1229 case HCI_OP_READ_LINK_POLICY:
1230 hci_cc_read_link_policy(hdev, skb);
1233 case HCI_OP_WRITE_LINK_POLICY:
1234 hci_cc_write_link_policy(hdev, skb);
1237 case HCI_OP_READ_DEF_LINK_POLICY:
1238 hci_cc_read_def_link_policy(hdev, skb);
1241 case HCI_OP_WRITE_DEF_LINK_POLICY:
1242 hci_cc_write_def_link_policy(hdev, skb);
1246 hci_cc_reset(hdev, skb);
1249 case HCI_OP_WRITE_LOCAL_NAME:
1250 hci_cc_write_local_name(hdev, skb);
1253 case HCI_OP_READ_LOCAL_NAME:
1254 hci_cc_read_local_name(hdev, skb);
1257 case HCI_OP_WRITE_AUTH_ENABLE:
1258 hci_cc_write_auth_enable(hdev, skb);
1261 case HCI_OP_WRITE_ENCRYPT_MODE:
1262 hci_cc_write_encrypt_mode(hdev, skb);
1265 case HCI_OP_WRITE_SCAN_ENABLE:
1266 hci_cc_write_scan_enable(hdev, skb);
1269 case HCI_OP_READ_CLASS_OF_DEV:
1270 hci_cc_read_class_of_dev(hdev, skb);
1273 case HCI_OP_WRITE_CLASS_OF_DEV:
1274 hci_cc_write_class_of_dev(hdev, skb);
1277 case HCI_OP_READ_VOICE_SETTING:
1278 hci_cc_read_voice_setting(hdev, skb);
1281 case HCI_OP_WRITE_VOICE_SETTING:
1282 hci_cc_write_voice_setting(hdev, skb);
1285 case HCI_OP_HOST_BUFFER_SIZE:
1286 hci_cc_host_buffer_size(hdev, skb);
1289 case HCI_OP_READ_SSP_MODE:
1290 hci_cc_read_ssp_mode(hdev, skb);
1293 case HCI_OP_WRITE_SSP_MODE:
1294 hci_cc_write_ssp_mode(hdev, skb);
1297 case HCI_OP_READ_LOCAL_VERSION:
1298 hci_cc_read_local_version(hdev, skb);
1301 case HCI_OP_READ_LOCAL_COMMANDS:
1302 hci_cc_read_local_commands(hdev, skb);
1305 case HCI_OP_READ_LOCAL_FEATURES:
1306 hci_cc_read_local_features(hdev, skb);
1309 case HCI_OP_READ_BUFFER_SIZE:
1310 hci_cc_read_buffer_size(hdev, skb);
1313 case HCI_OP_READ_BD_ADDR:
1314 hci_cc_read_bd_addr(hdev, skb);
1318 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1323 atomic_set(&hdev->cmd_cnt, 1);
1324 if (!skb_queue_empty(&hdev->cmd_q))
1325 tasklet_schedule(&hdev->cmd_task);
1329 static inline void hci_cmd_status_evt(struct hci_dev *hdev, struct sk_buff *skb)
1331 struct hci_ev_cmd_status *ev = (void *) skb->data;
1334 skb_pull(skb, sizeof(*ev));
1336 opcode = __le16_to_cpu(ev->opcode);
1339 case HCI_OP_INQUIRY:
1340 hci_cs_inquiry(hdev, ev->status);
1343 case HCI_OP_CREATE_CONN:
1344 hci_cs_create_conn(hdev, ev->status);
1347 case HCI_OP_ADD_SCO:
1348 hci_cs_add_sco(hdev, ev->status);
1351 case HCI_OP_AUTH_REQUESTED:
1352 hci_cs_auth_requested(hdev, ev->status);
1355 case HCI_OP_SET_CONN_ENCRYPT:
1356 hci_cs_set_conn_encrypt(hdev, ev->status);
1359 case HCI_OP_REMOTE_NAME_REQ:
1360 hci_cs_remote_name_req(hdev, ev->status);
1363 case HCI_OP_READ_REMOTE_FEATURES:
1364 hci_cs_read_remote_features(hdev, ev->status);
1367 case HCI_OP_READ_REMOTE_EXT_FEATURES:
1368 hci_cs_read_remote_ext_features(hdev, ev->status);
1371 case HCI_OP_SETUP_SYNC_CONN:
1372 hci_cs_setup_sync_conn(hdev, ev->status);
1375 case HCI_OP_SNIFF_MODE:
1376 hci_cs_sniff_mode(hdev, ev->status);
1379 case HCI_OP_EXIT_SNIFF_MODE:
1380 hci_cs_exit_sniff_mode(hdev, ev->status);
1384 BT_DBG("%s opcode 0x%x", hdev->name, opcode);
1389 atomic_set(&hdev->cmd_cnt, 1);
1390 if (!skb_queue_empty(&hdev->cmd_q))
1391 tasklet_schedule(&hdev->cmd_task);
1395 static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1397 struct hci_ev_role_change *ev = (void *) skb->data;
1398 struct hci_conn *conn;
1400 BT_DBG("%s status %d", hdev->name, ev->status);
1404 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1408 conn->link_mode &= ~HCI_LM_MASTER;
1410 conn->link_mode |= HCI_LM_MASTER;
1413 clear_bit(HCI_CONN_RSWITCH_PEND, &conn->pend);
1415 hci_role_switch_cfm(conn, ev->status, ev->role);
1418 hci_dev_unlock(hdev);
1421 static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
1423 struct hci_ev_num_comp_pkts *ev = (void *) skb->data;
1427 skb_pull(skb, sizeof(*ev));
1429 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
1431 if (skb->len < ev->num_hndl * 4) {
1432 BT_DBG("%s bad parameters", hdev->name);
1436 tasklet_disable(&hdev->tx_task);
1438 for (i = 0, ptr = (__le16 *) skb->data; i < ev->num_hndl; i++) {
1439 struct hci_conn *conn;
1440 __u16 handle, count;
1442 handle = get_unaligned_le16(ptr++);
1443 count = get_unaligned_le16(ptr++);
1445 conn = hci_conn_hash_lookup_handle(hdev, handle);
1447 conn->sent -= count;
1449 if (conn->type == ACL_LINK) {
1450 if ((hdev->acl_cnt += count) > hdev->acl_pkts)
1451 hdev->acl_cnt = hdev->acl_pkts;
1453 if ((hdev->sco_cnt += count) > hdev->sco_pkts)
1454 hdev->sco_cnt = hdev->sco_pkts;
1459 tasklet_schedule(&hdev->tx_task);
1461 tasklet_enable(&hdev->tx_task);
1464 static inline void hci_mode_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1466 struct hci_ev_mode_change *ev = (void *) skb->data;
1467 struct hci_conn *conn;
1469 BT_DBG("%s status %d", hdev->name, ev->status);
1473 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1475 conn->mode = ev->mode;
1476 conn->interval = __le16_to_cpu(ev->interval);
1478 if (!test_and_clear_bit(HCI_CONN_MODE_CHANGE_PEND, &conn->pend)) {
1479 if (conn->mode == HCI_CM_ACTIVE)
1480 conn->power_save = 1;
1482 conn->power_save = 0;
1486 hci_dev_unlock(hdev);
1489 static inline void hci_pin_code_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1491 struct hci_ev_pin_code_req *ev = (void *) skb->data;
1492 struct hci_conn *conn;
1494 BT_DBG("%s", hdev->name);
1498 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1499 if (conn && conn->state == BT_CONNECTED) {
1500 hci_conn_hold(conn);
1501 conn->disc_timeout = HCI_PAIRING_TIMEOUT;
1505 hci_dev_unlock(hdev);
1508 static inline void hci_link_key_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1510 BT_DBG("%s", hdev->name);
1513 static inline void hci_link_key_notify_evt(struct hci_dev *hdev, struct sk_buff *skb)
1515 struct hci_ev_link_key_notify *ev = (void *) skb->data;
1516 struct hci_conn *conn;
1518 BT_DBG("%s", hdev->name);
1522 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1524 hci_conn_hold(conn);
1525 conn->disc_timeout = HCI_DISCONN_TIMEOUT;
1529 hci_dev_unlock(hdev);
1532 static inline void hci_clock_offset_evt(struct hci_dev *hdev, struct sk_buff *skb)
1534 struct hci_ev_clock_offset *ev = (void *) skb->data;
1535 struct hci_conn *conn;
1537 BT_DBG("%s status %d", hdev->name, ev->status);
1541 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1542 if (conn && !ev->status) {
1543 struct inquiry_entry *ie;
1545 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst))) {
1546 ie->data.clock_offset = ev->clock_offset;
1547 ie->timestamp = jiffies;
1551 hci_dev_unlock(hdev);
1554 static inline void hci_pkt_type_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
1556 struct hci_ev_pkt_type_change *ev = (void *) skb->data;
1557 struct hci_conn *conn;
1559 BT_DBG("%s status %d", hdev->name, ev->status);
1563 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1564 if (conn && !ev->status)
1565 conn->pkt_type = __le16_to_cpu(ev->pkt_type);
1567 hci_dev_unlock(hdev);
1570 static inline void hci_pscan_rep_mode_evt(struct hci_dev *hdev, struct sk_buff *skb)
1572 struct hci_ev_pscan_rep_mode *ev = (void *) skb->data;
1573 struct inquiry_entry *ie;
1575 BT_DBG("%s", hdev->name);
1579 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr))) {
1580 ie->data.pscan_rep_mode = ev->pscan_rep_mode;
1581 ie->timestamp = jiffies;
1584 hci_dev_unlock(hdev);
1587 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
1589 struct inquiry_data data;
1590 int num_rsp = *((__u8 *) skb->data);
1592 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1599 if ((skb->len - 1) / num_rsp != sizeof(struct inquiry_info_with_rssi)) {
1600 struct inquiry_info_with_rssi_and_pscan_mode *info = (void *) (skb->data + 1);
1602 for (; num_rsp; num_rsp--) {
1603 bacpy(&data.bdaddr, &info->bdaddr);
1604 data.pscan_rep_mode = info->pscan_rep_mode;
1605 data.pscan_period_mode = info->pscan_period_mode;
1606 data.pscan_mode = info->pscan_mode;
1607 memcpy(data.dev_class, info->dev_class, 3);
1608 data.clock_offset = info->clock_offset;
1609 data.rssi = info->rssi;
1610 data.ssp_mode = 0x00;
1612 hci_inquiry_cache_update(hdev, &data);
1615 struct inquiry_info_with_rssi *info = (void *) (skb->data + 1);
1617 for (; num_rsp; num_rsp--) {
1618 bacpy(&data.bdaddr, &info->bdaddr);
1619 data.pscan_rep_mode = info->pscan_rep_mode;
1620 data.pscan_period_mode = info->pscan_period_mode;
1621 data.pscan_mode = 0x00;
1622 memcpy(data.dev_class, info->dev_class, 3);
1623 data.clock_offset = info->clock_offset;
1624 data.rssi = info->rssi;
1625 data.ssp_mode = 0x00;
1627 hci_inquiry_cache_update(hdev, &data);
1631 hci_dev_unlock(hdev);
1634 static inline void hci_remote_ext_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1636 struct hci_ev_remote_ext_features *ev = (void *) skb->data;
1637 struct hci_conn *conn;
1639 BT_DBG("%s", hdev->name);
1643 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1645 if (!ev->status && ev->page == 0x01) {
1646 struct inquiry_entry *ie;
1648 if ((ie = hci_inquiry_cache_lookup(hdev, &conn->dst)))
1649 ie->data.ssp_mode = (ev->features[0] & 0x01);
1651 conn->ssp_mode = (ev->features[0] & 0x01);
1654 if (conn->state == BT_CONFIG) {
1655 if (!ev->status && hdev->ssp_mode > 0 &&
1656 conn->ssp_mode > 0 && conn->out &&
1657 conn->sec_level != BT_SECURITY_SDP) {
1658 struct hci_cp_auth_requested cp;
1659 cp.handle = ev->handle;
1660 hci_send_cmd(hdev, HCI_OP_AUTH_REQUESTED,
1663 conn->state = BT_CONNECTED;
1664 hci_proto_connect_cfm(conn, ev->status);
1670 hci_dev_unlock(hdev);
1673 static inline void hci_sync_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1675 struct hci_ev_sync_conn_complete *ev = (void *) skb->data;
1676 struct hci_conn *conn;
1678 BT_DBG("%s status %d", hdev->name, ev->status);
1682 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
1684 if (ev->link_type == ESCO_LINK)
1687 conn = hci_conn_hash_lookup_ba(hdev, ESCO_LINK, &ev->bdaddr);
1691 conn->type = SCO_LINK;
1694 switch (ev->status) {
1696 conn->handle = __le16_to_cpu(ev->handle);
1697 conn->state = BT_CONNECTED;
1699 hci_conn_hold_device(conn);
1700 hci_conn_add_sysfs(conn);
1703 case 0x11: /* Unsupported Feature or Parameter Value */
1704 case 0x1c: /* SCO interval rejected */
1705 case 0x1a: /* Unsupported Remote Feature */
1706 case 0x1f: /* Unspecified error */
1707 if (conn->out && conn->attempt < 2) {
1708 conn->pkt_type = (hdev->esco_type & SCO_ESCO_MASK) |
1709 (hdev->esco_type & EDR_ESCO_MASK);
1710 hci_setup_sync(conn, conn->link->handle);
1716 conn->state = BT_CLOSED;
1720 hci_proto_connect_cfm(conn, ev->status);
1725 hci_dev_unlock(hdev);
1728 static inline void hci_sync_conn_changed_evt(struct hci_dev *hdev, struct sk_buff *skb)
1730 BT_DBG("%s", hdev->name);
1733 static inline void hci_sniff_subrate_evt(struct hci_dev *hdev, struct sk_buff *skb)
1735 struct hci_ev_sniff_subrate *ev = (void *) skb->data;
1736 struct hci_conn *conn;
1738 BT_DBG("%s status %d", hdev->name, ev->status);
1742 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(ev->handle));
1746 hci_dev_unlock(hdev);
1749 static inline void hci_extended_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
1751 struct inquiry_data data;
1752 struct extended_inquiry_info *info = (void *) (skb->data + 1);
1753 int num_rsp = *((__u8 *) skb->data);
1755 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
1762 for (; num_rsp; num_rsp--) {
1763 bacpy(&data.bdaddr, &info->bdaddr);
1764 data.pscan_rep_mode = info->pscan_rep_mode;
1765 data.pscan_period_mode = info->pscan_period_mode;
1766 data.pscan_mode = 0x00;
1767 memcpy(data.dev_class, info->dev_class, 3);
1768 data.clock_offset = info->clock_offset;
1769 data.rssi = info->rssi;
1770 data.ssp_mode = 0x01;
1772 hci_inquiry_cache_update(hdev, &data);
1775 hci_dev_unlock(hdev);
1778 static inline void hci_io_capa_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
1780 struct hci_ev_io_capa_request *ev = (void *) skb->data;
1781 struct hci_conn *conn;
1783 BT_DBG("%s", hdev->name);
1787 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1789 hci_conn_hold(conn);
1791 hci_dev_unlock(hdev);
1794 static inline void hci_simple_pair_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
1796 struct hci_ev_simple_pair_complete *ev = (void *) skb->data;
1797 struct hci_conn *conn;
1799 BT_DBG("%s", hdev->name);
1803 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
1807 hci_dev_unlock(hdev);
1810 static inline void hci_remote_host_features_evt(struct hci_dev *hdev, struct sk_buff *skb)
1812 struct hci_ev_remote_host_features *ev = (void *) skb->data;
1813 struct inquiry_entry *ie;
1815 BT_DBG("%s", hdev->name);
1819 if ((ie = hci_inquiry_cache_lookup(hdev, &ev->bdaddr)))
1820 ie->data.ssp_mode = (ev->features[0] & 0x01);
1822 hci_dev_unlock(hdev);
1825 void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
1827 struct hci_event_hdr *hdr = (void *) skb->data;
1828 __u8 event = hdr->evt;
1830 skb_pull(skb, HCI_EVENT_HDR_SIZE);
1833 case HCI_EV_INQUIRY_COMPLETE:
1834 hci_inquiry_complete_evt(hdev, skb);
1837 case HCI_EV_INQUIRY_RESULT:
1838 hci_inquiry_result_evt(hdev, skb);
1841 case HCI_EV_CONN_COMPLETE:
1842 hci_conn_complete_evt(hdev, skb);
1845 case HCI_EV_CONN_REQUEST:
1846 hci_conn_request_evt(hdev, skb);
1849 case HCI_EV_DISCONN_COMPLETE:
1850 hci_disconn_complete_evt(hdev, skb);
1853 case HCI_EV_AUTH_COMPLETE:
1854 hci_auth_complete_evt(hdev, skb);
1857 case HCI_EV_REMOTE_NAME:
1858 hci_remote_name_evt(hdev, skb);
1861 case HCI_EV_ENCRYPT_CHANGE:
1862 hci_encrypt_change_evt(hdev, skb);
1865 case HCI_EV_CHANGE_LINK_KEY_COMPLETE:
1866 hci_change_link_key_complete_evt(hdev, skb);
1869 case HCI_EV_REMOTE_FEATURES:
1870 hci_remote_features_evt(hdev, skb);
1873 case HCI_EV_REMOTE_VERSION:
1874 hci_remote_version_evt(hdev, skb);
1877 case HCI_EV_QOS_SETUP_COMPLETE:
1878 hci_qos_setup_complete_evt(hdev, skb);
1881 case HCI_EV_CMD_COMPLETE:
1882 hci_cmd_complete_evt(hdev, skb);
1885 case HCI_EV_CMD_STATUS:
1886 hci_cmd_status_evt(hdev, skb);
1889 case HCI_EV_ROLE_CHANGE:
1890 hci_role_change_evt(hdev, skb);
1893 case HCI_EV_NUM_COMP_PKTS:
1894 hci_num_comp_pkts_evt(hdev, skb);
1897 case HCI_EV_MODE_CHANGE:
1898 hci_mode_change_evt(hdev, skb);
1901 case HCI_EV_PIN_CODE_REQ:
1902 hci_pin_code_request_evt(hdev, skb);
1905 case HCI_EV_LINK_KEY_REQ:
1906 hci_link_key_request_evt(hdev, skb);
1909 case HCI_EV_LINK_KEY_NOTIFY:
1910 hci_link_key_notify_evt(hdev, skb);
1913 case HCI_EV_CLOCK_OFFSET:
1914 hci_clock_offset_evt(hdev, skb);
1917 case HCI_EV_PKT_TYPE_CHANGE:
1918 hci_pkt_type_change_evt(hdev, skb);
1921 case HCI_EV_PSCAN_REP_MODE:
1922 hci_pscan_rep_mode_evt(hdev, skb);
1925 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
1926 hci_inquiry_result_with_rssi_evt(hdev, skb);
1929 case HCI_EV_REMOTE_EXT_FEATURES:
1930 hci_remote_ext_features_evt(hdev, skb);
1933 case HCI_EV_SYNC_CONN_COMPLETE:
1934 hci_sync_conn_complete_evt(hdev, skb);
1937 case HCI_EV_SYNC_CONN_CHANGED:
1938 hci_sync_conn_changed_evt(hdev, skb);
1941 case HCI_EV_SNIFF_SUBRATE:
1942 hci_sniff_subrate_evt(hdev, skb);
1945 case HCI_EV_EXTENDED_INQUIRY_RESULT:
1946 hci_extended_inquiry_result_evt(hdev, skb);
1949 case HCI_EV_IO_CAPA_REQUEST:
1950 hci_io_capa_request_evt(hdev, skb);
1953 case HCI_EV_SIMPLE_PAIR_COMPLETE:
1954 hci_simple_pair_complete_evt(hdev, skb);
1957 case HCI_EV_REMOTE_HOST_FEATURES:
1958 hci_remote_host_features_evt(hdev, skb);
1962 BT_DBG("%s event 0x%x", hdev->name, event);
1967 hdev->stat.evt_rx++;
1970 /* Generate internal stack event */
1971 void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
1973 struct hci_event_hdr *hdr;
1974 struct hci_ev_stack_internal *ev;
1975 struct sk_buff *skb;
1977 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
1981 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
1982 hdr->evt = HCI_EV_STACK_INTERNAL;
1983 hdr->plen = sizeof(*ev) + dlen;
1985 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
1987 memcpy(ev->data, data, dlen);
1989 bt_cb(skb)->incoming = 1;
1990 __net_timestamp(skb);
1992 bt_cb(skb)->pkt_type = HCI_EVENT_PKT;
1993 skb->dev = (void *) hdev;
1994 hci_send_to_sock(hdev, skb);