sys/netgraph/bluetooth/hci/ng_hci_cmds.c

   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
  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
 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
 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
 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 already 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
 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
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