xref: /freebsd/sys/netgraph/bluetooth/hci/ng_hci_misc.c (revision 1ede983cc905643549d8cae56a9d0e28fc68375f)
1878ed226SJulian Elischer /*
2878ed226SJulian Elischer  * ng_hci_misc.c
3c398230bSWarner Losh  */
4c398230bSWarner Losh 
5c398230bSWarner Losh /*-
6878ed226SJulian Elischer  * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com>
7878ed226SJulian Elischer  * All rights reserved.
8878ed226SJulian Elischer  *
9878ed226SJulian Elischer  * Redistribution and use in source and binary forms, with or without
10878ed226SJulian Elischer  * modification, are permitted provided that the following conditions
11878ed226SJulian Elischer  * are met:
12878ed226SJulian Elischer  * 1. Redistributions of source code must retain the above copyright
13878ed226SJulian Elischer  *    notice, this list of conditions and the following disclaimer.
14878ed226SJulian Elischer  * 2. Redistributions in binary form must reproduce the above copyright
15878ed226SJulian Elischer  *    notice, this list of conditions and the following disclaimer in the
16878ed226SJulian Elischer  *    documentation and/or other materials provided with the distribution.
17878ed226SJulian Elischer  *
18878ed226SJulian Elischer  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19878ed226SJulian Elischer  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20878ed226SJulian Elischer  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21878ed226SJulian Elischer  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22878ed226SJulian Elischer  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23878ed226SJulian Elischer  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24878ed226SJulian Elischer  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25878ed226SJulian Elischer  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26878ed226SJulian Elischer  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27878ed226SJulian Elischer  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28878ed226SJulian Elischer  * SUCH DAMAGE.
29878ed226SJulian Elischer  *
300986ab12SMaksim Yevmenkin  * $Id: ng_hci_misc.c,v 1.5 2003/09/08 18:57:51 max Exp $
31878ed226SJulian Elischer  * $FreeBSD$
32878ed226SJulian Elischer  */
33878ed226SJulian Elischer 
34878ed226SJulian Elischer #include <sys/param.h>
35878ed226SJulian Elischer #include <sys/systm.h>
36878ed226SJulian Elischer #include <sys/kernel.h>
37878ed226SJulian Elischer #include <sys/malloc.h>
38878ed226SJulian Elischer #include <sys/mbuf.h>
39878ed226SJulian Elischer #include <sys/queue.h>
40878ed226SJulian Elischer #include <netgraph/ng_message.h>
41878ed226SJulian Elischer #include <netgraph/netgraph.h>
42b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_bluetooth.h>
43b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_hci.h>
44b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_var.h>
45b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_cmds.h>
46b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_evnt.h>
47b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_ulpi.h>
48b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_misc.h>
49878ed226SJulian Elischer 
50878ed226SJulian Elischer /******************************************************************************
51878ed226SJulian Elischer  ******************************************************************************
52878ed226SJulian Elischer  **                              Utility routines
53878ed226SJulian Elischer  ******************************************************************************
54878ed226SJulian Elischer  ******************************************************************************/
55878ed226SJulian Elischer 
56878ed226SJulian Elischer /*
57878ed226SJulian Elischer  * Give packet to RAW hook
58878ed226SJulian Elischer  * Assumes input mbuf is read only.
59878ed226SJulian Elischer  */
60878ed226SJulian Elischer 
61878ed226SJulian Elischer void
62878ed226SJulian Elischer ng_hci_mtap(ng_hci_unit_p unit, struct mbuf *m0)
63878ed226SJulian Elischer {
64878ed226SJulian Elischer 	struct mbuf	*m = NULL;
65878ed226SJulian Elischer 	int		 error = 0;
66878ed226SJulian Elischer 
67878ed226SJulian Elischer 	if (unit->raw != NULL && NG_HOOK_IS_VALID(unit->raw)) {
68a163d034SWarner Losh 		m = m_dup(m0, M_DONTWAIT);
69878ed226SJulian Elischer 		if (m != NULL)
70878ed226SJulian Elischer 			NG_SEND_DATA_ONLY(error, unit->raw, m);
71878ed226SJulian Elischer 
72878ed226SJulian Elischer 		if (error != 0)
73878ed226SJulian Elischer 			NG_HCI_INFO(
74878ed226SJulian Elischer "%s: %s - Could not forward packet, error=%d\n",
75878ed226SJulian Elischer 				__func__, NG_NODE_NAME(unit->node), error);
76878ed226SJulian Elischer 	}
77878ed226SJulian Elischer } /* ng_hci_mtap */
78878ed226SJulian Elischer 
79878ed226SJulian Elischer /*
80878ed226SJulian Elischer  * Send notification to the upper layer's
81878ed226SJulian Elischer  */
82878ed226SJulian Elischer 
83878ed226SJulian Elischer void
84878ed226SJulian Elischer ng_hci_node_is_up(node_p node, hook_p hook, void *arg1, int arg2)
85878ed226SJulian Elischer {
86878ed226SJulian Elischer 	ng_hci_unit_p		 unit = NULL;
87878ed226SJulian Elischer 	struct ng_mesg		*msg = NULL;
88878ed226SJulian Elischer 	ng_hci_node_up_ep	*ep = NULL;
89878ed226SJulian Elischer 	int			 error;
90878ed226SJulian Elischer 
91878ed226SJulian Elischer 	if (node == NULL || NG_NODE_NOT_VALID(node) ||
92878ed226SJulian Elischer 	    hook == NULL || NG_HOOK_NOT_VALID(hook))
93878ed226SJulian Elischer 		return;
94878ed226SJulian Elischer 
95878ed226SJulian Elischer 	unit = (ng_hci_unit_p) NG_NODE_PRIVATE(node);
96878ed226SJulian Elischer 	if ((unit->state & NG_HCI_UNIT_READY) != NG_HCI_UNIT_READY)
97878ed226SJulian Elischer 		return;
98878ed226SJulian Elischer 
99878ed226SJulian Elischer 	if (hook != unit->acl && hook != unit->sco)
100878ed226SJulian Elischer 		return;
101878ed226SJulian Elischer 
102878ed226SJulian Elischer 	NG_MKMESSAGE(msg,NGM_HCI_COOKIE,NGM_HCI_NODE_UP,sizeof(*ep),M_NOWAIT);
103878ed226SJulian Elischer 	if (msg != NULL) {
104878ed226SJulian Elischer 		ep = (ng_hci_node_up_ep *)(msg->data);
105878ed226SJulian Elischer 
106878ed226SJulian Elischer 		if (hook == unit->acl) {
107878ed226SJulian Elischer 			NG_HCI_BUFF_ACL_SIZE(unit->buffer, ep->pkt_size);
108878ed226SJulian Elischer 			NG_HCI_BUFF_ACL_TOTAL(unit->buffer, ep->num_pkts);
109878ed226SJulian Elischer 		} else {
110878ed226SJulian Elischer 			NG_HCI_BUFF_SCO_SIZE(unit->buffer, ep->pkt_size);
111878ed226SJulian Elischer 			NG_HCI_BUFF_SCO_TOTAL(unit->buffer, ep->num_pkts);
112878ed226SJulian Elischer 		}
113878ed226SJulian Elischer 
114878ed226SJulian Elischer 		bcopy(&unit->bdaddr, &ep->bdaddr, sizeof(ep->bdaddr));
115878ed226SJulian Elischer 
1164ae439a3SMaksim Yevmenkin 		NG_SEND_MSG_HOOK(error, node, msg, hook, 0);
117878ed226SJulian Elischer 	} else
118878ed226SJulian Elischer 		error = ENOMEM;
119878ed226SJulian Elischer 
120878ed226SJulian Elischer 	if (error != 0)
121878ed226SJulian Elischer 		NG_HCI_INFO(
122878ed226SJulian Elischer "%s: %s - failed to send NODE_UP message to hook \"%s\", error=%d\n",
123878ed226SJulian Elischer 			__func__, NG_NODE_NAME(unit->node),
124878ed226SJulian Elischer 			NG_HOOK_NAME(hook), error);
125878ed226SJulian Elischer } /* ng_hci_node_is_up */
126878ed226SJulian Elischer 
127878ed226SJulian Elischer /*
128878ed226SJulian Elischer  * Clean unit (helper)
129878ed226SJulian Elischer  */
130878ed226SJulian Elischer 
131878ed226SJulian Elischer void
132878ed226SJulian Elischer ng_hci_unit_clean(ng_hci_unit_p unit, int reason)
133878ed226SJulian Elischer {
134878ed226SJulian Elischer 	int	size;
135878ed226SJulian Elischer 
136878ed226SJulian Elischer 	/* Drain command queue */
137878ed226SJulian Elischer 	if (unit->state & NG_HCI_UNIT_COMMAND_PENDING)
138878ed226SJulian Elischer 		ng_hci_command_untimeout(unit);
139878ed226SJulian Elischer 
140878ed226SJulian Elischer 	NG_BT_MBUFQ_DRAIN(&unit->cmdq);
141878ed226SJulian Elischer 	NG_HCI_BUFF_CMD_SET(unit->buffer, 1);
142878ed226SJulian Elischer 
143878ed226SJulian Elischer 	/* Clean up connection list */
144878ed226SJulian Elischer 	while (!LIST_EMPTY(&unit->con_list)) {
145878ed226SJulian Elischer 		ng_hci_unit_con_p	con = LIST_FIRST(&unit->con_list);
146878ed226SJulian Elischer 
1470986ab12SMaksim Yevmenkin 		/* Remove all timeouts (if any) */
1480986ab12SMaksim Yevmenkin 		if (con->flags & NG_HCI_CON_TIMEOUT_PENDING)
1490986ab12SMaksim Yevmenkin 			ng_hci_con_untimeout(con);
1500986ab12SMaksim Yevmenkin 
151878ed226SJulian Elischer 		/*
152878ed226SJulian Elischer 		 * Notify upper layer protocol and destroy connection
153878ed226SJulian Elischer 		 * descriptor. Do not really care about the result.
154878ed226SJulian Elischer 		 */
155878ed226SJulian Elischer 
156878ed226SJulian Elischer 		ng_hci_lp_discon_ind(con, reason);
157878ed226SJulian Elischer 		ng_hci_free_con(con);
158878ed226SJulian Elischer 	}
159878ed226SJulian Elischer 
160878ed226SJulian Elischer 	NG_HCI_BUFF_ACL_TOTAL(unit->buffer, size);
161878ed226SJulian Elischer 	NG_HCI_BUFF_ACL_FREE(unit->buffer, size);
162878ed226SJulian Elischer 
163878ed226SJulian Elischer 	NG_HCI_BUFF_SCO_TOTAL(unit->buffer, size);
164878ed226SJulian Elischer 	NG_HCI_BUFF_SCO_FREE(unit->buffer, size);
165878ed226SJulian Elischer 
166878ed226SJulian Elischer 	/* Clean up neighbors list */
167878ed226SJulian Elischer 	ng_hci_flush_neighbor_cache(unit);
168878ed226SJulian Elischer } /* ng_hci_unit_clean */
169878ed226SJulian Elischer 
170878ed226SJulian Elischer /*
171878ed226SJulian Elischer  * Allocate and link new unit neighbor cache entry
172878ed226SJulian Elischer  */
173878ed226SJulian Elischer 
174878ed226SJulian Elischer ng_hci_neighbor_p
175878ed226SJulian Elischer ng_hci_new_neighbor(ng_hci_unit_p unit)
176878ed226SJulian Elischer {
177878ed226SJulian Elischer 	ng_hci_neighbor_p	n = NULL;
178878ed226SJulian Elischer 
1791ede983cSDag-Erling Smørgrav 	n = malloc(sizeof(*n), M_NETGRAPH_HCI,
180878ed226SJulian Elischer 		M_NOWAIT | M_ZERO);
181878ed226SJulian Elischer 	if (n != NULL) {
182878ed226SJulian Elischer 		getmicrotime(&n->updated);
183878ed226SJulian Elischer 		LIST_INSERT_HEAD(&unit->neighbors, n, next);
184878ed226SJulian Elischer 	}
185878ed226SJulian Elischer 
186878ed226SJulian Elischer 	return (n);
187878ed226SJulian Elischer } /* ng_hci_new_neighbor */
188878ed226SJulian Elischer 
189878ed226SJulian Elischer /*
190878ed226SJulian Elischer  * Free unit neighbor cache entry
191878ed226SJulian Elischer  */
192878ed226SJulian Elischer 
193878ed226SJulian Elischer void
194878ed226SJulian Elischer ng_hci_free_neighbor(ng_hci_neighbor_p n)
195878ed226SJulian Elischer {
196878ed226SJulian Elischer 	LIST_REMOVE(n, next);
197878ed226SJulian Elischer 	bzero(n, sizeof(*n));
1981ede983cSDag-Erling Smørgrav 	free(n, M_NETGRAPH_HCI);
199878ed226SJulian Elischer } /* ng_hci_free_neighbor */
200878ed226SJulian Elischer 
201878ed226SJulian Elischer /*
202878ed226SJulian Elischer  * Flush neighbor cache
203878ed226SJulian Elischer  */
204878ed226SJulian Elischer 
205878ed226SJulian Elischer void
206878ed226SJulian Elischer ng_hci_flush_neighbor_cache(ng_hci_unit_p unit)
207878ed226SJulian Elischer {
208878ed226SJulian Elischer 	while (!LIST_EMPTY(&unit->neighbors))
209878ed226SJulian Elischer 		ng_hci_free_neighbor(LIST_FIRST(&unit->neighbors));
210878ed226SJulian Elischer } /* ng_hci_flush_neighbor_cache */
211878ed226SJulian Elischer 
212878ed226SJulian Elischer /*
213878ed226SJulian Elischer  * Lookup unit in neighbor cache
214878ed226SJulian Elischer  */
215878ed226SJulian Elischer 
216878ed226SJulian Elischer ng_hci_neighbor_p
217878ed226SJulian Elischer ng_hci_get_neighbor(ng_hci_unit_p unit, bdaddr_p bdaddr)
218878ed226SJulian Elischer {
219878ed226SJulian Elischer 	ng_hci_neighbor_p	n = NULL;
220878ed226SJulian Elischer 
221878ed226SJulian Elischer 	for (n = LIST_FIRST(&unit->neighbors); n != NULL; ) {
222878ed226SJulian Elischer 		ng_hci_neighbor_p	nn = LIST_NEXT(n, next);
223878ed226SJulian Elischer 
224878ed226SJulian Elischer 		if (!ng_hci_neighbor_stale(n)) {
225878ed226SJulian Elischer 			if (bcmp(&n->bdaddr, bdaddr, sizeof(*bdaddr)) == 0)
226878ed226SJulian Elischer 				break;
227878ed226SJulian Elischer 		} else
228878ed226SJulian Elischer 			ng_hci_free_neighbor(n); /* remove old entry */
229878ed226SJulian Elischer 
230878ed226SJulian Elischer 		n = nn;
231878ed226SJulian Elischer 	}
232878ed226SJulian Elischer 
233878ed226SJulian Elischer 	return (n);
234878ed226SJulian Elischer } /* ng_hci_get_neighbor */
235878ed226SJulian Elischer 
236878ed226SJulian Elischer /*
237878ed226SJulian Elischer  * Check if neighbor entry is stale
238878ed226SJulian Elischer  */
239878ed226SJulian Elischer 
240878ed226SJulian Elischer int
241878ed226SJulian Elischer ng_hci_neighbor_stale(ng_hci_neighbor_p n)
242878ed226SJulian Elischer {
243878ed226SJulian Elischer 	struct timeval	now;
244878ed226SJulian Elischer 
245878ed226SJulian Elischer 	getmicrotime(&now);
246878ed226SJulian Elischer 
247878ed226SJulian Elischer 	return (now.tv_sec - n->updated.tv_sec > bluetooth_hci_max_neighbor_age());
248878ed226SJulian Elischer } /* ng_hci_neighbor_stale */
249878ed226SJulian Elischer 
250878ed226SJulian Elischer /*
251878ed226SJulian Elischer  * Allocate and link new connection descriptor
252878ed226SJulian Elischer  */
253878ed226SJulian Elischer 
254878ed226SJulian Elischer ng_hci_unit_con_p
255878ed226SJulian Elischer ng_hci_new_con(ng_hci_unit_p unit, int link_type)
256878ed226SJulian Elischer {
257878ed226SJulian Elischer 	ng_hci_unit_con_p	con = NULL;
258878ed226SJulian Elischer 	int			num_pkts;
2590986ab12SMaksim Yevmenkin 	static int		fake_con_handle = 0x0f00;
260878ed226SJulian Elischer 
2611ede983cSDag-Erling Smørgrav 	con = malloc(sizeof(*con), M_NETGRAPH_HCI,
262878ed226SJulian Elischer 		M_NOWAIT | M_ZERO);
263878ed226SJulian Elischer 	if (con != NULL) {
264878ed226SJulian Elischer 		con->unit = unit;
265878ed226SJulian Elischer 		con->state = NG_HCI_CON_CLOSED;
2660986ab12SMaksim Yevmenkin 
2670986ab12SMaksim Yevmenkin 		/*
2680986ab12SMaksim Yevmenkin 		 * XXX
2690986ab12SMaksim Yevmenkin 		 *
2700986ab12SMaksim Yevmenkin 		 * Assign fake connection handle to the connection descriptor.
2710986ab12SMaksim Yevmenkin 		 * Bluetooth specification marks 0x0f00 - 0x0fff connection
2720986ab12SMaksim Yevmenkin 		 * handles as reserved. We need this fake connection handles
2730986ab12SMaksim Yevmenkin 		 * for timeouts. Connection handle will be passed as argument
2740986ab12SMaksim Yevmenkin 		 * to timeout so when timeout happens we can find the right
2750986ab12SMaksim Yevmenkin 		 * connection descriptor. We can not pass pointers, because
2760986ab12SMaksim Yevmenkin 		 * timeouts are external (to Netgraph) events and there might
2770986ab12SMaksim Yevmenkin 		 * be a race when node/hook goes down and timeout event already
2780986ab12SMaksim Yevmenkin 		 * went into node's queue
2790986ab12SMaksim Yevmenkin 		 */
2800986ab12SMaksim Yevmenkin 
2810986ab12SMaksim Yevmenkin 		con->con_handle = fake_con_handle ++;
2820986ab12SMaksim Yevmenkin 		if (fake_con_handle > 0x0fff)
2830986ab12SMaksim Yevmenkin 			fake_con_handle = 0x0f00;
2840986ab12SMaksim Yevmenkin 
285878ed226SJulian Elischer 		con->link_type = link_type;
286878ed226SJulian Elischer 
287878ed226SJulian Elischer 		if (con->link_type == NG_HCI_LINK_ACL)
288878ed226SJulian Elischer 			NG_HCI_BUFF_ACL_TOTAL(unit->buffer, num_pkts);
289878ed226SJulian Elischer 		else
290878ed226SJulian Elischer 			NG_HCI_BUFF_SCO_TOTAL(unit->buffer, num_pkts);
291878ed226SJulian Elischer 
292878ed226SJulian Elischer 		NG_BT_ITEMQ_INIT(&con->conq, num_pkts);
293878ed226SJulian Elischer 
294b81d7730SMaksim Yevmenkin 		ng_callout_init(&con->con_timo);
295878ed226SJulian Elischer 
296878ed226SJulian Elischer 		LIST_INSERT_HEAD(&unit->con_list, con, next);
297878ed226SJulian Elischer 	}
298878ed226SJulian Elischer 
299878ed226SJulian Elischer 	return (con);
300878ed226SJulian Elischer } /* ng_hci_new_con */
301878ed226SJulian Elischer 
302878ed226SJulian Elischer /*
303878ed226SJulian Elischer  * Free connection descriptor
304878ed226SJulian Elischer  */
305878ed226SJulian Elischer 
306878ed226SJulian Elischer void
307878ed226SJulian Elischer ng_hci_free_con(ng_hci_unit_con_p con)
308878ed226SJulian Elischer {
309878ed226SJulian Elischer 	LIST_REMOVE(con, next);
310878ed226SJulian Elischer 
311878ed226SJulian Elischer 	/*
312878ed226SJulian Elischer 	 * If we have pending packets then assume that Host Controller has
313878ed226SJulian Elischer 	 * flushed these packets and we can free them too
314878ed226SJulian Elischer 	 */
315878ed226SJulian Elischer 
316878ed226SJulian Elischer 	if (con->link_type == NG_HCI_LINK_ACL)
317878ed226SJulian Elischer 		NG_HCI_BUFF_ACL_FREE(con->unit->buffer, con->pending);
318878ed226SJulian Elischer 	else
319878ed226SJulian Elischer 		NG_HCI_BUFF_SCO_FREE(con->unit->buffer, con->pending);
320878ed226SJulian Elischer 
321878ed226SJulian Elischer 	NG_BT_ITEMQ_DESTROY(&con->conq);
322878ed226SJulian Elischer 
323878ed226SJulian Elischer 	bzero(con, sizeof(*con));
3241ede983cSDag-Erling Smørgrav 	free(con, M_NETGRAPH_HCI);
325878ed226SJulian Elischer } /* ng_hci_free_con */
326878ed226SJulian Elischer 
327878ed226SJulian Elischer /*
328878ed226SJulian Elischer  * Lookup connection for given unit and connection handle.
329878ed226SJulian Elischer  */
330878ed226SJulian Elischer 
331878ed226SJulian Elischer ng_hci_unit_con_p
332878ed226SJulian Elischer ng_hci_con_by_handle(ng_hci_unit_p unit, int con_handle)
333878ed226SJulian Elischer {
334878ed226SJulian Elischer 	ng_hci_unit_con_p	con = NULL;
335878ed226SJulian Elischer 
336878ed226SJulian Elischer 	LIST_FOREACH(con, &unit->con_list, next)
337878ed226SJulian Elischer 		if (con->con_handle == con_handle)
338878ed226SJulian Elischer 			break;
339878ed226SJulian Elischer 
340878ed226SJulian Elischer 	return (con);
341878ed226SJulian Elischer } /* ng_hci_con_by_handle */
342878ed226SJulian Elischer 
343878ed226SJulian Elischer /*
344878ed226SJulian Elischer  * Lookup connection for given unit, link type and remove unit address
345878ed226SJulian Elischer  */
346878ed226SJulian Elischer 
347878ed226SJulian Elischer ng_hci_unit_con_p
348878ed226SJulian Elischer ng_hci_con_by_bdaddr(ng_hci_unit_p unit, bdaddr_p bdaddr, int link_type)
349878ed226SJulian Elischer {
350878ed226SJulian Elischer 	ng_hci_unit_con_p	con = NULL;
351878ed226SJulian Elischer 
352878ed226SJulian Elischer 	LIST_FOREACH(con, &unit->con_list, next)
353878ed226SJulian Elischer 		if (con->link_type == link_type &&
354878ed226SJulian Elischer 		    bcmp(&con->bdaddr, bdaddr, sizeof(bdaddr_t)) == 0)
355878ed226SJulian Elischer 			break;
356878ed226SJulian Elischer 
357878ed226SJulian Elischer 	return (con);
358878ed226SJulian Elischer } /* ng_hci_con_by_bdaddr */
359878ed226SJulian Elischer 
360878ed226SJulian Elischer /*
361878ed226SJulian Elischer  * Set HCI command timeout
362f9d9e1b4SGleb Smirnoff  * XXX FIXME: check return code from ng_callout
363878ed226SJulian Elischer  */
364878ed226SJulian Elischer 
3650986ab12SMaksim Yevmenkin int
366878ed226SJulian Elischer ng_hci_command_timeout(ng_hci_unit_p unit)
367878ed226SJulian Elischer {
3680986ab12SMaksim Yevmenkin 	if (unit->state & NG_HCI_UNIT_COMMAND_PENDING)
3690986ab12SMaksim Yevmenkin 		panic(
3700986ab12SMaksim Yevmenkin "%s: %s - Duplicated command timeout!\n", __func__, NG_NODE_NAME(unit->node));
3710986ab12SMaksim Yevmenkin 
372878ed226SJulian Elischer 	unit->state |= NG_HCI_UNIT_COMMAND_PENDING;
373f9d9e1b4SGleb Smirnoff 	ng_callout(&unit->cmd_timo, unit->node, NULL,
3740986ab12SMaksim Yevmenkin 				bluetooth_hci_command_timeout(),
3750986ab12SMaksim Yevmenkin 				ng_hci_process_command_timeout, NULL, 0);
3760986ab12SMaksim Yevmenkin 
3770986ab12SMaksim Yevmenkin 	return (0);
378878ed226SJulian Elischer } /* ng_hci_command_timeout */
379878ed226SJulian Elischer 
380878ed226SJulian Elischer /*
381878ed226SJulian Elischer  * Unset HCI command timeout
382878ed226SJulian Elischer  */
383878ed226SJulian Elischer 
3840986ab12SMaksim Yevmenkin int
385878ed226SJulian Elischer ng_hci_command_untimeout(ng_hci_unit_p unit)
386878ed226SJulian Elischer {
3870986ab12SMaksim Yevmenkin 	if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING))
3880986ab12SMaksim Yevmenkin 		panic(
3890986ab12SMaksim Yevmenkin "%s: %s - No command timeout!\n", __func__, NG_NODE_NAME(unit->node));
3900986ab12SMaksim Yevmenkin 
391f9d9e1b4SGleb Smirnoff 	if (ng_uncallout(&unit->cmd_timo, unit->node) == 0)
3920986ab12SMaksim Yevmenkin 		return (ETIMEDOUT);
3930986ab12SMaksim Yevmenkin 
394878ed226SJulian Elischer 	unit->state &= ~NG_HCI_UNIT_COMMAND_PENDING;
3950986ab12SMaksim Yevmenkin 
3960986ab12SMaksim Yevmenkin 	return (0);
397878ed226SJulian Elischer } /* ng_hci_command_untimeout */
398878ed226SJulian Elischer 
399878ed226SJulian Elischer /*
400878ed226SJulian Elischer  * Set HCI connection timeout
401f9d9e1b4SGleb Smirnoff  * XXX FIXME: check return code from ng_callout
402878ed226SJulian Elischer  */
403878ed226SJulian Elischer 
4040986ab12SMaksim Yevmenkin int
405878ed226SJulian Elischer ng_hci_con_timeout(ng_hci_unit_con_p con)
406878ed226SJulian Elischer {
4070986ab12SMaksim Yevmenkin 	if (con->flags & NG_HCI_CON_TIMEOUT_PENDING)
4080986ab12SMaksim Yevmenkin 		panic(
4090986ab12SMaksim Yevmenkin "%s: %s - Duplicated connection timeout!\n",
4100986ab12SMaksim Yevmenkin 			__func__, NG_NODE_NAME(con->unit->node));
4110986ab12SMaksim Yevmenkin 
412878ed226SJulian Elischer 	con->flags |= NG_HCI_CON_TIMEOUT_PENDING;
413f9d9e1b4SGleb Smirnoff 	ng_callout(&con->con_timo, con->unit->node, NULL,
4140986ab12SMaksim Yevmenkin 				bluetooth_hci_connect_timeout(),
4150986ab12SMaksim Yevmenkin 				ng_hci_process_con_timeout, NULL,
4160986ab12SMaksim Yevmenkin 				con->con_handle);
4170986ab12SMaksim Yevmenkin 
4180986ab12SMaksim Yevmenkin 	return (0);
419878ed226SJulian Elischer } /* ng_hci_con_timeout */
420878ed226SJulian Elischer 
421878ed226SJulian Elischer /*
422878ed226SJulian Elischer  * Unset HCI connection timeout
423878ed226SJulian Elischer  */
424878ed226SJulian Elischer 
4250986ab12SMaksim Yevmenkin int
426878ed226SJulian Elischer ng_hci_con_untimeout(ng_hci_unit_con_p con)
427878ed226SJulian Elischer {
4280986ab12SMaksim Yevmenkin 	if (!(con->flags & NG_HCI_CON_TIMEOUT_PENDING))
4290986ab12SMaksim Yevmenkin 		panic(
4300986ab12SMaksim Yevmenkin "%s: %s - No connection timeout!\n", __func__, NG_NODE_NAME(con->unit->node));
4310986ab12SMaksim Yevmenkin 
432f9d9e1b4SGleb Smirnoff 	if (ng_uncallout(&con->con_timo, con->unit->node) == 0)
4330986ab12SMaksim Yevmenkin 		return (ETIMEDOUT);
4340986ab12SMaksim Yevmenkin 
435878ed226SJulian Elischer 	con->flags &= ~NG_HCI_CON_TIMEOUT_PENDING;
4360986ab12SMaksim Yevmenkin 
4370986ab12SMaksim Yevmenkin 	return (0);
438878ed226SJulian Elischer } /* ng_hci_con_untimeout */
439878ed226SJulian Elischer 
440878ed226SJulian Elischer #if 0
441878ed226SJulian Elischer /*
442878ed226SJulian Elischer  * Convert numeric error code/reason to a string
443878ed226SJulian Elischer  */
444878ed226SJulian Elischer 
445878ed226SJulian Elischer char const * const
446878ed226SJulian Elischer ng_hci_str_error(u_int16_t code)
447878ed226SJulian Elischer {
448878ed226SJulian Elischer #define	LAST_ERROR_CODE			((sizeof(s)/sizeof(s[0]))-1)
449878ed226SJulian Elischer 	static char const * const	s[] = {
450878ed226SJulian Elischer 	/* 0x00 */ "No error",
451878ed226SJulian Elischer 	/* 0x01 */ "Unknown HCI command",
452878ed226SJulian Elischer 	/* 0x02 */ "No connection",
453878ed226SJulian Elischer 	/* 0x03 */ "Hardware failure",
454878ed226SJulian Elischer 	/* 0x04 */ "Page timeout",
455878ed226SJulian Elischer 	/* 0x05 */ "Authentication failure",
456878ed226SJulian Elischer 	/* 0x06 */ "Key missing",
457878ed226SJulian Elischer 	/* 0x07 */ "Memory full",
458878ed226SJulian Elischer 	/* 0x08 */ "Connection timeout",
459878ed226SJulian Elischer 	/* 0x09 */ "Max number of connections",
460878ed226SJulian Elischer 	/* 0x0a */ "Max number of SCO connections to a unit",
461878ed226SJulian Elischer 	/* 0x0b */ "ACL connection already exists",
462878ed226SJulian Elischer 	/* 0x0c */ "Command disallowed",
463878ed226SJulian Elischer 	/* 0x0d */ "Host rejected due to limited resources",
464878ed226SJulian Elischer 	/* 0x0e */ "Host rejected due to securiity reasons",
465878ed226SJulian Elischer 	/* 0x0f */ "Host rejected due to remote unit is a personal unit",
466878ed226SJulian Elischer 	/* 0x10 */ "Host timeout",
467878ed226SJulian Elischer 	/* 0x11 */ "Unsupported feature or parameter value",
468878ed226SJulian Elischer 	/* 0x12 */ "Invalid HCI command parameter",
469878ed226SJulian Elischer 	/* 0x13 */ "Other end terminated connection: User ended connection",
470878ed226SJulian Elischer 	/* 0x14 */ "Other end terminated connection: Low resources",
471878ed226SJulian Elischer 	/* 0x15 */ "Other end terminated connection: About to power off",
472878ed226SJulian Elischer 	/* 0x16 */ "Connection terminated by local host",
473878ed226SJulian Elischer 	/* 0x17 */ "Repeated attempts",
474878ed226SJulian Elischer 	/* 0x18 */ "Pairing not allowed",
475878ed226SJulian Elischer 	/* 0x19 */ "Unknown LMP PDU",
476878ed226SJulian Elischer 	/* 0x1a */ "Unsupported remote feature",
477878ed226SJulian Elischer 	/* 0x1b */ "SCO offset rejected",
478878ed226SJulian Elischer 	/* 0x1c */ "SCO interval rejected",
479878ed226SJulian Elischer 	/* 0x1d */ "SCO air mode rejected",
480878ed226SJulian Elischer 	/* 0x1e */ "Invalid LMP parameters",
481878ed226SJulian Elischer 	/* 0x1f */ "Unspecified error",
482878ed226SJulian Elischer 	/* 0x20 */ "Unsupported LMP parameter value",
483878ed226SJulian Elischer 	/* 0x21 */ "Role change not allowed",
484878ed226SJulian Elischer 	/* 0x22 */ "LMP response timeout",
485878ed226SJulian Elischer 	/* 0x23 */ "LMP error transaction collision",
486878ed226SJulian Elischer 	/* 0x24 */ "LMP PSU not allowed",
487878ed226SJulian Elischer 	/* 0x25 */ "Encryption mode not acceptable",
488878ed226SJulian Elischer 	/* 0x26 */ "Unit key used",
489878ed226SJulian Elischer 	/* 0x27 */ "QoS is not supported",
490878ed226SJulian Elischer 	/* 0x28 */ "Instant passed",
491878ed226SJulian Elischer 	/* 0x29 */ "Paring with unit key not supported",
492878ed226SJulian Elischer 	/* SHOULD ALWAYS BE LAST */ "Unknown error"
493878ed226SJulian Elischer 	};
494878ed226SJulian Elischer 
495878ed226SJulian Elischer 	return ((code >= LAST_ERROR_CODE)? s[LAST_ERROR_CODE] : s[code]);
496878ed226SJulian Elischer } /* ng_hci_str_error */
497878ed226SJulian Elischer #endif
498878ed226SJulian Elischer 
499