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/config.h>
28 #include <linux/module.h>
30 #include <linux/types.h>
31 #include <linux/errno.h>
32 #include <linux/kernel.h>
33 #include <linux/major.h>
34 #include <linux/sched.h>
35 #include <linux/slab.h>
36 #include <linux/poll.h>
37 #include <linux/fcntl.h>
38 #include <linux/init.h>
39 #include <linux/skbuff.h>
40 #include <linux/interrupt.h>
41 #include <linux/notifier.h>
44 #include <asm/system.h>
45 #include <asm/uaccess.h>
46 #include <asm/unaligned.h>
48 #include <net/bluetooth/bluetooth.h>
49 #include <net/bluetooth/hci_core.h>
51 #ifndef CONFIG_BT_HCI_CORE_DEBUG
56 /* Handle HCI Event packets */
58 /* Command Complete OGF LINK_CTL */
59 static void hci_cc_link_ctl(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
63 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
66 case OCF_INQUIRY_CANCEL:
67 status = *((__u8 *) skb->data);
70 BT_DBG("%s Inquiry cancel error: status 0x%x", hdev->name, status);
72 clear_bit(HCI_INQUIRY, &hdev->flags);
73 hci_req_complete(hdev, status);
78 BT_DBG("%s Command complete: ogf LINK_CTL ocf %x", hdev->name, ocf);
83 /* Command Complete OGF LINK_POLICY */
84 static void hci_cc_link_policy(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
86 struct hci_conn *conn;
87 struct hci_rp_role_discovery *rd;
89 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
92 case OCF_ROLE_DISCOVERY:
93 rd = (void *) skb->data;
100 conn = hci_conn_hash_lookup_handle(hdev, __le16_to_cpu(rd->handle));
103 conn->link_mode &= ~HCI_LM_MASTER;
105 conn->link_mode |= HCI_LM_MASTER;
108 hci_dev_unlock(hdev);
112 BT_DBG("%s: Command complete: ogf LINK_POLICY ocf %x",
118 /* Command Complete OGF HOST_CTL */
119 static void hci_cc_host_ctl(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
123 struct hci_rp_read_voice_setting *vs;
126 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
130 status = *((__u8 *) skb->data);
131 hci_req_complete(hdev, status);
134 case OCF_SET_EVENT_FLT:
135 status = *((__u8 *) skb->data);
137 BT_DBG("%s SET_EVENT_FLT failed %d", hdev->name, status);
139 BT_DBG("%s SET_EVENT_FLT succeseful", hdev->name);
143 case OCF_WRITE_AUTH_ENABLE:
144 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_AUTH_ENABLE);
148 status = *((__u8 *) skb->data);
149 param = *((__u8 *) sent);
152 if (param == AUTH_ENABLED)
153 set_bit(HCI_AUTH, &hdev->flags);
155 clear_bit(HCI_AUTH, &hdev->flags);
157 hci_req_complete(hdev, status);
160 case OCF_WRITE_ENCRYPT_MODE:
161 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_ENCRYPT_MODE);
165 status = *((__u8 *) skb->data);
166 param = *((__u8 *) sent);
170 set_bit(HCI_ENCRYPT, &hdev->flags);
172 clear_bit(HCI_ENCRYPT, &hdev->flags);
174 hci_req_complete(hdev, status);
177 case OCF_WRITE_CA_TIMEOUT:
178 status = *((__u8 *) skb->data);
180 BT_DBG("%s OCF_WRITE_CA_TIMEOUT failed %d", hdev->name, status);
182 BT_DBG("%s OCF_WRITE_CA_TIMEOUT succeseful", hdev->name);
186 case OCF_WRITE_PG_TIMEOUT:
187 status = *((__u8 *) skb->data);
189 BT_DBG("%s OCF_WRITE_PG_TIMEOUT failed %d", hdev->name, status);
191 BT_DBG("%s: OCF_WRITE_PG_TIMEOUT succeseful", hdev->name);
195 case OCF_WRITE_SCAN_ENABLE:
196 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_SCAN_ENABLE);
200 status = *((__u8 *) skb->data);
201 param = *((__u8 *) sent);
203 BT_DBG("param 0x%x", param);
206 clear_bit(HCI_PSCAN, &hdev->flags);
207 clear_bit(HCI_ISCAN, &hdev->flags);
208 if (param & SCAN_INQUIRY)
209 set_bit(HCI_ISCAN, &hdev->flags);
211 if (param & SCAN_PAGE)
212 set_bit(HCI_PSCAN, &hdev->flags);
214 hci_req_complete(hdev, status);
217 case OCF_READ_VOICE_SETTING:
218 vs = (struct hci_rp_read_voice_setting *) skb->data;
221 BT_DBG("%s READ_VOICE_SETTING failed %d", hdev->name, vs->status);
225 setting = __le16_to_cpu(vs->voice_setting);
227 if (hdev->voice_setting != setting ) {
228 hdev->voice_setting = setting;
230 BT_DBG("%s: voice setting 0x%04x", hdev->name, setting);
233 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
237 case OCF_WRITE_VOICE_SETTING:
238 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_VOICE_SETTING);
242 status = *((__u8 *) skb->data);
243 setting = __le16_to_cpu(get_unaligned((__u16 *) sent));
245 if (!status && hdev->voice_setting != setting) {
246 hdev->voice_setting = setting;
248 BT_DBG("%s: voice setting 0x%04x", hdev->name, setting);
251 hdev->notify(hdev, HCI_NOTIFY_VOICE_SETTING);
253 hci_req_complete(hdev, status);
256 case OCF_HOST_BUFFER_SIZE:
257 status = *((__u8 *) skb->data);
259 BT_DBG("%s OCF_BUFFER_SIZE failed %d", hdev->name, status);
260 hci_req_complete(hdev, status);
265 BT_DBG("%s Command complete: ogf HOST_CTL ocf %x", hdev->name, ocf);
270 /* Command Complete OGF INFO_PARAM */
271 static void hci_cc_info_param(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
273 struct hci_rp_read_loc_features *lf;
274 struct hci_rp_read_buffer_size *bs;
275 struct hci_rp_read_bd_addr *ba;
277 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
280 case OCF_READ_LOCAL_FEATURES:
281 lf = (struct hci_rp_read_loc_features *) skb->data;
284 BT_DBG("%s READ_LOCAL_FEATURES failed %d", hdev->name, lf->status);
288 memcpy(hdev->features, lf->features, sizeof(hdev->features));
290 /* Adjust default settings according to features
291 * supported by device. */
292 if (hdev->features[0] & LMP_3SLOT)
293 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
295 if (hdev->features[0] & LMP_5SLOT)
296 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
298 if (hdev->features[1] & LMP_HV2)
299 hdev->pkt_type |= (HCI_HV2);
301 if (hdev->features[1] & LMP_HV3)
302 hdev->pkt_type |= (HCI_HV3);
304 BT_DBG("%s: features 0x%x 0x%x 0x%x", hdev->name, lf->features[0], lf->features[1], lf->features[2]);
308 case OCF_READ_BUFFER_SIZE:
309 bs = (struct hci_rp_read_buffer_size *) skb->data;
312 BT_DBG("%s READ_BUFFER_SIZE failed %d", hdev->name, bs->status);
313 hci_req_complete(hdev, bs->status);
317 hdev->acl_mtu = __le16_to_cpu(bs->acl_mtu);
318 hdev->sco_mtu = bs->sco_mtu ? bs->sco_mtu : 64;
319 hdev->acl_pkts = hdev->acl_cnt = __le16_to_cpu(bs->acl_max_pkt);
320 hdev->sco_pkts = hdev->sco_cnt = __le16_to_cpu(bs->sco_max_pkt);
322 BT_DBG("%s mtu: acl %d, sco %d max_pkt: acl %d, sco %d", hdev->name,
323 hdev->acl_mtu, hdev->sco_mtu, hdev->acl_pkts, hdev->sco_pkts);
326 case OCF_READ_BD_ADDR:
327 ba = (struct hci_rp_read_bd_addr *) skb->data;
330 bacpy(&hdev->bdaddr, &ba->bdaddr);
332 BT_DBG("%s: READ_BD_ADDR failed %d", hdev->name, ba->status);
335 hci_req_complete(hdev, ba->status);
339 BT_DBG("%s Command complete: ogf INFO_PARAM ocf %x", hdev->name, ocf);
344 /* Command Status OGF LINK_CTL */
345 static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
347 struct hci_conn *conn;
348 struct hci_cp_create_conn *cp = hci_sent_cmd_data(hdev, OGF_LINK_CTL, OCF_CREATE_CONN);
355 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &cp->bdaddr);
357 BT_DBG("%s status 0x%x bdaddr %s conn %p", hdev->name,
358 status, batostr(&cp->bdaddr), conn);
362 conn->state = BT_CLOSED;
363 hci_proto_connect_cfm(conn, status);
368 conn = hci_conn_add(hdev, ACL_LINK, &cp->bdaddr);
371 conn->link_mode |= HCI_LM_MASTER;
373 BT_ERR("No memmory for new connection");
377 hci_dev_unlock(hdev);
380 static void hci_cs_link_ctl(struct hci_dev *hdev, __u16 ocf, __u8 status)
382 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
385 case OCF_CREATE_CONN:
386 hci_cs_create_conn(hdev, status);
391 struct hci_conn *acl, *sco;
392 struct hci_cp_add_sco *cp = hci_sent_cmd_data(hdev, OGF_LINK_CTL, OCF_ADD_SCO);
398 handle = __le16_to_cpu(cp->handle);
400 BT_DBG("%s Add SCO error: handle %d status 0x%x", hdev->name, handle, status);
404 acl = hci_conn_hash_lookup_handle(hdev, handle);
405 if (acl && (sco = acl->link)) {
406 sco->state = BT_CLOSED;
408 hci_proto_connect_cfm(sco, status);
412 hci_dev_unlock(hdev);
418 BT_DBG("%s Inquiry error: status 0x%x", hdev->name, status);
419 hci_req_complete(hdev, status);
421 set_bit(HCI_INQUIRY, &hdev->flags);
426 BT_DBG("%s Command status: ogf LINK_CTL ocf %x status %d",
427 hdev->name, ocf, status);
432 /* Command Status OGF LINK_POLICY */
433 static void hci_cs_link_policy(struct hci_dev *hdev, __u16 ocf, __u8 status)
435 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
439 BT_DBG("%s Command status: ogf HOST_POLICY ocf %x", hdev->name, ocf);
444 /* Command Status OGF HOST_CTL */
445 static void hci_cs_host_ctl(struct hci_dev *hdev, __u16 ocf, __u8 status)
447 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
451 BT_DBG("%s Command status: ogf HOST_CTL ocf %x", hdev->name, ocf);
456 /* Command Status OGF INFO_PARAM */
457 static void hci_cs_info_param(struct hci_dev *hdev, __u16 ocf, __u8 status)
459 BT_DBG("%s: hci_cs_info_param: ocf 0x%x", hdev->name, ocf);
463 BT_DBG("%s Command status: ogf INFO_PARAM ocf %x", hdev->name, ocf);
468 /* Inquiry Complete */
469 static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
471 __u8 status = *((__u8 *) skb->data);
473 BT_DBG("%s status %d", hdev->name, status);
475 clear_bit(HCI_INQUIRY, &hdev->flags);
476 hci_req_complete(hdev, status);
480 static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
482 struct inquiry_info *info = (struct inquiry_info *) (skb->data + 1);
483 int num_rsp = *((__u8 *) skb->data);
485 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
488 for (; num_rsp; num_rsp--)
489 inquiry_cache_update(hdev, info++);
490 hci_dev_unlock(hdev);
493 /* Inquiry Result With RSSI */
494 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
496 struct inquiry_info_with_rssi *info = (struct inquiry_info_with_rssi *) (skb->data + 1);
497 int num_rsp = *((__u8 *) skb->data);
499 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
502 for (; num_rsp; num_rsp--) {
503 struct inquiry_info tmp;
504 bacpy(&tmp.bdaddr, &info->bdaddr);
505 tmp.pscan_rep_mode = info->pscan_rep_mode;
506 tmp.pscan_period_mode = info->pscan_period_mode;
507 tmp.pscan_mode = 0x00;
508 memcpy(tmp.dev_class, &info->dev_class, 3);
509 tmp.clock_offset = info->clock_offset;
511 inquiry_cache_update(hdev, &tmp);
513 hci_dev_unlock(hdev);
516 /* Connect Request */
517 static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
519 struct hci_ev_conn_request *ev = (struct hci_ev_conn_request *) skb->data;
520 int mask = hdev->link_mode;
522 BT_DBG("%s Connection request: %s type 0x%x", hdev->name,
523 batostr(&ev->bdaddr), ev->link_type);
525 mask |= hci_proto_connect_ind(hdev, &ev->bdaddr, ev->link_type);
527 if (mask & HCI_LM_ACCEPT) {
528 /* Connection accepted */
529 struct hci_conn *conn;
530 struct hci_cp_accept_conn_req cp;
533 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
535 if (!(conn = hci_conn_add(hdev, ev->link_type, &ev->bdaddr))) {
536 BT_ERR("No memmory for new connection");
537 hci_dev_unlock(hdev);
541 conn->state = BT_CONNECT;
542 hci_dev_unlock(hdev);
544 bacpy(&cp.bdaddr, &ev->bdaddr);
546 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
547 cp.role = 0x00; /* Become master */
549 cp.role = 0x01; /* Remain slave */
551 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_ACCEPT_CONN_REQ, sizeof(cp), &cp);
553 /* Connection rejected */
554 struct hci_cp_reject_conn_req cp;
556 bacpy(&cp.bdaddr, &ev->bdaddr);
558 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_REJECT_CONN_REQ, sizeof(cp), &cp);
562 /* Connect Complete */
563 static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
565 struct hci_ev_conn_complete *ev = (struct hci_ev_conn_complete *) skb->data;
566 struct hci_conn *conn = NULL;
568 BT_DBG("%s", hdev->name);
572 conn = hci_conn_hash_lookup_ba(hdev, ev->link_type, &ev->bdaddr);
574 hci_dev_unlock(hdev);
579 conn->handle = __le16_to_cpu(ev->handle);
580 conn->state = BT_CONNECTED;
582 if (test_bit(HCI_AUTH, &hdev->flags))
583 conn->link_mode |= HCI_LM_AUTH;
585 if (test_bit(HCI_ENCRYPT, &hdev->flags))
586 conn->link_mode |= HCI_LM_ENCRYPT;
589 /* Set link policy */
590 if (conn->type == ACL_LINK && hdev->link_policy) {
591 struct hci_cp_write_link_policy cp;
592 cp.handle = ev->handle;
593 cp.policy = __cpu_to_le16(hdev->link_policy);
594 hci_send_cmd(hdev, OGF_LINK_POLICY, OCF_WRITE_LINK_POLICY, sizeof(cp), &cp);
597 /* Set packet type for incoming connection */
599 struct hci_cp_change_conn_ptype cp;
600 cp.handle = ev->handle;
601 cp.pkt_type = (conn->type == ACL_LINK) ?
602 __cpu_to_le16(hdev->pkt_type & ACL_PTYPE_MASK):
603 __cpu_to_le16(hdev->pkt_type & SCO_PTYPE_MASK);
605 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_CHANGE_CONN_PTYPE, sizeof(cp), &cp);
608 conn->state = BT_CLOSED;
610 if (conn->type == ACL_LINK) {
611 struct hci_conn *sco = conn->link;
614 hci_add_sco(sco, conn->handle);
616 hci_proto_connect_cfm(sco, ev->status);
622 hci_proto_connect_cfm(conn, ev->status);
626 hci_dev_unlock(hdev);
629 /* Disconnect Complete */
630 static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
632 struct hci_ev_disconn_complete *ev = (struct hci_ev_disconn_complete *) skb->data;
633 struct hci_conn *conn = NULL;
634 __u16 handle = __le16_to_cpu(ev->handle);
636 BT_DBG("%s status %d", hdev->name, ev->status);
643 conn = hci_conn_hash_lookup_handle(hdev, handle);
645 conn->state = BT_CLOSED;
646 hci_proto_disconn_ind(conn, ev->reason);
650 hci_dev_unlock(hdev);
653 /* Number of completed packets */
654 static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
656 struct hci_ev_num_comp_pkts *ev = (struct hci_ev_num_comp_pkts *) skb->data;
660 skb_pull(skb, sizeof(*ev));
662 BT_DBG("%s num_hndl %d", hdev->name, ev->num_hndl);
664 if (skb->len < ev->num_hndl * 4) {
665 BT_DBG("%s bad parameters", hdev->name);
669 tasklet_disable(&hdev->tx_task);
671 for (i = 0, ptr = (__u16 *) skb->data; i < ev->num_hndl; i++) {
672 struct hci_conn *conn;
675 handle = __le16_to_cpu(get_unaligned(ptr++));
676 count = __le16_to_cpu(get_unaligned(ptr++));
678 conn = hci_conn_hash_lookup_handle(hdev, handle);
682 if (conn->type == SCO_LINK) {
683 if ((hdev->sco_cnt += count) > hdev->sco_pkts)
684 hdev->sco_cnt = hdev->sco_pkts;
686 if ((hdev->acl_cnt += count) > hdev->acl_pkts)
687 hdev->acl_cnt = hdev->acl_pkts;
693 tasklet_enable(&hdev->tx_task);
697 static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
699 struct hci_ev_role_change *ev = (struct hci_ev_role_change *) skb->data;
700 struct hci_conn *conn = NULL;
702 BT_DBG("%s status %d", hdev->name, ev->status);
709 conn = hci_conn_hash_lookup_ba(hdev, ACL_LINK, &ev->bdaddr);
712 conn->link_mode &= ~HCI_LM_MASTER;
714 conn->link_mode |= HCI_LM_MASTER;
717 hci_dev_unlock(hdev);
720 /* Authentication Complete */
721 static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
723 struct hci_ev_auth_complete *ev = (struct hci_ev_auth_complete *) skb->data;
724 struct hci_conn *conn = NULL;
725 __u16 handle = __le16_to_cpu(ev->handle);
727 BT_DBG("%s status %d", hdev->name, ev->status);
731 conn = hci_conn_hash_lookup_handle(hdev, handle);
734 conn->link_mode |= HCI_LM_AUTH;
735 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
737 hci_proto_auth_cfm(conn, ev->status);
739 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
741 struct hci_cp_set_conn_encrypt cp;
742 cp.handle = __cpu_to_le16(conn->handle);
744 hci_send_cmd(conn->hdev, OGF_LINK_CTL,
745 OCF_SET_CONN_ENCRYPT,
748 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
749 hci_proto_encrypt_cfm(conn, ev->status);
754 hci_dev_unlock(hdev);
757 /* Encryption Change */
758 static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
760 struct hci_ev_encrypt_change *ev = (struct hci_ev_encrypt_change *) skb->data;
761 struct hci_conn *conn = NULL;
762 __u16 handle = __le16_to_cpu(ev->handle);
764 BT_DBG("%s status %d", hdev->name, ev->status);
768 conn = hci_conn_hash_lookup_handle(hdev, handle);
772 conn->link_mode |= HCI_LM_ENCRYPT;
774 conn->link_mode &= ~HCI_LM_ENCRYPT;
776 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
778 hci_proto_encrypt_cfm(conn, ev->status);
781 hci_dev_unlock(hdev);
784 void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
786 struct hci_event_hdr *hdr = (struct hci_event_hdr *) skb->data;
787 struct hci_ev_cmd_complete *ec;
788 struct hci_ev_cmd_status *cs;
789 u16 opcode, ocf, ogf;
791 skb_pull(skb, HCI_EVENT_HDR_SIZE);
793 BT_DBG("%s evt 0x%x", hdev->name, hdr->evt);
796 case HCI_EV_NUM_COMP_PKTS:
797 hci_num_comp_pkts_evt(hdev, skb);
800 case HCI_EV_INQUIRY_COMPLETE:
801 hci_inquiry_complete_evt(hdev, skb);
804 case HCI_EV_INQUIRY_RESULT:
805 hci_inquiry_result_evt(hdev, skb);
808 case HCI_EV_INQUIRY_RESULT_WITH_RSSI:
809 hci_inquiry_result_with_rssi_evt(hdev, skb);
812 case HCI_EV_CONN_REQUEST:
813 hci_conn_request_evt(hdev, skb);
816 case HCI_EV_CONN_COMPLETE:
817 hci_conn_complete_evt(hdev, skb);
820 case HCI_EV_DISCONN_COMPLETE:
821 hci_disconn_complete_evt(hdev, skb);
824 case HCI_EV_ROLE_CHANGE:
825 hci_role_change_evt(hdev, skb);
828 case HCI_EV_AUTH_COMPLETE:
829 hci_auth_complete_evt(hdev, skb);
832 case HCI_EV_ENCRYPT_CHANGE:
833 hci_encrypt_change_evt(hdev, skb);
836 case HCI_EV_CMD_STATUS:
837 cs = (struct hci_ev_cmd_status *) skb->data;
838 skb_pull(skb, sizeof(cs));
840 opcode = __le16_to_cpu(cs->opcode);
841 ogf = hci_opcode_ogf(opcode);
842 ocf = hci_opcode_ocf(opcode);
846 hci_cs_info_param(hdev, ocf, cs->status);
850 hci_cs_host_ctl(hdev, ocf, cs->status);
854 hci_cs_link_ctl(hdev, ocf, cs->status);
857 case OGF_LINK_POLICY:
858 hci_cs_link_policy(hdev, ocf, cs->status);
862 BT_DBG("%s Command Status OGF %x", hdev->name, ogf);
867 atomic_set(&hdev->cmd_cnt, 1);
868 if (!skb_queue_empty(&hdev->cmd_q))
873 case HCI_EV_CMD_COMPLETE:
874 ec = (struct hci_ev_cmd_complete *) skb->data;
875 skb_pull(skb, sizeof(*ec));
877 opcode = __le16_to_cpu(ec->opcode);
878 ogf = hci_opcode_ogf(opcode);
879 ocf = hci_opcode_ocf(opcode);
883 hci_cc_info_param(hdev, ocf, skb);
887 hci_cc_host_ctl(hdev, ocf, skb);
891 hci_cc_link_ctl(hdev, ocf, skb);
894 case OGF_LINK_POLICY:
895 hci_cc_link_policy(hdev, ocf, skb);
899 BT_DBG("%s Command Completed OGF %x", hdev->name, ogf);
904 atomic_set(&hdev->cmd_cnt, 1);
905 if (!skb_queue_empty(&hdev->cmd_q))
915 /* Generate internal stack event */
916 void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
918 struct hci_event_hdr *hdr;
919 struct hci_ev_stack_internal *ev;
922 skb = bt_skb_alloc(HCI_EVENT_HDR_SIZE + sizeof(*ev) + dlen, GFP_ATOMIC);
926 hdr = (void *) skb_put(skb, HCI_EVENT_HDR_SIZE);
927 hdr->evt = HCI_EV_STACK_INTERNAL;
928 hdr->plen = sizeof(*ev) + dlen;
930 ev = (void *) skb_put(skb, sizeof(*ev) + dlen);
932 memcpy(ev->data, data, dlen);
934 skb->pkt_type = HCI_EVENT_PKT;
935 skb->dev = (void *) hdev;
936 hci_send_to_sock(hdev, skb);
939 EXPORT_SYMBOL(hci_si_event);