xref: /freebsd/sys/netgraph/bluetooth/hci/ng_hci_cmds.c (revision 1e413cf93298b5b97441a21d9a50fdcd0ee9945e)
1 /*
2  * ng_hci_cmds.c
3  */
4 
5 /*-
6  * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com>
7  * All rights reserved.
8  *
9  * Redistribution and use in source and binary forms, with or without
10  * modification, are permitted provided that the following conditions
11  * are met:
12  * 1. Redistributions of source code must retain the above copyright
13  *    notice, this list of conditions and the following disclaimer.
14  * 2. Redistributions in binary form must reproduce the above copyright
15  *    notice, this list of conditions and the following disclaimer in the
16  *    documentation and/or other materials provided with the distribution.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
28  * SUCH DAMAGE.
29  *
30  * $Id: ng_hci_cmds.c,v 1.4 2003/09/08 18:57:51 max Exp $
31  * $FreeBSD$
32  */
33 
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/kernel.h>
37 #include <sys/endian.h>
38 #include <sys/malloc.h>
39 #include <sys/mbuf.h>
40 #include <sys/queue.h>
41 #include <netgraph/ng_message.h>
42 #include <netgraph/netgraph.h>
43 #include <netgraph/bluetooth/include/ng_bluetooth.h>
44 #include <netgraph/bluetooth/include/ng_hci.h>
45 #include <netgraph/bluetooth/hci/ng_hci_var.h>
46 #include <netgraph/bluetooth/hci/ng_hci_cmds.h>
47 #include <netgraph/bluetooth/hci/ng_hci_evnt.h>
48 #include <netgraph/bluetooth/hci/ng_hci_ulpi.h>
49 #include <netgraph/bluetooth/hci/ng_hci_misc.h>
50 
51 /******************************************************************************
52  ******************************************************************************
53  **                     HCI commands processing module
54  ******************************************************************************
55  ******************************************************************************/
56 
57 #undef	min
58 #define	min(a, b)	((a) < (b))? (a) : (b)
59 
60 static int  complete_command (ng_hci_unit_p, int, struct mbuf **);
61 
62 static int process_link_control_params
63 	(ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
64 static int process_link_policy_params
65 	(ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
66 static int process_hc_baseband_params
67 	(ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
68 static int process_info_params
69 	(ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
70 static int process_status_params
71 	(ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
72 static int process_testing_params
73 	(ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
74 
75 static int process_link_control_status
76 	(ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
77 static int process_link_policy_status
78 	(ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
79 
80 /*
81  * Send HCI command to the driver.
82  */
83 
84 int
85 ng_hci_send_command(ng_hci_unit_p unit)
86 {
87 	struct mbuf	*m0 = NULL, *m = NULL;
88 	int		 free, error = 0;
89 
90 	/* Check if other command is pending */
91 	if (unit->state & NG_HCI_UNIT_COMMAND_PENDING)
92 		return (0);
93 
94 	/* Check if unit can accept our command */
95 	NG_HCI_BUFF_CMD_GET(unit->buffer, free);
96 	if (free == 0)
97 		return (0);
98 
99 	/* Check if driver hook is still ok */
100 	if (unit->drv == NULL || NG_HOOK_NOT_VALID(unit->drv)) {
101 		NG_HCI_WARN(
102 "%s: %s - hook \"%s\" is not connected or valid\n",
103 			__func__, NG_NODE_NAME(unit->node), NG_HCI_HOOK_DRV);
104 
105 		NG_BT_MBUFQ_DRAIN(&unit->cmdq);
106 
107 		return (ENOTCONN);
108 	}
109 
110 	/*
111 	 * Get first command from queue, give it to RAW hook then
112 	 * make copy of it and send it to the driver
113 	 */
114 
115 	m0 = NG_BT_MBUFQ_FIRST(&unit->cmdq);
116 	if (m0 == NULL)
117 		return (0);
118 
119 	ng_hci_mtap(unit, m0);
120 
121 	m = m_dup(m0, M_DONTWAIT);
122 	if (m != NULL)
123 		NG_SEND_DATA_ONLY(error, unit->drv, m);
124 	else
125 		error = ENOBUFS;
126 
127 	if (error != 0)
128 		NG_HCI_ERR(
129 "%s: %s - could not send HCI command, error=%d\n",
130 			__func__, NG_NODE_NAME(unit->node), error);
131 
132 	/*
133 	 * Even if we were not able to send command we still pretend
134 	 * that everything is OK and let timeout handle that.
135 	 */
136 
137 	NG_HCI_BUFF_CMD_USE(unit->buffer, 1);
138 	NG_HCI_STAT_CMD_SENT(unit->stat);
139 	NG_HCI_STAT_BYTES_SENT(unit->stat, m0->m_pkthdr.len);
140 
141 	/*
142 	 * Note: ng_hci_command_timeout() will set
143 	 * NG_HCI_UNIT_COMMAND_PENDING flag
144 	 */
145 
146 	ng_hci_command_timeout(unit);
147 
148 	return (0);
149 } /* ng_hci_send_command */
150 
151 /*
152  * Process HCI Command_Compete event. Complete HCI command, and do post
153  * processing on the command parameters (cp) and command return parameters
154  * (e) if required (for example adjust state).
155  */
156 
157 int
158 ng_hci_process_command_complete(ng_hci_unit_p unit, struct mbuf *e)
159 {
160 	ng_hci_command_compl_ep		*ep = NULL;
161 	struct mbuf			*cp = NULL;
162 	int				 error = 0;
163 
164 	/* Get event packet and update command buffer info */
165 	NG_HCI_M_PULLUP(e, sizeof(*ep));
166 	if (e == NULL)
167 		return (ENOBUFS); /* XXX this is bad */
168 
169 	ep = mtod(e, ng_hci_command_compl_ep *);
170         NG_HCI_BUFF_CMD_SET(unit->buffer, ep->num_cmd_pkts);
171 
172 	/* Check for special NOOP command */
173 	if (ep->opcode == 0x0000) {
174 		NG_FREE_M(e);
175 		goto out;
176 	}
177 
178 	/* Try to match first command item in the queue */
179 	error = complete_command(unit, ep->opcode, &cp);
180 	if (error != 0) {
181 		NG_FREE_M(e);
182 		goto out;
183 	}
184 
185 	/*
186 	 * Perform post processing on command parameters and return parameters
187 	 * do it only if status is OK (status == 0). Status is the first byte
188 	 * of any command return parameters.
189 	 */
190 
191 	ep->opcode = le16toh(ep->opcode);
192 	m_adj(e, sizeof(*ep));
193 
194 	if (*mtod(e, u_int8_t *) == 0) { /* XXX m_pullup here? */
195 		switch (NG_HCI_OGF(ep->opcode)) {
196 		case NG_HCI_OGF_LINK_CONTROL:
197 			error = process_link_control_params(unit,
198 					NG_HCI_OCF(ep->opcode), cp, e);
199 			break;
200 
201 		case NG_HCI_OGF_LINK_POLICY:
202 			error = process_link_policy_params(unit,
203 					NG_HCI_OCF(ep->opcode), cp, e);
204 			break;
205 
206 		case NG_HCI_OGF_HC_BASEBAND:
207 			error = process_hc_baseband_params(unit,
208 					NG_HCI_OCF(ep->opcode), cp, e);
209 			break;
210 
211 		case NG_HCI_OGF_INFO:
212 			error = process_info_params(unit,
213 					NG_HCI_OCF(ep->opcode), cp, e);
214 			break;
215 
216 		case NG_HCI_OGF_STATUS:
217 			error = process_status_params(unit,
218 					NG_HCI_OCF(ep->opcode), cp, e);
219 			break;
220 
221 		case NG_HCI_OGF_TESTING:
222 			error = process_testing_params(unit,
223 					NG_HCI_OCF(ep->opcode), cp, e);
224 			break;
225 
226 		case NG_HCI_OGF_BT_LOGO:
227 		case NG_HCI_OGF_VENDOR:
228 			NG_FREE_M(cp);
229 			NG_FREE_M(e);
230 			break;
231 
232 		default:
233 			NG_FREE_M(cp);
234 			NG_FREE_M(e);
235 			error = EINVAL;
236 			break;
237 		}
238 	} else {
239 		NG_HCI_ERR(
240 "%s: %s - HCI command failed, OGF=%#x, OCF=%#x, status=%#x\n",
241 			__func__, NG_NODE_NAME(unit->node),
242 			NG_HCI_OGF(ep->opcode), NG_HCI_OCF(ep->opcode),
243 			*mtod(e, u_int8_t *));
244 
245 		NG_FREE_M(cp);
246 		NG_FREE_M(e);
247 	}
248 out:
249 	ng_hci_send_command(unit);
250 
251 	return (error);
252 } /* ng_hci_process_command_complete */
253 
254 /*
255  * Process HCI Command_Status event. Check the status (mst) and do post
256  * processing (if required).
257  */
258 
259 int
260 ng_hci_process_command_status(ng_hci_unit_p unit, struct mbuf *e)
261 {
262 	ng_hci_command_status_ep	*ep = NULL;
263 	struct mbuf			*cp = NULL;
264 	int				 error = 0;
265 
266 	/* Update command buffer info */
267 	NG_HCI_M_PULLUP(e, sizeof(*ep));
268 	if (e == NULL)
269 		return (ENOBUFS); /* XXX this is bad */
270 
271 	ep = mtod(e, ng_hci_command_status_ep *);
272 	NG_HCI_BUFF_CMD_SET(unit->buffer, ep->num_cmd_pkts);
273 
274 	/* Check for special NOOP command */
275 	if (ep->opcode == 0x0000)
276 		goto out;
277 
278 	/* Try to match first command item in the queue */
279 	error = complete_command(unit, ep->opcode, &cp);
280         if (error != 0)
281 		goto out;
282 
283 	/*
284 	 * Perform post processing on HCI Command_Status event
285 	 */
286 
287 	ep->opcode = le16toh(ep->opcode);
288 
289 	switch (NG_HCI_OGF(ep->opcode)) {
290 	case NG_HCI_OGF_LINK_CONTROL:
291 		error = process_link_control_status(unit, ep, cp);
292 		break;
293 
294 	case NG_HCI_OGF_LINK_POLICY:
295 		error = process_link_policy_status(unit, ep, cp);
296 		break;
297 
298 	case NG_HCI_OGF_BT_LOGO:
299 	case NG_HCI_OGF_VENDOR:
300 		NG_FREE_M(cp);
301 		break;
302 
303 	case NG_HCI_OGF_HC_BASEBAND:
304 	case NG_HCI_OGF_INFO:
305 	case NG_HCI_OGF_STATUS:
306 	case NG_HCI_OGF_TESTING:
307 	default:
308 		NG_FREE_M(cp);
309 		error = EINVAL;
310 		break;
311 	}
312 out:
313 	NG_FREE_M(e);
314 	ng_hci_send_command(unit);
315 
316 	return (error);
317 } /* ng_hci_process_command_status */
318 
319 /*
320  * Complete queued HCI command.
321  */
322 
323 static int
324 complete_command(ng_hci_unit_p unit, int opcode, struct mbuf **cp)
325 {
326 	struct mbuf	*m = NULL;
327 
328 	/* Check unit state */
329 	if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING)) {
330 		NG_HCI_ALERT(
331 "%s: %s - no pending command, state=%#x\n",
332 			__func__, NG_NODE_NAME(unit->node), unit->state);
333 
334 		return (EINVAL);
335 	}
336 
337 	/* Get first command in the queue */
338 	m = NG_BT_MBUFQ_FIRST(&unit->cmdq);
339 	if (m == NULL) {
340 		NG_HCI_ALERT(
341 "%s: %s - empty command queue?!\n", __func__, NG_NODE_NAME(unit->node));
342 
343 		return (EINVAL);
344 	}
345 
346 	/*
347 	 * Match command opcode, if does not match - do nothing and
348 	 * let timeout handle that.
349 	 */
350 
351 	if (mtod(m, ng_hci_cmd_pkt_t *)->opcode != opcode) {
352 		NG_HCI_ALERT(
353 "%s: %s - command queue is out of sync\n", __func__, NG_NODE_NAME(unit->node));
354 
355 		return (EINVAL);
356 	}
357 
358 	/*
359 	 * Now we can remove command timeout, dequeue completed command
360 	 * and return command parameters. ng_hci_command_untimeout will
361 	 * drop NG_HCI_UNIT_COMMAND_PENDING flag.
362 	 * Note: if ng_hci_command_untimeout() fails (returns non-zero)
363 	 * then timeout aready happened and timeout message went info node
364 	 * queue. In this case we ignore command completion and pretend
365 	 * there is a timeout.
366 	 */
367 
368 	if (ng_hci_command_untimeout(unit) != 0)
369 		return (ETIMEDOUT);
370 
371 	NG_BT_MBUFQ_DEQUEUE(&unit->cmdq, *cp);
372 	m_adj(*cp, sizeof(ng_hci_cmd_pkt_t));
373 
374 	return (0);
375 } /* complete_command */
376 
377 /*
378  * Process HCI command timeout
379  */
380 
381 void
382 ng_hci_process_command_timeout(node_p node, hook_p hook, void *arg1, int arg2)
383 {
384 	ng_hci_unit_p	 unit = NULL;
385 	struct mbuf	*m = NULL;
386 	u_int16_t	 opcode;
387 
388 	if (NG_NODE_NOT_VALID(node)) {
389 		printf("%s: Netgraph node is not valid\n", __func__);
390 		return;
391 	}
392 
393 	unit = (ng_hci_unit_p) NG_NODE_PRIVATE(node);
394 
395 	if (unit->state & NG_HCI_UNIT_COMMAND_PENDING) {
396 		unit->state &= ~NG_HCI_UNIT_COMMAND_PENDING;
397 
398 		NG_BT_MBUFQ_DEQUEUE(&unit->cmdq, m);
399 		if (m == NULL) {
400 			NG_HCI_ALERT(
401 "%s: %s - command queue is out of sync!\n", __func__, NG_NODE_NAME(unit->node));
402 
403 			return;
404 		}
405 
406 		opcode = le16toh(mtod(m, ng_hci_cmd_pkt_t *)->opcode);
407 		NG_FREE_M(m);
408 
409 		NG_HCI_ERR(
410 "%s: %s - unable to complete HCI command OGF=%#x, OCF=%#x. Timeout\n",
411 			__func__, NG_NODE_NAME(unit->node), NG_HCI_OGF(opcode),
412 			NG_HCI_OCF(opcode));
413 
414 		/* Try to send more commands */
415  		NG_HCI_BUFF_CMD_SET(unit->buffer, 1);
416 		ng_hci_send_command(unit);
417 	} else
418 		NG_HCI_ALERT(
419 "%s: %s - no pending command\n", __func__, NG_NODE_NAME(unit->node));
420 } /* ng_hci_process_command_timeout */
421 
422 /*
423  * Process link command return parameters
424  */
425 
426 static int
427 process_link_control_params(ng_hci_unit_p unit, u_int16_t ocf,
428 		struct mbuf *mcp, struct mbuf *mrp)
429 {
430 	int	error  = 0;
431 
432 	switch (ocf) {
433 	case NG_HCI_OCF_INQUIRY_CANCEL:
434 	case NG_HCI_OCF_PERIODIC_INQUIRY:
435 	case NG_HCI_OCF_EXIT_PERIODIC_INQUIRY:
436 	case NG_HCI_OCF_LINK_KEY_REP:
437 	case NG_HCI_OCF_LINK_KEY_NEG_REP:
438 	case NG_HCI_OCF_PIN_CODE_REP:
439 	case NG_HCI_OCF_PIN_CODE_NEG_REP:
440 		/* These do not need post processing */
441 		break;
442 
443 	case NG_HCI_OCF_INQUIRY:
444 	case NG_HCI_OCF_CREATE_CON:
445 	case NG_HCI_OCF_DISCON:
446 	case NG_HCI_OCF_ADD_SCO_CON:
447 	case NG_HCI_OCF_ACCEPT_CON:
448 	case NG_HCI_OCF_REJECT_CON:
449 	case NG_HCI_OCF_CHANGE_CON_PKT_TYPE:
450 	case NG_HCI_OCF_AUTH_REQ:
451 	case NG_HCI_OCF_SET_CON_ENCRYPTION:
452 	case NG_HCI_OCF_CHANGE_CON_LINK_KEY:
453 	case NG_HCI_OCF_MASTER_LINK_KEY:
454 	case NG_HCI_OCF_REMOTE_NAME_REQ:
455 	case NG_HCI_OCF_READ_REMOTE_FEATURES:
456 	case NG_HCI_OCF_READ_REMOTE_VER_INFO:
457 	case NG_HCI_OCF_READ_CLOCK_OFFSET:
458 	default:
459 
460 		/*
461 		 * None of these command was supposed to generate
462 		 * Command_Complete event. Instead Command_Status event
463 		 * should have been generated and then appropriate event
464 		 * should have been sent to indicate the final result.
465 		 */
466 
467 		error = EINVAL;
468 		break;
469 	}
470 
471 	NG_FREE_M(mcp);
472 	NG_FREE_M(mrp);
473 
474 	return (error);
475 } /* process_link_control_params */
476 
477 /*
478  * Process link policy command return parameters
479  */
480 
481 static int
482 process_link_policy_params(ng_hci_unit_p unit, u_int16_t ocf,
483 		struct mbuf *mcp, struct mbuf *mrp)
484 {
485 	int	error = 0;
486 
487 	switch (ocf){
488 	case NG_HCI_OCF_ROLE_DISCOVERY: {
489 		ng_hci_role_discovery_rp	*rp = NULL;
490 		ng_hci_unit_con_t		*con = NULL;
491 		u_int16_t			 h;
492 
493 		NG_HCI_M_PULLUP(mrp, sizeof(*rp));
494 		if (mrp != NULL) {
495 			rp = mtod(mrp, ng_hci_role_discovery_rp *);
496 
497 			h = NG_HCI_CON_HANDLE(le16toh(rp->con_handle));
498 			con = ng_hci_con_by_handle(unit, h);
499 			if (con == NULL) {
500 				NG_HCI_ALERT(
501 "%s: %s - invalid connection handle=%d\n",
502 					__func__, NG_NODE_NAME(unit->node), h);
503 				error = ENOENT;
504 			} else if (con->link_type != NG_HCI_LINK_ACL) {
505 				NG_HCI_ALERT(
506 "%s: %s - invalid link type=%d\n", __func__, NG_NODE_NAME(unit->node),
507 					con->link_type);
508 				error = EINVAL;
509 			} else
510 				con->role = rp->role;
511 		} else
512 			error = ENOBUFS;
513 		} break;
514 
515 	case NG_HCI_OCF_READ_LINK_POLICY_SETTINGS:
516 	case NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS:
517 		/* These do not need post processing */
518 		break;
519 
520 	case NG_HCI_OCF_HOLD_MODE:
521 	case NG_HCI_OCF_SNIFF_MODE:
522 	case NG_HCI_OCF_EXIT_SNIFF_MODE:
523 	case NG_HCI_OCF_PARK_MODE:
524 	case NG_HCI_OCF_EXIT_PARK_MODE:
525 	case NG_HCI_OCF_QOS_SETUP:
526 	case NG_HCI_OCF_SWITCH_ROLE:
527 	default:
528 
529 		/*
530 		 * None of these command was supposed to generate
531 		 * Command_Complete event. Instead Command_Status event
532 		 * should have been generated and then appropriate event
533 		 * should have been sent to indicate the final result.
534 		 */
535 
536 		error = EINVAL;
537 		break;
538 	}
539 
540 	NG_FREE_M(mcp);
541 	NG_FREE_M(mrp);
542 
543 	return (error);
544 } /* process_link_policy_params */
545 
546 /*
547  * Process HC and baseband command return parameters
548  */
549 
550 int
551 process_hc_baseband_params(ng_hci_unit_p unit, u_int16_t ocf,
552 		struct mbuf *mcp, struct mbuf *mrp)
553 {
554 	int	error = 0;
555 
556 	switch (ocf) {
557 	case NG_HCI_OCF_SET_EVENT_MASK:
558 	case NG_HCI_OCF_SET_EVENT_FILTER:
559 	case NG_HCI_OCF_FLUSH:	/* XXX Do we need to handle that? */
560 	case NG_HCI_OCF_READ_PIN_TYPE:
561 	case NG_HCI_OCF_WRITE_PIN_TYPE:
562 	case NG_HCI_OCF_CREATE_NEW_UNIT_KEY:
563 	case NG_HCI_OCF_WRITE_STORED_LINK_KEY:
564 	case NG_HCI_OCF_WRITE_CON_ACCEPT_TIMO:
565 	case NG_HCI_OCF_WRITE_PAGE_TIMO:
566 	case NG_HCI_OCF_READ_SCAN_ENABLE:
567 	case NG_HCI_OCF_WRITE_SCAN_ENABLE:
568 	case NG_HCI_OCF_WRITE_PAGE_SCAN_ACTIVITY:
569 	case NG_HCI_OCF_WRITE_INQUIRY_SCAN_ACTIVITY:
570 	case NG_HCI_OCF_READ_AUTH_ENABLE:
571 	case NG_HCI_OCF_WRITE_AUTH_ENABLE:
572 	case NG_HCI_OCF_READ_ENCRYPTION_MODE:
573 	case NG_HCI_OCF_WRITE_ENCRYPTION_MODE:
574 	case NG_HCI_OCF_WRITE_VOICE_SETTINGS:
575 	case NG_HCI_OCF_READ_NUM_BROADCAST_RETRANS:
576 	case NG_HCI_OCF_WRITE_NUM_BROADCAST_RETRANS:
577 	case NG_HCI_OCF_READ_HOLD_MODE_ACTIVITY:
578 	case NG_HCI_OCF_WRITE_HOLD_MODE_ACTIVITY:
579 	case NG_HCI_OCF_READ_SCO_FLOW_CONTROL:
580 	case NG_HCI_OCF_WRITE_SCO_FLOW_CONTROL:
581 	case NG_HCI_OCF_H2HC_FLOW_CONTROL: /* XXX Not supported this time */
582 	case NG_HCI_OCF_HOST_BUFFER_SIZE:
583 	case NG_HCI_OCF_READ_IAC_LAP:
584 	case NG_HCI_OCF_WRITE_IAC_LAP:
585 	case NG_HCI_OCF_READ_PAGE_SCAN_PERIOD:
586 	case NG_HCI_OCF_WRITE_PAGE_SCAN_PERIOD:
587 	case NG_HCI_OCF_READ_PAGE_SCAN:
588 	case NG_HCI_OCF_WRITE_PAGE_SCAN:
589 	case NG_HCI_OCF_READ_LINK_SUPERVISION_TIMO:
590 	case NG_HCI_OCF_WRITE_LINK_SUPERVISION_TIMO:
591 	case NG_HCI_OCF_READ_SUPPORTED_IAC_NUM:
592 	case NG_HCI_OCF_READ_STORED_LINK_KEY:
593 	case NG_HCI_OCF_DELETE_STORED_LINK_KEY:
594 	case NG_HCI_OCF_READ_CON_ACCEPT_TIMO:
595 	case NG_HCI_OCF_READ_PAGE_TIMO:
596 	case NG_HCI_OCF_READ_PAGE_SCAN_ACTIVITY:
597 	case NG_HCI_OCF_READ_INQUIRY_SCAN_ACTIVITY:
598 	case NG_HCI_OCF_READ_VOICE_SETTINGS:
599 	case NG_HCI_OCF_READ_AUTO_FLUSH_TIMO:
600 	case NG_HCI_OCF_WRITE_AUTO_FLUSH_TIMO:
601 	case NG_HCI_OCF_READ_XMIT_LEVEL:
602 	case NG_HCI_OCF_HOST_NUM_COMPL_PKTS:	/* XXX Can get here? */
603 	case NG_HCI_OCF_CHANGE_LOCAL_NAME:
604 	case NG_HCI_OCF_READ_LOCAL_NAME:
605 	case NG_HCI_OCF_READ_UNIT_CLASS:
606 	case NG_HCI_OCF_WRITE_UNIT_CLASS:
607 		/* These do not need post processing */
608 		break;
609 
610 	case NG_HCI_OCF_RESET: {
611 		ng_hci_unit_con_p	con = NULL;
612 		int			size;
613 
614 		/*
615 		 * XXX
616 		 *
617 		 * After RESET command unit goes into standby mode
618 		 * and all operational state is lost. Host controller
619 		 * will revert to default values for all parameters.
620 		 *
621 		 * For now we shall terminate all connections and drop
622 		 * inited bit. After RESET unit must be re-initialized.
623 		 */
624 
625 		while (!LIST_EMPTY(&unit->con_list)) {
626 			con = LIST_FIRST(&unit->con_list);
627 
628 			/* Remove all timeouts (if any) */
629 			if (con->flags & NG_HCI_CON_TIMEOUT_PENDING)
630 				ng_hci_con_untimeout(con);
631 
632 			/* Connection terminated by local host */
633 			ng_hci_lp_discon_ind(con, 0x16);
634 			ng_hci_free_con(con);
635 		}
636 
637 		NG_HCI_BUFF_ACL_TOTAL(unit->buffer, size);
638 		NG_HCI_BUFF_ACL_FREE(unit->buffer, size);
639 
640 		NG_HCI_BUFF_SCO_TOTAL(unit->buffer, size);
641 		NG_HCI_BUFF_SCO_FREE(unit->buffer, size);
642 
643 		unit->state &= ~NG_HCI_UNIT_INITED;
644 		} break;
645 
646 	default:
647 		error = EINVAL;
648 		break;
649 	}
650 
651 	NG_FREE_M(mcp);
652 	NG_FREE_M(mrp);
653 
654 	return (error);
655 } /* process_hc_baseband_params */
656 
657 /*
658  * Process info command return parameters
659  */
660 
661 static int
662 process_info_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
663 		struct mbuf *mrp)
664 {
665 	int	error = 0, len;
666 
667 	switch (ocf) {
668 	case NG_HCI_OCF_READ_LOCAL_VER:
669 	case NG_HCI_OCF_READ_COUNTRY_CODE:
670 		break;
671 
672 	case NG_HCI_OCF_READ_LOCAL_FEATURES:
673 		m_adj(mrp, sizeof(u_int8_t));
674 		len = min(mrp->m_pkthdr.len, sizeof(unit->features));
675 		m_copydata(mrp, 0, len, (caddr_t) unit->features);
676 		break;
677 
678 	case NG_HCI_OCF_READ_BUFFER_SIZE: {
679 		ng_hci_read_buffer_size_rp	*rp = NULL;
680 
681 		/* Do not update buffer descriptor if node was initialized */
682 		if ((unit->state & NG_HCI_UNIT_READY) == NG_HCI_UNIT_READY)
683 			break;
684 
685 		NG_HCI_M_PULLUP(mrp, sizeof(*rp));
686 		if (mrp != NULL) {
687 			rp = mtod(mrp, ng_hci_read_buffer_size_rp *);
688 
689 			NG_HCI_BUFF_ACL_SET(
690 				unit->buffer,
691 				le16toh(rp->num_acl_pkt),  /* number */
692 				le16toh(rp->max_acl_size), /* size */
693 				le16toh(rp->num_acl_pkt)   /* free */
694 			);
695 
696 			NG_HCI_BUFF_SCO_SET(
697 				unit->buffer,
698 				le16toh(rp->num_sco_pkt), /* number */
699 				rp->max_sco_size,         /* size */
700 				le16toh(rp->num_sco_pkt)  /* free */
701 			);
702 
703 			/* Let upper layers know */
704 			ng_hci_node_is_up(unit->node, unit->acl, NULL, 0);
705 			ng_hci_node_is_up(unit->node, unit->sco, NULL, 0);
706 		} else
707 			error = ENOBUFS;
708 		} break;
709 
710 	case NG_HCI_OCF_READ_BDADDR:
711 		/* Do not update BD_ADDR if node was initialized */
712 		if ((unit->state & NG_HCI_UNIT_READY) == NG_HCI_UNIT_READY)
713 			break;
714 
715 		m_adj(mrp, sizeof(u_int8_t));
716 		len = min(mrp->m_pkthdr.len, sizeof(unit->bdaddr));
717 		m_copydata(mrp, 0, len, (caddr_t) &unit->bdaddr);
718 
719 		/* Let upper layers know */
720 		ng_hci_node_is_up(unit->node, unit->acl, NULL, 0);
721 		ng_hci_node_is_up(unit->node, unit->sco, NULL, 0);
722 		break;
723 
724 	default:
725 		error = EINVAL;
726 		break;
727 	}
728 
729 	NG_FREE_M(mcp);
730 	NG_FREE_M(mrp);
731 
732 	return (error);
733 } /* process_info_params */
734 
735 /*
736  * Process status command return parameters
737  */
738 
739 static int
740 process_status_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
741 		struct mbuf *mrp)
742 {
743 	int	error = 0;
744 
745 	switch (ocf) {
746 	case NG_HCI_OCF_READ_FAILED_CONTACT_CNTR:
747 	case NG_HCI_OCF_RESET_FAILED_CONTACT_CNTR:
748 	case NG_HCI_OCF_GET_LINK_QUALITY:
749 	case NG_HCI_OCF_READ_RSSI:
750 		/* These do not need post processing */
751 		break;
752 
753 	default:
754 		error = EINVAL;
755 		break;
756 	}
757 
758 	NG_FREE_M(mcp);
759 	NG_FREE_M(mrp);
760 
761 	return (error);
762 } /* process_status_params */
763 
764 /*
765  * Process testing command return parameters
766  */
767 
768 int
769 process_testing_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
770 		struct mbuf *mrp)
771 {
772 	int	error = 0;
773 
774 	switch (ocf) {
775 
776 	/*
777 	 * XXX FIXME
778 	 * We do not support these features at this time. However,
779 	 * HCI node could support this and do something smart. At least
780 	 * node can change unit state.
781 	 */
782 
783 	case NG_HCI_OCF_READ_LOOPBACK_MODE:
784 	case NG_HCI_OCF_WRITE_LOOPBACK_MODE:
785 	case NG_HCI_OCF_ENABLE_UNIT_UNDER_TEST:
786 		break;
787 
788 	default:
789 		error = EINVAL;
790 		break;
791 	}
792 
793 	NG_FREE_M(mcp);
794 	NG_FREE_M(mrp);
795 
796 	return (error);
797 } /* process_testing_params */
798 
799 /*
800  * Process link control command status
801  */
802 
803 static int
804 process_link_control_status(ng_hci_unit_p unit, ng_hci_command_status_ep *ep,
805 		struct mbuf *mcp)
806 {
807 	int	error = 0;
808 
809 	switch (NG_HCI_OCF(ep->opcode)) {
810 	case NG_HCI_OCF_INQUIRY:
811 	case NG_HCI_OCF_DISCON:		/* XXX */
812 	case NG_HCI_OCF_REJECT_CON:	/* XXX */
813 	case NG_HCI_OCF_CHANGE_CON_PKT_TYPE:
814 	case NG_HCI_OCF_AUTH_REQ:
815 	case NG_HCI_OCF_SET_CON_ENCRYPTION:
816 	case NG_HCI_OCF_CHANGE_CON_LINK_KEY:
817 	case NG_HCI_OCF_MASTER_LINK_KEY:
818 	case NG_HCI_OCF_REMOTE_NAME_REQ:
819 	case NG_HCI_OCF_READ_REMOTE_FEATURES:
820 	case NG_HCI_OCF_READ_REMOTE_VER_INFO:
821 	case NG_HCI_OCF_READ_CLOCK_OFFSET:
822 		/* These do not need post processing */
823 		break;
824 
825 	case NG_HCI_OCF_CREATE_CON:
826 		break;
827 
828 	case NG_HCI_OCF_ADD_SCO_CON:
829 		break;
830 
831 	case NG_HCI_OCF_ACCEPT_CON:
832 		break;
833 
834 	case NG_HCI_OCF_INQUIRY_CANCEL:
835 	case NG_HCI_OCF_PERIODIC_INQUIRY:
836 	case NG_HCI_OCF_EXIT_PERIODIC_INQUIRY:
837 	case NG_HCI_OCF_LINK_KEY_REP:
838 	case NG_HCI_OCF_LINK_KEY_NEG_REP:
839 	case NG_HCI_OCF_PIN_CODE_REP:
840 	case NG_HCI_OCF_PIN_CODE_NEG_REP:
841 	default:
842 
843 		/*
844 		 * None of these command was supposed to generate
845 		 * Command_Status event. Instead Command_Complete event
846 		 * should have been sent.
847 		 */
848 
849 		error = EINVAL;
850 		break;
851 	}
852 
853 	NG_FREE_M(mcp);
854 
855 	return (error);
856 } /* process_link_control_status */
857 
858 /*
859  * Process link policy command status
860  */
861 
862 static int
863 process_link_policy_status(ng_hci_unit_p unit, ng_hci_command_status_ep *ep,
864 		struct mbuf *mcp)
865 {
866 	int	error = 0;
867 
868 	switch (NG_HCI_OCF(ep->opcode)) {
869 	case NG_HCI_OCF_HOLD_MODE:
870 	case NG_HCI_OCF_SNIFF_MODE:
871 	case NG_HCI_OCF_EXIT_SNIFF_MODE:
872 	case NG_HCI_OCF_PARK_MODE:
873 	case NG_HCI_OCF_EXIT_PARK_MODE:
874 	case NG_HCI_OCF_SWITCH_ROLE:
875 		/* These do not need post processing */
876 		break;
877 
878 	case NG_HCI_OCF_QOS_SETUP:
879 		break;
880 
881 	case NG_HCI_OCF_ROLE_DISCOVERY:
882 	case NG_HCI_OCF_READ_LINK_POLICY_SETTINGS:
883 	case NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS:
884 	default:
885 
886 		/*
887 		 * None of these command was supposed to generate
888 		 * Command_Status event. Instead Command_Complete event
889 		 * should have been sent.
890 		 */
891 
892 		error = EINVAL;
893 		break;
894 	}
895 
896 	NG_FREE_M(mcp);
897 
898 	return (error);
899 } /* process_link_policy_status */
900 
901