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 60static int complete_command (ng_hci_unit_p, int, struct mbuf **); 61 62static int process_link_control_params 63 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *); 64static int process_link_policy_params 65 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *); 66static int process_hc_baseband_params 67 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *); 68static int process_info_params 69 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *); 70static int process_status_params 71 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *); 72static int process_testing_params 73 (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *); 74 75static int process_link_control_status 76 (ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *); 77static 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 84int 85ng_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_NOWAIT); 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 157int 158ng_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 } 248out: 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 259int 260ng_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 } 312out: 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 323static int 324complete_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 381void 382ng_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 426static int 427process_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 481static int 482process_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 550int 551process_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 661static int 662process_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 739static int 740process_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 768int 769process_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 803static int 804process_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 862static int 863process_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