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.
28 * $Id: hci_event.c,v 1.4 2002/07/27 18:14:38 maxk Exp $
31 #include <linux/config.h>
32 #include <linux/module.h>
34 #include <linux/types.h>
35 #include <linux/errno.h>
36 #include <linux/kernel.h>
37 #include <linux/major.h>
38 #include <linux/sched.h>
39 #include <linux/slab.h>
40 #include <linux/poll.h>
41 #include <linux/fcntl.h>
42 #include <linux/init.h>
43 #include <linux/skbuff.h>
44 #include <linux/interrupt.h>
45 #include <linux/notifier.h>
48 #include <asm/system.h>
49 #include <asm/uaccess.h>
50 #include <asm/unaligned.h>
52 #include <net/bluetooth/bluetooth.h>
53 #include <net/bluetooth/hci_core.h>
55 #ifndef HCI_CORE_DEBUG
57 #define BT_DBG( A... )
60 /* Handle HCI Event packets */
62 /* Command Complete OGF LINK_CTL */
63 static void hci_cc_link_ctl(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
67 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
70 case OCF_INQUIRY_CANCEL:
71 status = *((__u8 *) skb->data);
74 BT_DBG("%s Inquiry cancel error: status 0x%x", hdev->name, status);
76 clear_bit(HCI_INQUIRY, &hdev->flags);
77 hci_req_complete(hdev, status);
82 BT_DBG("%s Command complete: ogf LINK_CTL ocf %x", hdev->name, ocf);
87 /* Command Complete OGF LINK_POLICY */
88 static void hci_cc_link_policy(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
90 struct hci_conn *conn;
91 role_discovery_rp *rd;
93 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
96 case OCF_ROLE_DISCOVERY:
97 rd = (void *) skb->data;
104 conn = conn_hash_lookup_handle(hdev, __le16_to_cpu(rd->handle));
107 conn->link_mode &= ~HCI_LM_MASTER;
109 conn->link_mode |= HCI_LM_MASTER;
112 hci_dev_unlock(hdev);
116 BT_DBG("%s: Command complete: ogf LINK_POLICY ocf %x",
122 /* Command Complete OGF HOST_CTL */
123 static void hci_cc_host_ctl(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
128 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
132 status = *((__u8 *) skb->data);
133 hci_req_complete(hdev, status);
136 case OCF_SET_EVENT_FLT:
137 status = *((__u8 *) skb->data);
139 BT_DBG("%s SET_EVENT_FLT failed %d", hdev->name, status);
141 BT_DBG("%s SET_EVENT_FLT succeseful", hdev->name);
145 case OCF_WRITE_AUTH_ENABLE:
146 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_AUTH_ENABLE);
150 status = *((__u8 *) skb->data);
151 param = *((__u8 *) sent);
154 if (param == AUTH_ENABLED)
155 set_bit(HCI_AUTH, &hdev->flags);
157 clear_bit(HCI_AUTH, &hdev->flags);
159 hci_req_complete(hdev, status);
162 case OCF_WRITE_ENCRYPT_MODE:
163 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_ENCRYPT_MODE);
167 status = *((__u8 *) skb->data);
168 param = *((__u8 *) sent);
172 set_bit(HCI_ENCRYPT, &hdev->flags);
174 clear_bit(HCI_ENCRYPT, &hdev->flags);
176 hci_req_complete(hdev, status);
179 case OCF_WRITE_CA_TIMEOUT:
180 status = *((__u8 *) skb->data);
182 BT_DBG("%s OCF_WRITE_CA_TIMEOUT failed %d", hdev->name, status);
184 BT_DBG("%s OCF_WRITE_CA_TIMEOUT succeseful", hdev->name);
188 case OCF_WRITE_PG_TIMEOUT:
189 status = *((__u8 *) skb->data);
191 BT_DBG("%s OCF_WRITE_PG_TIMEOUT failed %d", hdev->name, status);
193 BT_DBG("%s: OCF_WRITE_PG_TIMEOUT succeseful", hdev->name);
197 case OCF_WRITE_SCAN_ENABLE:
198 sent = hci_sent_cmd_data(hdev, OGF_HOST_CTL, OCF_WRITE_SCAN_ENABLE);
201 status = *((__u8 *) skb->data);
202 param = *((__u8 *) sent);
204 BT_DBG("param 0x%x", param);
207 clear_bit(HCI_PSCAN, &hdev->flags);
208 clear_bit(HCI_ISCAN, &hdev->flags);
209 if (param & SCAN_INQUIRY)
210 set_bit(HCI_ISCAN, &hdev->flags);
212 if (param & SCAN_PAGE)
213 set_bit(HCI_PSCAN, &hdev->flags);
215 hci_req_complete(hdev, status);
218 case OCF_HOST_BUFFER_SIZE:
219 status = *((__u8 *) skb->data);
221 BT_DBG("%s OCF_BUFFER_SIZE failed %d", hdev->name, status);
222 hci_req_complete(hdev, status);
227 BT_DBG("%s Command complete: ogf HOST_CTL ocf %x", hdev->name, ocf);
232 /* Command Complete OGF INFO_PARAM */
233 static void hci_cc_info_param(struct hci_dev *hdev, __u16 ocf, struct sk_buff *skb)
235 read_local_features_rp *lf;
236 read_buffer_size_rp *bs;
239 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
242 case OCF_READ_LOCAL_FEATURES:
243 lf = (read_local_features_rp *) skb->data;
246 BT_DBG("%s READ_LOCAL_FEATURES failed %d", hdev->name, lf->status);
250 memcpy(hdev->features, lf->features, sizeof(hdev->features));
252 /* Adjust default settings according to features
253 * supported by device. */
254 if (hdev->features[0] & LMP_3SLOT)
255 hdev->pkt_type |= (HCI_DM3 | HCI_DH3);
257 if (hdev->features[0] & LMP_5SLOT)
258 hdev->pkt_type |= (HCI_DM5 | HCI_DH5);
260 if (hdev->features[1] & LMP_HV2)
261 hdev->pkt_type |= (HCI_HV2);
263 if (hdev->features[1] & LMP_HV3)
264 hdev->pkt_type |= (HCI_HV3);
266 BT_DBG("%s: features 0x%x 0x%x 0x%x", hdev->name, lf->features[0], lf->features[1], lf->features[2]);
270 case OCF_READ_BUFFER_SIZE:
271 bs = (read_buffer_size_rp *) skb->data;
274 BT_DBG("%s READ_BUFFER_SIZE failed %d", hdev->name, bs->status);
275 hci_req_complete(hdev, bs->status);
279 hdev->acl_mtu = __le16_to_cpu(bs->acl_mtu);
280 hdev->sco_mtu = bs->sco_mtu ? bs->sco_mtu : 64;
281 hdev->acl_pkts = hdev->acl_cnt = __le16_to_cpu(bs->acl_max_pkt);
282 hdev->sco_pkts = hdev->sco_cnt = __le16_to_cpu(bs->sco_max_pkt);
284 BT_DBG("%s mtu: acl %d, sco %d max_pkt: acl %d, sco %d", hdev->name,
285 hdev->acl_mtu, hdev->sco_mtu, hdev->acl_pkts, hdev->sco_pkts);
288 case OCF_READ_BD_ADDR:
289 ba = (read_bd_addr_rp *) skb->data;
292 bacpy(&hdev->bdaddr, &ba->bdaddr);
294 BT_DBG("%s: READ_BD_ADDR failed %d", hdev->name, ba->status);
297 hci_req_complete(hdev, ba->status);
301 BT_DBG("%s Command complete: ogf INFO_PARAM ocf %x", hdev->name, ocf);
306 /* Command Status OGF LINK_CTL */
307 static inline void hci_cs_create_conn(struct hci_dev *hdev, __u8 status)
309 struct hci_conn *conn;
310 create_conn_cp *cc = hci_sent_cmd_data(hdev, OGF_LINK_CTL, OCF_CREATE_CONN);
317 conn = conn_hash_lookup_ba(hdev, ACL_LINK, &cc->bdaddr);
319 BT_DBG("%s status 0x%x bdaddr %s conn %p", hdev->name,
320 status, batostr(&cc->bdaddr), conn);
323 if (conn && conn->state == BT_CONNECT) {
324 conn->state = BT_CLOSED;
325 hci_proto_connect_cfm(conn, status);
330 conn = hci_conn_add(hdev, ACL_LINK, &cc->bdaddr);
333 conn->link_mode |= HCI_LM_MASTER;
335 BT_ERR("No memmory for new connection");
339 hci_dev_unlock(hdev);
342 static void hci_cs_link_ctl(struct hci_dev *hdev, __u16 ocf, __u8 status)
344 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
347 case OCF_CREATE_CONN:
348 hci_cs_create_conn(hdev, status);
353 struct hci_conn *acl, *sco;
354 add_sco_cp *cp = hci_sent_cmd_data(hdev,
355 OGF_LINK_CTL, OCF_ADD_SCO);
361 handle = __le16_to_cpu(cp->handle);
363 BT_DBG("%s Add SCO error: handle %d status 0x%x", hdev->name, handle, status);
367 acl = conn_hash_lookup_handle(hdev, handle);
368 if (acl && (sco = acl->link)) {
369 sco->state = BT_CLOSED;
370 hci_proto_connect_cfm(sco, status);
374 hci_dev_unlock(hdev);
380 BT_DBG("%s Inquiry error: status 0x%x", hdev->name, status);
381 hci_req_complete(hdev, status);
383 set_bit(HCI_INQUIRY, &hdev->flags);
388 BT_DBG("%s Command status: ogf LINK_CTL ocf %x status %d",
389 hdev->name, ocf, status);
394 /* Command Status OGF LINK_POLICY */
395 static void hci_cs_link_policy(struct hci_dev *hdev, __u16 ocf, __u8 status)
397 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
401 BT_DBG("%s Command status: ogf HOST_POLICY ocf %x", hdev->name, ocf);
406 /* Command Status OGF HOST_CTL */
407 static void hci_cs_host_ctl(struct hci_dev *hdev, __u16 ocf, __u8 status)
409 BT_DBG("%s ocf 0x%x", hdev->name, ocf);
413 BT_DBG("%s Command status: ogf HOST_CTL ocf %x", hdev->name, ocf);
418 /* Command Status OGF INFO_PARAM */
419 static void hci_cs_info_param(struct hci_dev *hdev, __u16 ocf, __u8 status)
421 BT_DBG("%s: hci_cs_info_param: ocf 0x%x", hdev->name, ocf);
425 BT_DBG("%s Command status: ogf INFO_PARAM ocf %x", hdev->name, ocf);
430 /* Inquiry Complete */
431 static inline void hci_inquiry_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
433 __u8 status = *((__u8 *) skb->data);
435 BT_DBG("%s status %d", hdev->name, status);
437 clear_bit(HCI_INQUIRY, &hdev->flags);
438 hci_req_complete(hdev, status);
442 static inline void hci_inquiry_result_evt(struct hci_dev *hdev, struct sk_buff *skb)
444 inquiry_info *info = (inquiry_info *) (skb->data + 1);
445 int num_rsp = *((__u8 *) skb->data);
447 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
450 for (; num_rsp; num_rsp--)
451 inquiry_cache_update(hdev, info++);
452 hci_dev_unlock(hdev);
455 /* Inquiry Result With RSSI */
456 static inline void hci_inquiry_result_with_rssi_evt(struct hci_dev *hdev, struct sk_buff *skb)
458 inquiry_info_with_rssi *info = (inquiry_info_with_rssi *) (skb->data + 1);
459 int num_rsp = *((__u8 *) skb->data);
461 BT_DBG("%s num_rsp %d", hdev->name, num_rsp);
464 for (; num_rsp; num_rsp--) {
466 bacpy(&tmp.bdaddr, &info->bdaddr);
467 tmp.pscan_rep_mode = info->pscan_rep_mode;
468 tmp.pscan_period_mode = info->pscan_period_mode;
469 tmp.pscan_mode = 0x00;
470 memcpy(tmp.dev_class, &info->dev_class, 3);
471 tmp.clock_offset = info->clock_offset;
473 inquiry_cache_update(hdev, &tmp);
475 hci_dev_unlock(hdev);
478 /* Connect Request */
479 static inline void hci_conn_request_evt(struct hci_dev *hdev, struct sk_buff *skb)
481 evt_conn_request *cr = (evt_conn_request *) skb->data;
482 int mask = hdev->link_mode;
484 BT_DBG("%s Connection request: %s type 0x%x", hdev->name,
485 batostr(&cr->bdaddr), cr->link_type);
487 mask |= hci_proto_connect_ind(hdev, &cr->bdaddr, cr->link_type);
489 if (mask & HCI_LM_ACCEPT) {
490 /* Connection accepted */
491 struct hci_conn *conn;
492 accept_conn_req_cp ac;
495 conn = conn_hash_lookup_ba(hdev, cr->link_type, &cr->bdaddr);
497 if (!(conn = hci_conn_add(hdev, cr->link_type, &cr->bdaddr))) {
498 BT_ERR("No memmory for new connection");
499 hci_dev_unlock(hdev);
503 conn->state = BT_CONNECT;
504 hci_dev_unlock(hdev);
506 bacpy(&ac.bdaddr, &cr->bdaddr);
508 if (lmp_rswitch_capable(hdev) && (mask & HCI_LM_MASTER))
509 ac.role = 0x00; /* Become master */
511 ac.role = 0x01; /* Remain slave */
513 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_ACCEPT_CONN_REQ,
514 ACCEPT_CONN_REQ_CP_SIZE, &ac);
516 /* Connection rejected */
517 reject_conn_req_cp rc;
519 bacpy(&rc.bdaddr, &cr->bdaddr);
521 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_REJECT_CONN_REQ,
522 REJECT_CONN_REQ_CP_SIZE, &rc);
526 /* Connect Complete */
527 static inline void hci_conn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
529 evt_conn_complete *cc = (evt_conn_complete *) skb->data;
530 struct hci_conn *conn = NULL;
532 BT_DBG("%s", hdev->name);
536 conn = conn_hash_lookup_ba(hdev, cc->link_type, &cc->bdaddr);
538 hci_dev_unlock(hdev);
543 conn->handle = __le16_to_cpu(cc->handle);
544 conn->state = BT_CONNECTED;
546 if (test_bit(HCI_AUTH, &hdev->flags))
547 conn->link_mode |= HCI_LM_AUTH;
549 if (test_bit(HCI_ENCRYPT, &hdev->flags))
550 conn->link_mode |= HCI_LM_ENCRYPT;
553 /* Set link policy */
554 if (conn->type == ACL_LINK && hdev->link_policy) {
555 write_link_policy_cp lp;
556 lp.handle = cc->handle;
557 lp.policy = __cpu_to_le16(hdev->link_policy);
558 hci_send_cmd(hdev, OGF_LINK_POLICY, OCF_WRITE_LINK_POLICY,
559 WRITE_LINK_POLICY_CP_SIZE, &lp);
562 /* Set packet type for incomming connection */
564 change_conn_ptype_cp cp;
565 cp.handle = cc->handle;
566 cp.pkt_type = (conn->type == ACL_LINK) ?
567 __cpu_to_le16(hdev->pkt_type & ACL_PTYPE_MASK):
568 __cpu_to_le16(hdev->pkt_type & SCO_PTYPE_MASK);
570 hci_send_cmd(hdev, OGF_LINK_CTL, OCF_CHANGE_CONN_PTYPE,
571 CHANGE_CONN_PTYPE_CP_SIZE, &cp);
574 conn->state = BT_CLOSED;
576 if (conn->type == ACL_LINK) {
577 struct hci_conn *sco = conn->link;
580 hci_add_sco(sco, conn->handle);
582 hci_proto_connect_cfm(sco, cc->status);
588 hci_proto_connect_cfm(conn, cc->status);
592 hci_dev_unlock(hdev);
595 /* Disconnect Complete */
596 static inline void hci_disconn_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
598 evt_disconn_complete *dc = (evt_disconn_complete *) skb->data;
599 struct hci_conn *conn = NULL;
600 __u16 handle = __le16_to_cpu(dc->handle);
602 BT_DBG("%s status %d", hdev->name, dc->status);
609 conn = conn_hash_lookup_handle(hdev, handle);
611 conn->state = BT_CLOSED;
612 hci_proto_disconn_ind(conn, dc->reason);
616 hci_dev_unlock(hdev);
619 /* Number of completed packets */
620 static inline void hci_num_comp_pkts_evt(struct hci_dev *hdev, struct sk_buff *skb)
622 evt_num_comp_pkts *nc = (evt_num_comp_pkts *) skb->data;
626 skb_pull(skb, EVT_NUM_COMP_PKTS_SIZE);
628 BT_DBG("%s num_hndl %d", hdev->name, nc->num_hndl);
630 if (skb->len < nc->num_hndl * 4) {
631 BT_DBG("%s bad parameters", hdev->name);
635 tasklet_disable(&hdev->tx_task);
637 for (i = 0, ptr = (__u16 *) skb->data; i < nc->num_hndl; i++) {
638 struct hci_conn *conn;
641 handle = __le16_to_cpu(get_unaligned(ptr++));
642 count = __le16_to_cpu(get_unaligned(ptr++));
644 conn = conn_hash_lookup_handle(hdev, handle);
648 if (conn->type == SCO_LINK) {
649 if ((hdev->sco_cnt += count) > hdev->sco_pkts)
650 hdev->sco_cnt = hdev->sco_pkts;
652 if ((hdev->acl_cnt += count) > hdev->acl_pkts)
653 hdev->acl_cnt = hdev->acl_pkts;
659 tasklet_enable(&hdev->tx_task);
663 static inline void hci_role_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
665 evt_role_change *rc = (evt_role_change *) skb->data;
666 struct hci_conn *conn = NULL;
668 BT_DBG("%s status %d", hdev->name, rc->status);
675 conn = conn_hash_lookup_ba(hdev, ACL_LINK, &rc->bdaddr);
678 conn->link_mode &= ~HCI_LM_MASTER;
680 conn->link_mode |= HCI_LM_MASTER;
683 hci_dev_unlock(hdev);
686 /* Authentication Complete */
687 static inline void hci_auth_complete_evt(struct hci_dev *hdev, struct sk_buff *skb)
689 evt_auth_complete *ac = (evt_auth_complete *) skb->data;
690 struct hci_conn *conn = NULL;
691 __u16 handle = __le16_to_cpu(ac->handle);
693 BT_DBG("%s status %d", hdev->name, ac->status);
697 conn = conn_hash_lookup_handle(hdev, handle);
700 conn->link_mode |= HCI_LM_AUTH;
701 clear_bit(HCI_CONN_AUTH_PEND, &conn->pend);
703 hci_proto_auth_cfm(conn, ac->status);
705 if (test_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend)) {
707 set_conn_encrypt_cp ce;
708 ce.handle = __cpu_to_le16(conn->handle);
710 hci_send_cmd(conn->hdev, OGF_LINK_CTL,
711 OCF_SET_CONN_ENCRYPT,
712 SET_CONN_ENCRYPT_CP_SIZE, &ce);
714 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
715 hci_proto_encrypt_cfm(conn, ac->status);
720 hci_dev_unlock(hdev);
723 /* Encryption Change */
724 static inline void hci_encrypt_change_evt(struct hci_dev *hdev, struct sk_buff *skb)
726 evt_encrypt_change *ec = (evt_encrypt_change *) skb->data;
727 struct hci_conn *conn = NULL;
728 __u16 handle = __le16_to_cpu(ec->handle);
730 BT_DBG("%s status %d", hdev->name, ec->status);
734 conn = conn_hash_lookup_handle(hdev, handle);
738 conn->link_mode |= HCI_LM_ENCRYPT;
740 conn->link_mode &= ~HCI_LM_ENCRYPT;
742 clear_bit(HCI_CONN_ENCRYPT_PEND, &conn->pend);
744 hci_proto_encrypt_cfm(conn, ec->status);
747 hci_dev_unlock(hdev);
750 void hci_event_packet(struct hci_dev *hdev, struct sk_buff *skb)
752 hci_event_hdr *he = (hci_event_hdr *) skb->data;
754 evt_cmd_complete *ec;
755 __u16 opcode, ocf, ogf;
757 skb_pull(skb, HCI_EVENT_HDR_SIZE);
759 BT_DBG("%s evt 0x%x", hdev->name, he->evt);
762 case EVT_NUM_COMP_PKTS:
763 hci_num_comp_pkts_evt(hdev, skb);
766 case EVT_INQUIRY_COMPLETE:
767 hci_inquiry_complete_evt(hdev, skb);
770 case EVT_INQUIRY_RESULT:
771 hci_inquiry_result_evt(hdev, skb);
774 case EVT_INQUIRY_RESULT_WITH_RSSI:
775 hci_inquiry_result_with_rssi_evt(hdev, skb);
778 case EVT_CONN_REQUEST:
779 hci_conn_request_evt(hdev, skb);
782 case EVT_CONN_COMPLETE:
783 hci_conn_complete_evt(hdev, skb);
786 case EVT_DISCONN_COMPLETE:
787 hci_disconn_complete_evt(hdev, skb);
790 case EVT_ROLE_CHANGE:
791 hci_role_change_evt(hdev, skb);
794 case EVT_AUTH_COMPLETE:
795 hci_auth_complete_evt(hdev, skb);
798 case EVT_ENCRYPT_CHANGE:
799 hci_encrypt_change_evt(hdev, skb);
803 cs = (evt_cmd_status *) skb->data;
804 skb_pull(skb, EVT_CMD_STATUS_SIZE);
806 opcode = __le16_to_cpu(cs->opcode);
807 ogf = cmd_opcode_ogf(opcode);
808 ocf = cmd_opcode_ocf(opcode);
812 hci_cs_info_param(hdev, ocf, cs->status);
816 hci_cs_host_ctl(hdev, ocf, cs->status);
820 hci_cs_link_ctl(hdev, ocf, cs->status);
823 case OGF_LINK_POLICY:
824 hci_cs_link_policy(hdev, ocf, cs->status);
828 BT_DBG("%s Command Status OGF %x", hdev->name, ogf);
833 atomic_set(&hdev->cmd_cnt, 1);
834 if (!skb_queue_empty(&hdev->cmd_q))
839 case EVT_CMD_COMPLETE:
840 ec = (evt_cmd_complete *) skb->data;
841 skb_pull(skb, EVT_CMD_COMPLETE_SIZE);
843 opcode = __le16_to_cpu(ec->opcode);
844 ogf = cmd_opcode_ogf(opcode);
845 ocf = cmd_opcode_ocf(opcode);
849 hci_cc_info_param(hdev, ocf, skb);
853 hci_cc_host_ctl(hdev, ocf, skb);
857 hci_cc_link_ctl(hdev, ocf, skb);
860 case OGF_LINK_POLICY:
861 hci_cc_link_policy(hdev, ocf, skb);
865 BT_DBG("%s Command Completed OGF %x", hdev->name, ogf);
870 atomic_set(&hdev->cmd_cnt, 1);
871 if (!skb_queue_empty(&hdev->cmd_q))
881 /* General internal stack event */
882 void hci_si_event(struct hci_dev *hdev, int type, int dlen, void *data)
885 evt_stack_internal *si;
890 size = HCI_EVENT_HDR_SIZE + EVT_STACK_INTERNAL_SIZE + dlen;
891 skb = bluez_skb_alloc(size, GFP_ATOMIC);
895 ptr = skb_put(skb, size);
898 eh->evt = EVT_STACK_INTERNAL;
899 eh->plen = EVT_STACK_INTERNAL_SIZE + dlen;
900 ptr += HCI_EVENT_HDR_SIZE;
904 memcpy(si->data, data, dlen);
906 skb->pkt_type = HCI_EVENT_PKT;
907 skb->dev = (void *) hdev;
908 hci_send_to_sock(hdev, skb);