sys/netgraph/bluetooth/hci/ng_hci_cmds.c

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