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 static int process_le_params
75 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
76
77 static int process_link_control_status
78 (ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
79 static int process_link_policy_status
80 (ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
81 static int process_le_status
82 (ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
83
84 /*
85 * Send HCI command to the driver.
86 */
87
88 int
ng_hci_send_command(ng_hci_unit_p unit)89 ng_hci_send_command(ng_hci_unit_p unit)
90 {
91 struct mbuf *m0 = NULL, *m = NULL;
92 int free, error = 0;
93
94 /* Check if other command is pending */
95 if (unit->state & NG_HCI_UNIT_COMMAND_PENDING)
96 return (0);
97
98 /* Check if unit can accept our command */
99 NG_HCI_BUFF_CMD_GET(unit->buffer, free);
100 if (free == 0)
101 return (0);
102
103 /* Check if driver hook is still ok */
104 if (unit->drv == NULL || NG_HOOK_NOT_VALID(unit->drv)) {
105 NG_HCI_WARN(
106 "%s: %s - hook \"%s\" is not connected or valid\n",
107 __func__, NG_NODE_NAME(unit->node), NG_HCI_HOOK_DRV);
108
109 NG_BT_MBUFQ_DRAIN(&unit->cmdq);
110
111 return (ENOTCONN);
112 }
113
114 /*
115 * Get first command from queue, give it to RAW hook then
116 * make copy of it and send it to the driver
117 */
118
119 m0 = NG_BT_MBUFQ_FIRST(&unit->cmdq);
120 if (m0 == NULL)
121 return (0);
122
123 ng_hci_mtap(unit, m0);
124
125 m = m_dup(m0, M_NOWAIT);
126 if (m != NULL)
127 NG_SEND_DATA_ONLY(error, unit->drv, m);
128 else
129 error = ENOBUFS;
130
131 if (error != 0)
132 NG_HCI_ERR(
133 "%s: %s - could not send HCI command, error=%d\n",
134 __func__, NG_NODE_NAME(unit->node), error);
135
136 /*
137 * Even if we were not able to send command we still pretend
138 * that everything is OK and let timeout handle that.
139 */
140
141 NG_HCI_BUFF_CMD_USE(unit->buffer, 1);
142 NG_HCI_STAT_CMD_SENT(unit->stat);
143 NG_HCI_STAT_BYTES_SENT(unit->stat, m0->m_pkthdr.len);
144
145 /*
146 * Note: ng_hci_command_timeout() will set
147 * NG_HCI_UNIT_COMMAND_PENDING flag
148 */
149
150 ng_hci_command_timeout(unit);
151
152 return (0);
153 } /* ng_hci_send_command */
154
155 /*
156 * Process HCI Command_Compete event. Complete HCI command, and do post
157 * processing on the command parameters (cp) and command return parameters
158 * (e) if required (for example adjust state).
159 */
160
161 int
ng_hci_process_command_complete(ng_hci_unit_p unit,struct mbuf * e)162 ng_hci_process_command_complete(ng_hci_unit_p unit, struct mbuf *e)
163 {
164 ng_hci_command_compl_ep *ep = NULL;
165 struct mbuf *cp = NULL;
166 int error = 0;
167
168 /* Get event packet and update command buffer info */
169 NG_HCI_M_PULLUP(e, sizeof(*ep));
170 if (e == NULL)
171 return (ENOBUFS); /* XXX this is bad */
172
173 ep = mtod(e, ng_hci_command_compl_ep *);
174 NG_HCI_BUFF_CMD_SET(unit->buffer, ep->num_cmd_pkts);
175
176 /* Check for special NOOP command */
177 if (ep->opcode == 0x0000) {
178 NG_FREE_M(e);
179 goto out;
180 }
181
182 /* Try to match first command item in the queue */
183 error = complete_command(unit, ep->opcode, &cp);
184 if (error != 0) {
185 NG_FREE_M(e);
186 goto out;
187 }
188
189 /*
190 * Perform post processing on command parameters and return parameters
191 * do it only if status is OK (status == 0). Status is the first byte
192 * of any command return parameters.
193 */
194
195 ep->opcode = le16toh(ep->opcode);
196 m_adj(e, sizeof(*ep));
197
198 if (*mtod(e, u_int8_t *) == 0) { /* XXX m_pullup here? */
199 switch (NG_HCI_OGF(ep->opcode)) {
200 case NG_HCI_OGF_LINK_CONTROL:
201 error = process_link_control_params(unit,
202 NG_HCI_OCF(ep->opcode), cp, e);
203 break;
204
205 case NG_HCI_OGF_LINK_POLICY:
206 error = process_link_policy_params(unit,
207 NG_HCI_OCF(ep->opcode), cp, e);
208 break;
209
210 case NG_HCI_OGF_HC_BASEBAND:
211 error = process_hc_baseband_params(unit,
212 NG_HCI_OCF(ep->opcode), cp, e);
213 break;
214
215 case NG_HCI_OGF_INFO:
216 error = process_info_params(unit,
217 NG_HCI_OCF(ep->opcode), cp, e);
218 break;
219
220 case NG_HCI_OGF_STATUS:
221 error = process_status_params(unit,
222 NG_HCI_OCF(ep->opcode), cp, e);
223 break;
224
225 case NG_HCI_OGF_TESTING:
226 error = process_testing_params(unit,
227 NG_HCI_OCF(ep->opcode), cp, e);
228 break;
229 case NG_HCI_OGF_LE:
230 error = process_le_params(unit,
231 NG_HCI_OCF(ep->opcode), cp, e);
232 break;
233 case NG_HCI_OGF_BT_LOGO:
234 case NG_HCI_OGF_VENDOR:
235 NG_FREE_M(cp);
236 NG_FREE_M(e);
237 break;
238
239 default:
240 NG_FREE_M(cp);
241 NG_FREE_M(e);
242 error = EINVAL;
243 break;
244 }
245 } else {
246 NG_HCI_ERR(
247 "%s: %s - HCI command failed, OGF=%#x, OCF=%#x, status=%#x\n",
248 __func__, NG_NODE_NAME(unit->node),
249 NG_HCI_OGF(ep->opcode), NG_HCI_OCF(ep->opcode),
250 *mtod(e, u_int8_t *));
251
252 NG_FREE_M(cp);
253 NG_FREE_M(e);
254 }
255 out:
256 ng_hci_send_command(unit);
257
258 return (error);
259 } /* ng_hci_process_command_complete */
260
261 /*
262 * Process HCI Command_Status event. Check the status (mst) and do post
263 * processing (if required).
264 */
265
266 int
ng_hci_process_command_status(ng_hci_unit_p unit,struct mbuf * e)267 ng_hci_process_command_status(ng_hci_unit_p unit, struct mbuf *e)
268 {
269 ng_hci_command_status_ep *ep = NULL;
270 struct mbuf *cp = NULL;
271 int error = 0;
272
273 /* Update command buffer info */
274 NG_HCI_M_PULLUP(e, sizeof(*ep));
275 if (e == NULL)
276 return (ENOBUFS); /* XXX this is bad */
277
278 ep = mtod(e, ng_hci_command_status_ep *);
279 NG_HCI_BUFF_CMD_SET(unit->buffer, ep->num_cmd_pkts);
280
281 /* Check for special NOOP command */
282 if (ep->opcode == 0x0000)
283 goto out;
284
285 /* Try to match first command item in the queue */
286 error = complete_command(unit, ep->opcode, &cp);
287 if (error != 0)
288 goto out;
289
290 /*
291 * Perform post processing on HCI Command_Status event
292 */
293
294 ep->opcode = le16toh(ep->opcode);
295
296 switch (NG_HCI_OGF(ep->opcode)) {
297 case NG_HCI_OGF_LINK_CONTROL:
298 error = process_link_control_status(unit, ep, cp);
299 break;
300
301 case NG_HCI_OGF_LINK_POLICY:
302 error = process_link_policy_status(unit, ep, cp);
303 break;
304 case NG_HCI_OGF_LE:
305 error = process_le_status(unit, ep, cp);
306 break;
307 case NG_HCI_OGF_BT_LOGO:
308 case NG_HCI_OGF_VENDOR:
309 NG_FREE_M(cp);
310 break;
311
312 case NG_HCI_OGF_HC_BASEBAND:
313 case NG_HCI_OGF_INFO:
314 case NG_HCI_OGF_STATUS:
315 case NG_HCI_OGF_TESTING:
316 default:
317 NG_FREE_M(cp);
318 error = EINVAL;
319 break;
320 }
321 out:
322 NG_FREE_M(e);
323 ng_hci_send_command(unit);
324
325 return (error);
326 } /* ng_hci_process_command_status */
327
328 /*
329 * Complete queued HCI command.
330 */
331
332 static int
complete_command(ng_hci_unit_p unit,int opcode,struct mbuf ** cp)333 complete_command(ng_hci_unit_p unit, int opcode, struct mbuf **cp)
334 {
335 struct mbuf *m = NULL;
336
337 /* Check unit state */
338 if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING)) {
339 NG_HCI_ALERT(
340 "%s: %s - no pending command, state=%#x\n",
341 __func__, NG_NODE_NAME(unit->node), unit->state);
342
343 return (EINVAL);
344 }
345
346 /* Get first command in the queue */
347 m = NG_BT_MBUFQ_FIRST(&unit->cmdq);
348 if (m == NULL) {
349 NG_HCI_ALERT(
350 "%s: %s - empty command queue?!\n", __func__, NG_NODE_NAME(unit->node));
351
352 return (EINVAL);
353 }
354
355 /*
356 * Match command opcode, if does not match - do nothing and
357 * let timeout handle that.
358 */
359
360 if (mtod(m, ng_hci_cmd_pkt_t *)->opcode != opcode) {
361 NG_HCI_ALERT(
362 "%s: %s - command queue is out of sync\n", __func__, NG_NODE_NAME(unit->node));
363
364 return (EINVAL);
365 }
366
367 /*
368 * Now we can remove command timeout, dequeue completed command
369 * and return command parameters. ng_hci_command_untimeout will
370 * drop NG_HCI_UNIT_COMMAND_PENDING flag.
371 * Note: if ng_hci_command_untimeout() fails (returns non-zero)
372 * then timeout aready happened and timeout message went info node
373 * queue. In this case we ignore command completion and pretend
374 * there is a timeout.
375 */
376
377 if (ng_hci_command_untimeout(unit) != 0)
378 return (ETIMEDOUT);
379
380 NG_BT_MBUFQ_DEQUEUE(&unit->cmdq, *cp);
381 m_adj(*cp, sizeof(ng_hci_cmd_pkt_t));
382
383 return (0);
384 } /* complete_command */
385
386 /*
387 * Process HCI command timeout
388 */
389
390 void
ng_hci_process_command_timeout(node_p node,hook_p hook,void * arg1,int arg2)391 ng_hci_process_command_timeout(node_p node, hook_p hook, void *arg1, int arg2)
392 {
393 ng_hci_unit_p unit = NULL;
394 struct mbuf *m = NULL;
395 u_int16_t opcode;
396
397 if (NG_NODE_NOT_VALID(node)) {
398 printf("%s: Netgraph node is not valid\n", __func__);
399 return;
400 }
401
402 unit = (ng_hci_unit_p) NG_NODE_PRIVATE(node);
403
404 if (unit->state & NG_HCI_UNIT_COMMAND_PENDING) {
405 unit->state &= ~NG_HCI_UNIT_COMMAND_PENDING;
406
407 NG_BT_MBUFQ_DEQUEUE(&unit->cmdq, m);
408 if (m == NULL) {
409 NG_HCI_ALERT(
410 "%s: %s - command queue is out of sync!\n", __func__, NG_NODE_NAME(unit->node));
411
412 return;
413 }
414
415 opcode = le16toh(mtod(m, ng_hci_cmd_pkt_t *)->opcode);
416 NG_FREE_M(m);
417
418 NG_HCI_ERR(
419 "%s: %s - unable to complete HCI command OGF=%#x, OCF=%#x. Timeout\n",
420 __func__, NG_NODE_NAME(unit->node), NG_HCI_OGF(opcode),
421 NG_HCI_OCF(opcode));
422
423 /* Try to send more commands */
424 NG_HCI_BUFF_CMD_SET(unit->buffer, 1);
425 ng_hci_send_command(unit);
426 } else
427 NG_HCI_ALERT(
428 "%s: %s - no pending command\n", __func__, NG_NODE_NAME(unit->node));
429 } /* ng_hci_process_command_timeout */
430
431 /*
432 * Process link command return parameters
433 */
434
435 static int
process_link_control_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)436 process_link_control_params(ng_hci_unit_p unit, u_int16_t ocf,
437 struct mbuf *mcp, struct mbuf *mrp)
438 {
439 int error = 0;
440
441 switch (ocf) {
442 case NG_HCI_OCF_INQUIRY_CANCEL:
443 case NG_HCI_OCF_PERIODIC_INQUIRY:
444 case NG_HCI_OCF_EXIT_PERIODIC_INQUIRY:
445 case NG_HCI_OCF_LINK_KEY_REP:
446 case NG_HCI_OCF_LINK_KEY_NEG_REP:
447 case NG_HCI_OCF_PIN_CODE_REP:
448 case NG_HCI_OCF_PIN_CODE_NEG_REP:
449 /* These do not need post processing */
450 break;
451
452 case NG_HCI_OCF_INQUIRY:
453 case NG_HCI_OCF_CREATE_CON:
454 case NG_HCI_OCF_DISCON:
455 case NG_HCI_OCF_ADD_SCO_CON:
456 case NG_HCI_OCF_ACCEPT_CON:
457 case NG_HCI_OCF_REJECT_CON:
458 case NG_HCI_OCF_CHANGE_CON_PKT_TYPE:
459 case NG_HCI_OCF_AUTH_REQ:
460 case NG_HCI_OCF_SET_CON_ENCRYPTION:
461 case NG_HCI_OCF_CHANGE_CON_LINK_KEY:
462 case NG_HCI_OCF_MASTER_LINK_KEY:
463 case NG_HCI_OCF_REMOTE_NAME_REQ:
464 case NG_HCI_OCF_READ_REMOTE_FEATURES:
465 case NG_HCI_OCF_READ_REMOTE_VER_INFO:
466 case NG_HCI_OCF_READ_CLOCK_OFFSET:
467 default:
468
469 /*
470 * None of these command was supposed to generate
471 * Command_Complete event. Instead Command_Status event
472 * should have been generated and then appropriate event
473 * should have been sent to indicate the final result.
474 */
475
476 error = EINVAL;
477 break;
478 }
479
480 NG_FREE_M(mcp);
481 NG_FREE_M(mrp);
482
483 return (error);
484 } /* process_link_control_params */
485
486 /*
487 * Process link policy command return parameters
488 */
489
490 static int
process_link_policy_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)491 process_link_policy_params(ng_hci_unit_p unit, u_int16_t ocf,
492 struct mbuf *mcp, struct mbuf *mrp)
493 {
494 int error = 0;
495
496 switch (ocf){
497 case NG_HCI_OCF_ROLE_DISCOVERY: {
498 ng_hci_role_discovery_rp *rp = NULL;
499 ng_hci_unit_con_t *con = NULL;
500 u_int16_t h;
501
502 NG_HCI_M_PULLUP(mrp, sizeof(*rp));
503 if (mrp != NULL) {
504 rp = mtod(mrp, ng_hci_role_discovery_rp *);
505
506 h = NG_HCI_CON_HANDLE(le16toh(rp->con_handle));
507 con = ng_hci_con_by_handle(unit, h);
508 if (con == NULL) {
509 NG_HCI_ALERT(
510 "%s: %s - invalid connection handle=%d\n",
511 __func__, NG_NODE_NAME(unit->node), h);
512 error = ENOENT;
513 } else if (con->link_type != NG_HCI_LINK_ACL) {
514 NG_HCI_ALERT(
515 "%s: %s - invalid link type=%d\n", __func__, NG_NODE_NAME(unit->node),
516 con->link_type);
517 error = EINVAL;
518 } else
519 con->role = rp->role;
520 } else
521 error = ENOBUFS;
522 } break;
523
524 case NG_HCI_OCF_READ_LINK_POLICY_SETTINGS:
525 case NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS:
526 /* These do not need post processing */
527 break;
528
529 case NG_HCI_OCF_HOLD_MODE:
530 case NG_HCI_OCF_SNIFF_MODE:
531 case NG_HCI_OCF_EXIT_SNIFF_MODE:
532 case NG_HCI_OCF_PARK_MODE:
533 case NG_HCI_OCF_EXIT_PARK_MODE:
534 case NG_HCI_OCF_QOS_SETUP:
535 case NG_HCI_OCF_SWITCH_ROLE:
536 default:
537
538 /*
539 * None of these command was supposed to generate
540 * Command_Complete event. Instead Command_Status event
541 * should have been generated and then appropriate event
542 * should have been sent to indicate the final result.
543 */
544
545 error = EINVAL;
546 break;
547 }
548
549 NG_FREE_M(mcp);
550 NG_FREE_M(mrp);
551
552 return (error);
553 } /* process_link_policy_params */
554
555 /*
556 * Process HC and baseband command return parameters
557 */
558
559 int
process_hc_baseband_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)560 process_hc_baseband_params(ng_hci_unit_p unit, u_int16_t ocf,
561 struct mbuf *mcp, struct mbuf *mrp)
562 {
563 int error = 0;
564
565 switch (ocf) {
566 case NG_HCI_OCF_SET_EVENT_MASK:
567 case NG_HCI_OCF_SET_EVENT_FILTER:
568 case NG_HCI_OCF_FLUSH: /* XXX Do we need to handle that? */
569 case NG_HCI_OCF_READ_PIN_TYPE:
570 case NG_HCI_OCF_WRITE_PIN_TYPE:
571 case NG_HCI_OCF_CREATE_NEW_UNIT_KEY:
572 case NG_HCI_OCF_WRITE_STORED_LINK_KEY:
573 case NG_HCI_OCF_WRITE_CON_ACCEPT_TIMO:
574 case NG_HCI_OCF_WRITE_PAGE_TIMO:
575 case NG_HCI_OCF_READ_SCAN_ENABLE:
576 case NG_HCI_OCF_WRITE_SCAN_ENABLE:
577 case NG_HCI_OCF_WRITE_PAGE_SCAN_ACTIVITY:
578 case NG_HCI_OCF_WRITE_INQUIRY_SCAN_ACTIVITY:
579 case NG_HCI_OCF_READ_AUTH_ENABLE:
580 case NG_HCI_OCF_WRITE_AUTH_ENABLE:
581 case NG_HCI_OCF_READ_ENCRYPTION_MODE:
582 case NG_HCI_OCF_WRITE_ENCRYPTION_MODE:
583 case NG_HCI_OCF_WRITE_VOICE_SETTINGS:
584 case NG_HCI_OCF_READ_NUM_BROADCAST_RETRANS:
585 case NG_HCI_OCF_WRITE_NUM_BROADCAST_RETRANS:
586 case NG_HCI_OCF_READ_HOLD_MODE_ACTIVITY:
587 case NG_HCI_OCF_WRITE_HOLD_MODE_ACTIVITY:
588 case NG_HCI_OCF_READ_SCO_FLOW_CONTROL:
589 case NG_HCI_OCF_WRITE_SCO_FLOW_CONTROL:
590 case NG_HCI_OCF_H2HC_FLOW_CONTROL: /* XXX Not supported this time */
591 case NG_HCI_OCF_HOST_BUFFER_SIZE:
592 case NG_HCI_OCF_READ_IAC_LAP:
593 case NG_HCI_OCF_WRITE_IAC_LAP:
594 case NG_HCI_OCF_READ_PAGE_SCAN_PERIOD:
595 case NG_HCI_OCF_WRITE_PAGE_SCAN_PERIOD:
596 case NG_HCI_OCF_READ_PAGE_SCAN:
597 case NG_HCI_OCF_WRITE_PAGE_SCAN:
598 case NG_HCI_OCF_READ_LINK_SUPERVISION_TIMO:
599 case NG_HCI_OCF_WRITE_LINK_SUPERVISION_TIMO:
600 case NG_HCI_OCF_READ_SUPPORTED_IAC_NUM:
601 case NG_HCI_OCF_READ_STORED_LINK_KEY:
602 case NG_HCI_OCF_DELETE_STORED_LINK_KEY:
603 case NG_HCI_OCF_READ_CON_ACCEPT_TIMO:
604 case NG_HCI_OCF_READ_PAGE_TIMO:
605 case NG_HCI_OCF_READ_PAGE_SCAN_ACTIVITY:
606 case NG_HCI_OCF_READ_INQUIRY_SCAN_ACTIVITY:
607 case NG_HCI_OCF_READ_VOICE_SETTINGS:
608 case NG_HCI_OCF_READ_AUTO_FLUSH_TIMO:
609 case NG_HCI_OCF_WRITE_AUTO_FLUSH_TIMO:
610 case NG_HCI_OCF_READ_XMIT_LEVEL:
611 case NG_HCI_OCF_HOST_NUM_COMPL_PKTS: /* XXX Can get here? */
612 case NG_HCI_OCF_CHANGE_LOCAL_NAME:
613 case NG_HCI_OCF_READ_LOCAL_NAME:
614 case NG_HCI_OCF_READ_UNIT_CLASS:
615 case NG_HCI_OCF_WRITE_UNIT_CLASS:
616 case NG_HCI_OCF_READ_LE_HOST_SUPPORTED:
617 case NG_HCI_OCF_WRITE_LE_HOST_SUPPORTED:
618 /* These do not need post processing */
619 break;
620
621 case NG_HCI_OCF_RESET: {
622 ng_hci_unit_con_p con = NULL;
623 int size;
624
625 /*
626 * XXX
627 *
628 * After RESET command unit goes into standby mode
629 * and all operational state is lost. Host controller
630 * will revert to default values for all parameters.
631 *
632 * For now we shall terminate all connections and drop
633 * inited bit. After RESET unit must be re-initialized.
634 */
635
636 while (!LIST_EMPTY(&unit->con_list)) {
637 con = LIST_FIRST(&unit->con_list);
638
639 /* Remove all timeouts (if any) */
640 if (con->flags & NG_HCI_CON_TIMEOUT_PENDING)
641 ng_hci_con_untimeout(con);
642
643 /* Connection terminated by local host */
644 ng_hci_lp_discon_ind(con, 0x16);
645 ng_hci_free_con(con);
646 }
647
648 NG_HCI_BUFF_ACL_TOTAL(unit->buffer, size);
649 NG_HCI_BUFF_ACL_FREE(unit->buffer, size);
650
651 NG_HCI_BUFF_SCO_TOTAL(unit->buffer, size);
652 NG_HCI_BUFF_SCO_FREE(unit->buffer, size);
653
654 unit->state &= ~NG_HCI_UNIT_INITED;
655 } break;
656
657 default:
658 error = EINVAL;
659 break;
660 }
661
662 NG_FREE_M(mcp);
663 NG_FREE_M(mrp);
664
665 return (error);
666 } /* process_hc_baseband_params */
667
668 /*
669 * Process info command return parameters
670 */
671
672 static int
process_info_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)673 process_info_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
674 struct mbuf *mrp)
675 {
676 int error = 0, len;
677
678 switch (ocf) {
679 case NG_HCI_OCF_READ_LOCAL_VER:
680 case NG_HCI_OCF_READ_COUNTRY_CODE:
681 break;
682
683 case NG_HCI_OCF_READ_LOCAL_FEATURES:
684 m_adj(mrp, sizeof(u_int8_t));
685 len = min(mrp->m_pkthdr.len, sizeof(unit->features));
686 m_copydata(mrp, 0, len, (caddr_t) unit->features);
687 break;
688
689 case NG_HCI_OCF_READ_BUFFER_SIZE: {
690 ng_hci_read_buffer_size_rp *rp = NULL;
691
692 /* Do not update buffer descriptor if node was initialized */
693 if ((unit->state & NG_HCI_UNIT_READY) == NG_HCI_UNIT_READY)
694 break;
695
696 NG_HCI_M_PULLUP(mrp, sizeof(*rp));
697 if (mrp != NULL) {
698 rp = mtod(mrp, ng_hci_read_buffer_size_rp *);
699
700 NG_HCI_BUFF_ACL_SET(
701 unit->buffer,
702 le16toh(rp->num_acl_pkt), /* number */
703 le16toh(rp->max_acl_size), /* size */
704 le16toh(rp->num_acl_pkt) /* free */
705 );
706
707 NG_HCI_BUFF_SCO_SET(
708 unit->buffer,
709 le16toh(rp->num_sco_pkt), /* number */
710 rp->max_sco_size, /* size */
711 le16toh(rp->num_sco_pkt) /* free */
712 );
713
714 /* Let upper layers know */
715 ng_hci_node_is_up(unit->node, unit->acl, NULL, 0);
716 ng_hci_node_is_up(unit->node, unit->sco, NULL, 0);
717 } else
718 error = ENOBUFS;
719 } break;
720
721 case NG_HCI_OCF_READ_BDADDR:
722 /* Do not update BD_ADDR if node was initialized */
723 if ((unit->state & NG_HCI_UNIT_READY) == NG_HCI_UNIT_READY)
724 break;
725
726 m_adj(mrp, sizeof(u_int8_t));
727 len = min(mrp->m_pkthdr.len, sizeof(unit->bdaddr));
728 m_copydata(mrp, 0, len, (caddr_t) &unit->bdaddr);
729
730 /* Let upper layers know */
731 ng_hci_node_is_up(unit->node, unit->acl, NULL, 0);
732 ng_hci_node_is_up(unit->node, unit->sco, NULL, 0);
733 break;
734
735 default:
736 error = EINVAL;
737 break;
738 }
739
740 NG_FREE_M(mcp);
741 NG_FREE_M(mrp);
742
743 return (error);
744 } /* process_info_params */
745
746 /*
747 * Process status command return parameters
748 */
749
750 static int
process_status_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)751 process_status_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
752 struct mbuf *mrp)
753 {
754 int error = 0;
755
756 switch (ocf) {
757 case NG_HCI_OCF_READ_FAILED_CONTACT_CNTR:
758 case NG_HCI_OCF_RESET_FAILED_CONTACT_CNTR:
759 case NG_HCI_OCF_GET_LINK_QUALITY:
760 case NG_HCI_OCF_READ_RSSI:
761 /* These do not need post processing */
762 break;
763
764 default:
765 error = EINVAL;
766 break;
767 }
768
769 NG_FREE_M(mcp);
770 NG_FREE_M(mrp);
771
772 return (error);
773 } /* process_status_params */
774
775 /*
776 * Process testing command return parameters
777 */
778
779 int
process_testing_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)780 process_testing_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
781 struct mbuf *mrp)
782 {
783 int error = 0;
784
785 switch (ocf) {
786
787 /*
788 * XXX FIXME
789 * We do not support these features at this time. However,
790 * HCI node could support this and do something smart. At least
791 * node can change unit state.
792 */
793
794 case NG_HCI_OCF_READ_LOOPBACK_MODE:
795 case NG_HCI_OCF_WRITE_LOOPBACK_MODE:
796 case NG_HCI_OCF_ENABLE_UNIT_UNDER_TEST:
797 break;
798
799 default:
800 error = EINVAL;
801 break;
802 }
803
804 NG_FREE_M(mcp);
805 NG_FREE_M(mrp);
806
807 return (error);
808 } /* process_testing_params */
809
810 /*
811 * Process LE command return parameters
812 */
813
814 static int
process_le_params(ng_hci_unit_p unit,u_int16_t ocf,struct mbuf * mcp,struct mbuf * mrp)815 process_le_params(ng_hci_unit_p unit, u_int16_t ocf,
816 struct mbuf *mcp, struct mbuf *mrp)
817 {
818 int error = 0;
819
820 switch (ocf){
821 case NG_HCI_OCF_LE_SET_EVENT_MASK:
822 case NG_HCI_OCF_LE_READ_BUFFER_SIZE:
823 case NG_HCI_OCF_LE_READ_LOCAL_SUPPORTED_FEATURES:
824 case NG_HCI_OCF_LE_SET_RANDOM_ADDRESS:
825 case NG_HCI_OCF_LE_SET_ADVERTISING_PARAMETERS:
826 case NG_HCI_OCF_LE_READ_ADVERTISING_CHANNEL_TX_POWER:
827 case NG_HCI_OCF_LE_SET_ADVERTISING_DATA:
828 case NG_HCI_OCF_LE_SET_SCAN_RESPONSE_DATA:
829 case NG_HCI_OCF_LE_SET_ADVERTISE_ENABLE:
830 case NG_HCI_OCF_LE_SET_SCAN_PARAMETERS:
831 case NG_HCI_OCF_LE_SET_SCAN_ENABLE:
832 case NG_HCI_OCF_LE_CREATE_CONNECTION_CANCEL:
833 case NG_HCI_OCF_LE_CLEAR_WHITE_LIST:
834 case NG_HCI_OCF_LE_READ_WHITE_LIST_SIZE:
835 case NG_HCI_OCF_LE_ADD_DEVICE_TO_WHITE_LIST:
836 case NG_HCI_OCF_LE_REMOVE_DEVICE_FROM_WHITE_LIST:
837 case NG_HCI_OCF_LE_SET_HOST_CHANNEL_CLASSIFICATION:
838 case NG_HCI_OCF_LE_READ_CHANNEL_MAP:
839 case NG_HCI_OCF_LE_ENCRYPT:
840 case NG_HCI_OCF_LE_RAND:
841 case NG_HCI_OCF_LE_LONG_TERM_KEY_REQUEST_REPLY:
842 case NG_HCI_OCF_LE_LONG_TERM_KEY_REQUEST_NEGATIVE_REPLY:
843 case NG_HCI_OCF_LE_READ_SUPPORTED_STATUS:
844 case NG_HCI_OCF_LE_RECEIVER_TEST:
845 case NG_HCI_OCF_LE_TRANSMITTER_TEST:
846 case NG_HCI_OCF_LE_TEST_END:
847
848 /* These do not need post processing */
849 break;
850 case NG_HCI_OCF_LE_CREATE_CONNECTION:
851 case NG_HCI_OCF_LE_CONNECTION_UPDATE:
852 case NG_HCI_OCF_LE_READ_REMOTE_USED_FEATURES:
853 case NG_HCI_OCF_LE_START_ENCRYPTION:
854
855
856 default:
857 /*
858 * None of these command was supposed to generate
859 * Command_Complete event. Instead Command_Status event
860 * should have been generated and then appropriate event
861 * should have been sent to indicate the final result.
862 */
863
864 error = EINVAL;
865 break;
866 }
867
868 NG_FREE_M(mcp);
869 NG_FREE_M(mrp);
870
871 return (error);
872
873 }
874
875
876
877 static int
process_le_status(ng_hci_unit_p unit,ng_hci_command_status_ep * ep,struct mbuf * mcp)878 process_le_status(ng_hci_unit_p unit,ng_hci_command_status_ep *ep,
879 struct mbuf *mcp)
880 {
881 int error = 0;
882
883 switch (NG_HCI_OCF(ep->opcode)){
884 case NG_HCI_OCF_LE_CREATE_CONNECTION:
885 case NG_HCI_OCF_LE_CONNECTION_UPDATE:
886 case NG_HCI_OCF_LE_READ_REMOTE_USED_FEATURES:
887 case NG_HCI_OCF_LE_START_ENCRYPTION:
888
889 /* These do not need post processing */
890 break;
891
892 case NG_HCI_OCF_LE_SET_EVENT_MASK:
893 case NG_HCI_OCF_LE_READ_BUFFER_SIZE:
894 case NG_HCI_OCF_LE_READ_LOCAL_SUPPORTED_FEATURES:
895 case NG_HCI_OCF_LE_SET_RANDOM_ADDRESS:
896 case NG_HCI_OCF_LE_SET_ADVERTISING_PARAMETERS:
897 case NG_HCI_OCF_LE_READ_ADVERTISING_CHANNEL_TX_POWER:
898 case NG_HCI_OCF_LE_SET_ADVERTISING_DATA:
899 case NG_HCI_OCF_LE_SET_SCAN_RESPONSE_DATA:
900 case NG_HCI_OCF_LE_SET_ADVERTISE_ENABLE:
901 case NG_HCI_OCF_LE_SET_SCAN_PARAMETERS:
902 case NG_HCI_OCF_LE_SET_SCAN_ENABLE:
903 case NG_HCI_OCF_LE_CREATE_CONNECTION_CANCEL:
904 case NG_HCI_OCF_LE_CLEAR_WHITE_LIST:
905 case NG_HCI_OCF_LE_READ_WHITE_LIST_SIZE:
906 case NG_HCI_OCF_LE_ADD_DEVICE_TO_WHITE_LIST:
907 case NG_HCI_OCF_LE_REMOVE_DEVICE_FROM_WHITE_LIST:
908 case NG_HCI_OCF_LE_SET_HOST_CHANNEL_CLASSIFICATION:
909 case NG_HCI_OCF_LE_READ_CHANNEL_MAP:
910 case NG_HCI_OCF_LE_ENCRYPT:
911 case NG_HCI_OCF_LE_RAND:
912 case NG_HCI_OCF_LE_LONG_TERM_KEY_REQUEST_REPLY:
913 case NG_HCI_OCF_LE_LONG_TERM_KEY_REQUEST_NEGATIVE_REPLY:
914 case NG_HCI_OCF_LE_READ_SUPPORTED_STATUS:
915 case NG_HCI_OCF_LE_RECEIVER_TEST:
916 case NG_HCI_OCF_LE_TRANSMITTER_TEST:
917 case NG_HCI_OCF_LE_TEST_END:
918
919
920 default:
921 /*
922 * None of these command was supposed to generate
923 * Command_Stutus event. Command Complete instead.
924 */
925
926 error = EINVAL;
927 break;
928 }
929
930 NG_FREE_M(mcp);
931
932 return (error);
933
934 }
935
936 /*
937 * Process link control command status
938 */
939
940 static int
process_link_control_status(ng_hci_unit_p unit,ng_hci_command_status_ep * ep,struct mbuf * mcp)941 process_link_control_status(ng_hci_unit_p unit, ng_hci_command_status_ep *ep,
942 struct mbuf *mcp)
943 {
944 int error = 0;
945
946 switch (NG_HCI_OCF(ep->opcode)) {
947 case NG_HCI_OCF_INQUIRY:
948 case NG_HCI_OCF_DISCON: /* XXX */
949 case NG_HCI_OCF_REJECT_CON: /* XXX */
950 case NG_HCI_OCF_CHANGE_CON_PKT_TYPE:
951 case NG_HCI_OCF_AUTH_REQ:
952 case NG_HCI_OCF_SET_CON_ENCRYPTION:
953 case NG_HCI_OCF_CHANGE_CON_LINK_KEY:
954 case NG_HCI_OCF_MASTER_LINK_KEY:
955 case NG_HCI_OCF_REMOTE_NAME_REQ:
956 case NG_HCI_OCF_READ_REMOTE_FEATURES:
957 case NG_HCI_OCF_READ_REMOTE_VER_INFO:
958 case NG_HCI_OCF_READ_CLOCK_OFFSET:
959 /* These do not need post processing */
960 break;
961
962 case NG_HCI_OCF_CREATE_CON:
963 break;
964
965 case NG_HCI_OCF_ADD_SCO_CON:
966 break;
967
968 case NG_HCI_OCF_ACCEPT_CON:
969 break;
970
971 case NG_HCI_OCF_INQUIRY_CANCEL:
972 case NG_HCI_OCF_PERIODIC_INQUIRY:
973 case NG_HCI_OCF_EXIT_PERIODIC_INQUIRY:
974 case NG_HCI_OCF_LINK_KEY_REP:
975 case NG_HCI_OCF_LINK_KEY_NEG_REP:
976 case NG_HCI_OCF_PIN_CODE_REP:
977 case NG_HCI_OCF_PIN_CODE_NEG_REP:
978 default:
979
980 /*
981 * None of these command was supposed to generate
982 * Command_Status event. Instead Command_Complete event
983 * should have been sent.
984 */
985
986 error = EINVAL;
987 break;
988 }
989
990 NG_FREE_M(mcp);
991
992 return (error);
993 } /* process_link_control_status */
994
995 /*
996 * Process link policy command status
997 */
998
999 static int
process_link_policy_status(ng_hci_unit_p unit,ng_hci_command_status_ep * ep,struct mbuf * mcp)1000 process_link_policy_status(ng_hci_unit_p unit, ng_hci_command_status_ep *ep,
1001 struct mbuf *mcp)
1002 {
1003 int error = 0;
1004
1005 switch (NG_HCI_OCF(ep->opcode)) {
1006 case NG_HCI_OCF_HOLD_MODE:
1007 case NG_HCI_OCF_SNIFF_MODE:
1008 case NG_HCI_OCF_EXIT_SNIFF_MODE:
1009 case NG_HCI_OCF_PARK_MODE:
1010 case NG_HCI_OCF_EXIT_PARK_MODE:
1011 case NG_HCI_OCF_SWITCH_ROLE:
1012 /* These do not need post processing */
1013 break;
1014
1015 case NG_HCI_OCF_QOS_SETUP:
1016 break;
1017
1018 case NG_HCI_OCF_ROLE_DISCOVERY:
1019 case NG_HCI_OCF_READ_LINK_POLICY_SETTINGS:
1020 case NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS:
1021 default:
1022
1023 /*
1024 * None of these command was supposed to generate
1025 * Command_Status event. Instead Command_Complete event
1026 * should have been sent.
1027 */
1028
1029 error = EINVAL;
1030 break;
1031 }
1032
1033 NG_FREE_M(mcp);
1034
1035 return (error);
1036 } /* process_link_policy_status */
1037
1038