bluetooth/hci/ng_hci_evnt.c

53  **                     HCI event processing module
81  * Process HCI event packet
85 ng_hci_process_event(ng_hci_unit_p unit, struct mbuf *event)
90 	/* Get event packet header */
91 	NG_HCI_M_PULLUP(event, sizeof(*hdr));
92 	if (event == NULL)
95 	hdr = mtod(event, ng_hci_event_pkt_t *);
98 "%s: %s - got HCI event=%#x, length=%d\n",
99 		__func__, NG_NODE_NAME(unit->node), hdr->event, hdr->length);
101 	/* Get rid of event header and process event */
102 	m_adj(event, sizeof(*hdr));
104 	switch (hdr->event) {
122 		NG_FREE_M(event);
126 		error = inquiry_result(unit, event);
130 		error = con_compl(unit, event);
134 		error = con_req(unit, event);
138 		error = discon_compl(unit, event);
142 		error = encryption_change(unit, event);
146 		error = read_remote_features_compl(unit, event);
150 		error = qos_setup_compl(unit, event);
154 		error = ng_hci_process_command_complete(unit, event);
158 		error = ng_hci_process_command_status(unit, event);
162 		error = hardware_error(unit, event);
166 		error = role_change(unit, event);
170 		error = num_compl_pkts(unit, event);
174 		error = mode_change(unit, event);
178 		error = data_buffer_overflow(unit, event);
182 		error = read_clock_offset_compl(unit, event);
186 		error = qos_violation(unit, event);
190 		error = page_scan_mode_change(unit, event);
194 		error = page_scan_rep_mode_change(unit, event);
198 		NG_FREE_M(event);
367 /* Inquiry result event */
369 inquiry_result(ng_hci_unit_p unit, struct mbuf *event)
376 	NG_HCI_M_PULLUP(event, sizeof(*ep));
377 	if (event == NULL)
380 	ep = mtod(event, ng_hci_inquiry_result_ep *);
381 	m_adj(event, sizeof(*ep));
385 		m_copydata(event, 0, sizeof(bdaddr), (caddr_t) &bdaddr);
386 		m_adj(event, sizeof(bdaddr));
404 		n->page_scan_rep_mode = *mtod(event, u_int8_t *);
405 		m_adj(event, sizeof(u_int8_t));
408 		m_adj(event, sizeof(u_int8_t));
410 		n->page_scan_mode = *mtod(event, u_int8_t *);
411 		m_adj(event, sizeof(u_int8_t));
414 		m_adj(event, NG_HCI_CLASS_SIZE);
417 		m_copydata(event, 0, sizeof(n->clock_offset),
422 	NG_FREE_M(event);
427 /* Connection complete event */
429 con_compl(ng_hci_unit_p unit, struct mbuf *event)
435 	NG_HCI_M_PULLUP(event, sizeof(*ep));
436 	if (event == NULL)
439 	ep = mtod(event, ng_hci_con_compl_ep *);
462 	 *    ignore Connection_Complete event and let timeout deal with it.
548 	NG_FREE_M(event);
553 /* Connection request event */
555 con_req(ng_hci_unit_p unit, struct mbuf *event)
561 	NG_HCI_M_PULLUP(event, sizeof(*ep));
562 	if (event == NULL)
565 	ep = mtod(event, ng_hci_con_req_ep *);
592 	 *	Connection_Request event. This probably will cause connect
633 	NG_FREE_M(event);
638 /* Disconnect complete event */
640 discon_compl(ng_hci_unit_p unit, struct mbuf *event)
647 	NG_HCI_M_PULLUP(event, sizeof(*ep));
648 	if (event == NULL)
651 	ep = mtod(event, ng_hci_discon_compl_ep *);
679 	NG_FREE_M(event);
684 /* Encryption change event */
686 encryption_change(ng_hci_unit_p unit, struct mbuf *event)
692 	NG_HCI_M_PULLUP(event, sizeof(*ep));
693 	if (event == NULL)
696 	ep = mtod(event, ng_hci_encryption_change_ep *);
723 	NG_FREE_M(event);
728 /* Read remote feature complete event */
730 read_remote_features_compl(ng_hci_unit_p unit, struct mbuf *event)
738 	NG_HCI_M_PULLUP(event, sizeof(*ep));
739 	if (event == NULL)
742 	ep = mtod(event, ng_hci_read_remote_features_compl_ep *);
775 	NG_FREE_M(event);
780 /* QoS setup complete event */
782 qos_setup_compl(ng_hci_unit_p unit, struct mbuf *event)
789 	NG_HCI_M_PULLUP(event, sizeof(*ep));
790 	if (event == NULL)
793 	ep = mtod(event, ng_hci_qos_setup_compl_ep *);
817 	NG_FREE_M(event);
822 /* Hardware error event */
824 hardware_error(ng_hci_unit_p unit, struct mbuf *event)
828 		__func__, NG_NODE_NAME(unit->node), *mtod(event, u_int8_t *));
830 	NG_FREE_M(event);
835 /* Role change event */
837 role_change(ng_hci_unit_p unit, struct mbuf *event)
842 	NG_HCI_M_PULLUP(event, sizeof(*ep));
843 	if (event == NULL)
846 	ep = mtod(event, ng_hci_role_change_ep *);
867 	NG_FREE_M(event);
872 /* Number of completed packets event */
874 num_compl_pkts(ng_hci_unit_p unit, struct mbuf *event)
880 	NG_HCI_M_PULLUP(event, sizeof(*ep));
881 	if (event == NULL)
884 	ep = mtod(event, ng_hci_num_compl_pkts_ep *);
885 	m_adj(event, sizeof(*ep));
889 		m_copydata(event, 0, sizeof(h), (caddr_t) &h);
890 		m_adj(event, sizeof(h));
894 		m_copydata(event, 0, sizeof(p), (caddr_t) &p);
895 		m_adj(event, sizeof(p));
922 	NG_FREE_M(event);
930 /* Mode change event */
932 mode_change(ng_hci_unit_p unit, struct mbuf *event)
938 	NG_HCI_M_PULLUP(event, sizeof(*ep));
939 	if (event == NULL)
942 	ep = mtod(event, ng_hci_mode_change_ep *);
966 	NG_FREE_M(event);
971 /* Data buffer overflow event */
973 data_buffer_overflow(ng_hci_unit_p unit, struct mbuf *event)
978 		(*mtod(event, u_int8_t *) == NG_HCI_LINK_ACL)? "ACL" : "SCO");
980 	NG_FREE_M(event);
985 /* Read clock offset complete event */
987 read_clock_offset_compl(ng_hci_unit_p unit, struct mbuf *event)
994 	NG_HCI_M_PULLUP(event, sizeof(*ep));
995 	if (event == NULL)
998 	ep = mtod(event, ng_hci_read_clock_offset_compl_ep *);
1031 	NG_FREE_M(event);
1036 /* QoS violation event */
1038 qos_violation(ng_hci_unit_p unit, struct mbuf *event)
1045 	NG_HCI_M_PULLUP(event, sizeof(*ep));
1046 	if (event == NULL)
1049 	ep = mtod(event, ng_hci_qos_violation_ep *);
1072 	NG_FREE_M(event);
1077 /* Page scan mode change event */
1079 page_scan_mode_change(ng_hci_unit_p unit, struct mbuf *event)
1085 	NG_HCI_M_PULLUP(event, sizeof(*ep));
1086 	if (event == NULL)
1089 	ep = mtod(event, ng_hci_page_scan_mode_change_ep *);
1106 	NG_FREE_M(event);
1111 /* Page scan repetition mode change event */
1113 page_scan_rep_mode_change(ng_hci_unit_p unit, struct mbuf *event)
1119 	NG_HCI_M_PULLUP(event, sizeof(*ep));
1120 	if (event == NULL)
1123 	ep = mtod(event, ng_hci_page_scan_rep_mode_change_ep *);
1140 	NG_FREE_M(event);