summaryrefslogtreecommitdiffstats
path: root/sys/netgraph/bluetooth/hci/ng_hci_cmds.c
diff options
context:
space:
mode:
Diffstat (limited to 'sys/netgraph/bluetooth/hci/ng_hci_cmds.c')
-rw-r--r--sys/netgraph/bluetooth/hci/ng_hci_cmds.c887
1 files changed, 887 insertions, 0 deletions
diff --git a/sys/netgraph/bluetooth/hci/ng_hci_cmds.c b/sys/netgraph/bluetooth/hci/ng_hci_cmds.c
new file mode 100644
index 0000000..5769ee5
--- /dev/null
+++ b/sys/netgraph/bluetooth/hci/ng_hci_cmds.c
@@ -0,0 +1,887 @@
+/*
+ * ng_hci_cmds.c
+ *
+ * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ * notice, this list of conditions and the following disclaimer in the
+ * documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
+ * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
+ * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+ * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
+ * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
+ * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
+ * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ * $Id: ng_hci_cmds.c,v 1.22 2002/10/30 00:18:18 max Exp $
+ * $FreeBSD$
+ */
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/endian.h>
+#include <sys/malloc.h>
+#include <sys/mbuf.h>
+#include <sys/queue.h>
+#include <netgraph/ng_message.h>
+#include <netgraph/netgraph.h>
+#include "ng_bluetooth.h"
+#include "ng_hci.h"
+#include "ng_hci_var.h"
+#include "ng_hci_cmds.h"
+#include "ng_hci_evnt.h"
+#include "ng_hci_ulpi.h"
+#include "ng_hci_misc.h"
+
+/******************************************************************************
+ ******************************************************************************
+ ** HCI commands processing module
+ ******************************************************************************
+ ******************************************************************************/
+
+#undef min
+#define min(a, b) ((a) < (b))? (a) : (b)
+
+static int complete_command (ng_hci_unit_p, int, struct mbuf **);
+
+static int process_link_control_params
+ (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
+static int process_link_policy_params
+ (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
+static int process_hc_baseband_params
+ (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
+static int process_info_params
+ (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
+static int process_status_params
+ (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
+static int process_testing_params
+ (ng_hci_unit_p, u_int16_t, struct mbuf *, struct mbuf *);
+
+static int process_link_control_status
+ (ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
+static int process_link_policy_status
+ (ng_hci_unit_p, ng_hci_command_status_ep *, struct mbuf *);
+
+/*
+ * Send HCI command to the driver.
+ */
+
+int
+ng_hci_send_command(ng_hci_unit_p unit)
+{
+ struct mbuf *m0 = NULL, *m = NULL;
+ int free, error = 0;
+
+ /* Check if other command is pending */
+ if (unit->state & NG_HCI_UNIT_COMMAND_PENDING)
+ return (0);
+
+ /* Check if unit can accept our command */
+ NG_HCI_BUFF_CMD_GET(unit->buffer, free);
+ if (free == 0)
+ return (0);
+
+ /* Check if driver hook is still ok */
+ if (unit->drv == NULL || NG_HOOK_NOT_VALID(unit->drv)) {
+ NG_HCI_WARN(
+"%s: %s - hook \"%s\" is not connected or valid\n",
+ __func__, NG_NODE_NAME(unit->node), NG_HCI_HOOK_DRV);
+
+ NG_BT_MBUFQ_DRAIN(&unit->cmdq);
+
+ return (ENOTCONN);
+ }
+
+ /*
+ * Get first command from queue, give it to RAW hook then
+ * make copy of it and send it to the driver
+ */
+
+ m0 = NG_BT_MBUFQ_FIRST(&unit->cmdq);
+ if (m0 == NULL)
+ return (0);
+
+ ng_hci_mtap(unit, m0);
+
+ m = m_dup(m0, M_DONTWAIT);
+ if (m != NULL)
+ NG_SEND_DATA_ONLY(error, unit->drv, m);
+ else
+ error = ENOBUFS;
+
+ if (error != 0)
+ NG_HCI_ERR(
+"%s: %s - could not send HCI command, error=%d\n",
+ __func__, NG_NODE_NAME(unit->node), error);
+
+ /*
+ * Even if we were not able to send command we still pretend
+ * that everything is OK and let timeout handle that.
+ */
+
+ NG_HCI_BUFF_CMD_USE(unit->buffer, 1);
+ NG_HCI_STAT_CMD_SENT(unit->stat);
+ NG_HCI_STAT_BYTES_SENT(unit->stat, m0->m_pkthdr.len);
+
+ /*
+ * Note: ng_hci_command_timeout() will set
+ * NG_HCI_UNIT_COMMAND_PENDING flag
+ */
+
+ ng_hci_command_timeout(unit);
+
+ return (0);
+} /* ng_hci_send_command */
+
+/*
+ * Process HCI Command_Compete event. Complete HCI command, and do post
+ * processing on the command parameters (cp) and command return parameters
+ * (e) if required (for example adjust state).
+ */
+
+int
+ng_hci_process_command_complete(ng_hci_unit_p unit, struct mbuf *e)
+{
+ ng_hci_command_compl_ep *ep = NULL;
+ struct mbuf *cp = NULL;
+ int error = 0;
+
+ /* Get event packet and update command buffer info */
+ NG_HCI_M_PULLUP(e, sizeof(*ep));
+ if (e == NULL)
+ return (ENOBUFS); /* XXX this is bad */
+
+ ep = mtod(e, ng_hci_command_compl_ep *);
+ NG_HCI_BUFF_CMD_SET(unit->buffer, ep->num_cmd_pkts);
+
+ /* Check for special NOOP command */
+ if (ep->opcode == 0x0000) {
+ NG_FREE_M(e);
+ goto out;
+ }
+
+ /* Try to match first command item in the queue */
+ error = complete_command(unit, ep->opcode, &cp);
+ if (error != 0) {
+ NG_FREE_M(e);
+ goto out;
+ }
+
+ /*
+ * Perform post processing on command parameters and return parameters
+ * do it only if status is OK (status == 0). Status is the first byte
+ * of any command return parameters.
+ */
+
+ ep->opcode = le16toh(ep->opcode);
+ m_adj(e, sizeof(*ep));
+
+ if (*mtod(e, u_int8_t *) == 0) { /* XXX m_pullup here? */
+ switch (NG_HCI_OGF(ep->opcode)) {
+ case NG_HCI_OGF_LINK_CONTROL:
+ error = process_link_control_params(unit,
+ NG_HCI_OCF(ep->opcode), cp, e);
+ break;
+
+ case NG_HCI_OGF_LINK_POLICY:
+ error = process_link_policy_params(unit,
+ NG_HCI_OCF(ep->opcode), cp, e);
+ break;
+
+ case NG_HCI_OGF_HC_BASEBAND:
+ error = process_hc_baseband_params(unit,
+ NG_HCI_OCF(ep->opcode), cp, e);
+ break;
+
+ case NG_HCI_OGF_INFO:
+ error = process_info_params(unit,
+ NG_HCI_OCF(ep->opcode), cp, e);
+ break;
+
+ case NG_HCI_OGF_STATUS:
+ error = process_status_params(unit,
+ NG_HCI_OCF(ep->opcode), cp, e);
+ break;
+
+ case NG_HCI_OGF_TESTING:
+ error = process_testing_params(unit,
+ NG_HCI_OCF(ep->opcode), cp, e);
+ break;
+
+ case NG_HCI_OGF_BT_LOGO:
+ case NG_HCI_OGF_VENDOR:
+ NG_FREE_M(cp);
+ NG_FREE_M(e);
+ break;
+
+ default:
+ NG_FREE_M(cp);
+ NG_FREE_M(e);
+ error = EINVAL;
+ break;
+ }
+ } else {
+ NG_HCI_ERR(
+"%s: %s - HCI command failed, OGF=%#x, OCF=%#x, status=%#x\n",
+ __func__, NG_NODE_NAME(unit->node),
+ NG_HCI_OGF(ep->opcode), NG_HCI_OCF(ep->opcode),
+ *mtod(e, u_int8_t *));
+
+ NG_FREE_M(cp);
+ NG_FREE_M(e);
+ }
+out:
+ ng_hci_send_command(unit);
+
+ return (error);
+} /* ng_hci_process_command_complete */
+
+/*
+ * Process HCI Command_Status event. Check the status (mst) and do post
+ * processing (if required).
+ */
+
+int
+ng_hci_process_command_status(ng_hci_unit_p unit, struct mbuf *e)
+{
+ ng_hci_command_status_ep *ep = NULL;
+ struct mbuf *cp = NULL;
+ int error = 0;
+
+ /* Update command buffer info */
+ NG_HCI_M_PULLUP(e, sizeof(*ep));
+ if (e == NULL)
+ return (ENOBUFS); /* XXX this is bad */
+
+ ep = mtod(e, ng_hci_command_status_ep *);
+ NG_HCI_BUFF_CMD_SET(unit->buffer, ep->num_cmd_pkts);
+
+ /* Check for special NOOP command */
+ if (ep->opcode == 0x0000)
+ goto out;
+
+ /* Try to match first command item in the queue */
+ error = complete_command(unit, ep->opcode, &cp);
+ if (error != 0)
+ goto out;
+
+ /*
+ * Perform post processing on HCI Command_Status event
+ */
+
+ ep->opcode = le16toh(ep->opcode);
+
+ switch (NG_HCI_OGF(ep->opcode)) {
+ case NG_HCI_OGF_LINK_CONTROL:
+ error = process_link_control_status(unit, ep, cp);
+ break;
+
+ case NG_HCI_OGF_LINK_POLICY:
+ error = process_link_policy_status(unit, ep, cp);
+ break;
+
+ case NG_HCI_OGF_BT_LOGO:
+ case NG_HCI_OGF_VENDOR:
+ NG_FREE_M(cp);
+ break;
+
+ case NG_HCI_OGF_HC_BASEBAND:
+ case NG_HCI_OGF_INFO:
+ case NG_HCI_OGF_STATUS:
+ case NG_HCI_OGF_TESTING:
+ default:
+ NG_FREE_M(cp);
+ error = EINVAL;
+ break;
+ }
+out:
+ NG_FREE_M(e);
+ ng_hci_send_command(unit);
+
+ return (error);
+} /* ng_hci_process_command_status */
+
+/*
+ * Complete queued HCI command.
+ */
+
+static int
+complete_command(ng_hci_unit_p unit, int opcode, struct mbuf **cp)
+{
+ struct mbuf *m = NULL;
+
+ /* Check unit state */
+ if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING)) {
+ NG_HCI_ALERT(
+"%s: %s - no pending command, state=%#x\n",
+ __func__, NG_NODE_NAME(unit->node), unit->state);
+
+ return (EINVAL);
+ }
+
+ /* Get first command in the queue */
+ m = NG_BT_MBUFQ_FIRST(&unit->cmdq);
+ if (m == NULL) {
+ NG_HCI_ALERT(
+"%s: %s - empty command queue?!\n", __func__, NG_NODE_NAME(unit->node));
+
+ return (EINVAL);
+ }
+
+ /*
+ * Match command opcode, if does not match - do nothing and
+ * let timeout handle that.
+ */
+
+ if (mtod(m, ng_hci_cmd_pkt_t *)->opcode != opcode) {
+ NG_HCI_ALERT(
+"%s: %s - command queue is out of sync\n", __func__, NG_NODE_NAME(unit->node));
+
+ return (EINVAL);
+ }
+
+ /*
+ * Now we can remove command timeout, dequeue completed command
+ * and return command parameters. Note: ng_hci_command_untimeout()
+ * will drop NG_HCI_UNIT_COMMAND_PENDING flag.
+ */
+
+ ng_hci_command_untimeout(unit);
+ NG_BT_MBUFQ_DEQUEUE(&unit->cmdq, *cp);
+ m_adj(*cp, sizeof(ng_hci_cmd_pkt_t));
+
+ return (0);
+} /* complete_command */
+
+/*
+ * Process HCI command timeout
+ */
+
+void
+ng_hci_process_command_timeout(node_p node, hook_p hook, void *arg1, int arg2)
+{
+ ng_hci_unit_p unit = (ng_hci_unit_p) arg1;
+ struct mbuf *m = NULL;
+ u_int16_t opcode;
+
+ if (unit->state & NG_HCI_UNIT_COMMAND_PENDING) {
+ NG_BT_MBUFQ_DEQUEUE(&unit->cmdq, m);
+
+ if (m == NULL) {
+ KASSERT(0,
+("%s: %s - command queue is out of sync!\n",
+ __func__, NG_NODE_NAME(unit->node)));
+
+ return;
+ }
+
+ opcode = le16toh(mtod(m, ng_hci_cmd_pkt_t *)->opcode);
+ NG_FREE_M(m);
+
+ NG_HCI_ERR(
+"%s: %s - unable to complete HCI command OGF=%#x, OCF=%#x. Timeout\n",
+ __func__, NG_NODE_NAME(unit->node), NG_HCI_OGF(opcode),
+ NG_HCI_OCF(opcode));
+
+ /*
+ * Try to send more commands
+ */
+
+ NG_HCI_BUFF_CMD_SET(unit->buffer, 1);
+
+ unit->state &= ~NG_HCI_UNIT_COMMAND_PENDING;
+ ng_hci_send_command(unit);
+ } else
+ KASSERT(0,
+("%s: %s - no pending command, state=%#x\n",
+ __func__, NG_NODE_NAME(unit->node), unit->state));
+} /* ng_hci_process_command_timeout */
+
+/*
+ * Process link command return parameters
+ */
+
+static int
+process_link_control_params(ng_hci_unit_p unit, u_int16_t ocf,
+ struct mbuf *mcp, struct mbuf *mrp)
+{
+ int error = 0;
+
+ switch (ocf) {
+ case NG_HCI_OCF_INQUIRY_CANCEL:
+ case NG_HCI_OCF_PERIODIC_INQUIRY:
+ case NG_HCI_OCF_EXIT_PERIODIC_INQUIRY:
+ case NG_HCI_OCF_LINK_KEY_REP:
+ case NG_HCI_OCF_LINK_KEY_NEG_REP:
+ case NG_HCI_OCF_PIN_CODE_REP:
+ case NG_HCI_OCF_PIN_CODE_NEG_REP:
+ /* These do not need post processing */
+ break;
+
+ case NG_HCI_OCF_INQUIRY:
+ case NG_HCI_OCF_CREATE_CON:
+ case NG_HCI_OCF_DISCON:
+ case NG_HCI_OCF_ADD_SCO_CON:
+ case NG_HCI_OCF_ACCEPT_CON:
+ case NG_HCI_OCF_REJECT_CON:
+ case NG_HCI_OCF_CHANGE_CON_PKT_TYPE:
+ case NG_HCI_OCF_AUTH_REQ:
+ case NG_HCI_OCF_SET_CON_ENCRYPTION:
+ case NG_HCI_OCF_CHANGE_CON_LINK_KEY:
+ case NG_HCI_OCF_MASTER_LINK_KEY:
+ case NG_HCI_OCF_REMOTE_NAME_REQ:
+ case NG_HCI_OCF_READ_REMOTE_FEATURES:
+ case NG_HCI_OCF_READ_REMOTE_VER_INFO:
+ case NG_HCI_OCF_READ_CLOCK_OFFSET:
+ default:
+
+ /*
+ * None of these command was supposed to generate
+ * Command_Complete event. Instead Command_Status event
+ * should have been generated and then appropriate event
+ * should have been sent to indicate the final result.
+ */
+
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+ NG_FREE_M(mrp);
+
+ return (error);
+} /* process_link_control_params */
+
+/*
+ * Process link policy command return parameters
+ */
+
+static int
+process_link_policy_params(ng_hci_unit_p unit, u_int16_t ocf,
+ struct mbuf *mcp, struct mbuf *mrp)
+{
+ int error = 0;
+
+ switch (ocf){
+ case NG_HCI_OCF_ROLE_DISCOVERY: {
+ ng_hci_role_discovery_rp *rp = NULL;
+ ng_hci_unit_con_t *con = NULL;
+ u_int16_t h;
+
+ NG_HCI_M_PULLUP(mrp, sizeof(*rp));
+ if (mrp != NULL) {
+ rp = mtod(mrp, ng_hci_role_discovery_rp *);
+
+ h = NG_HCI_CON_HANDLE(le16toh(rp->con_handle));
+ con = ng_hci_con_by_handle(unit, h);
+ if (con == NULL) {
+ NG_HCI_ALERT(
+"%s: %s - invalid connection handle=%d\n",
+ __func__, NG_NODE_NAME(unit->node), h);
+ error = ENOENT;
+ } else if (con->link_type != NG_HCI_LINK_ACL) {
+ NG_HCI_ALERT(
+"%s: %s - invalid link type=%d\n", __func__, NG_NODE_NAME(unit->node),
+ con->link_type);
+ error = EINVAL;
+ } else
+ con->role = rp->role;
+ } else
+ error = ENOBUFS;
+ } break;
+
+ case NG_HCI_OCF_READ_LINK_POLICY_SETTINGS:
+ case NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS:
+ /* These do not need post processing */
+ break;
+
+ case NG_HCI_OCF_HOLD_MODE:
+ case NG_HCI_OCF_SNIFF_MODE:
+ case NG_HCI_OCF_EXIT_SNIFF_MODE:
+ case NG_HCI_OCF_PARK_MODE:
+ case NG_HCI_OCF_EXIT_PARK_MODE:
+ case NG_HCI_OCF_QOS_SETUP:
+ case NG_HCI_OCF_SWITCH_ROLE:
+ default:
+
+ /*
+ * None of these command was supposed to generate
+ * Command_Complete event. Instead Command_Status event
+ * should have been generated and then appropriate event
+ * should have been sent to indicate the final result.
+ */
+
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+ NG_FREE_M(mrp);
+
+ return (error);
+} /* process_link_policy_params */
+
+/*
+ * Process HC and baseband command return parameters
+ */
+
+int
+process_hc_baseband_params(ng_hci_unit_p unit, u_int16_t ocf,
+ struct mbuf *mcp, struct mbuf *mrp)
+{
+ int error = 0;
+
+ switch (ocf) {
+ case NG_HCI_OCF_SET_EVENT_MASK:
+ case NG_HCI_OCF_SET_EVENT_FILTER:
+ case NG_HCI_OCF_FLUSH: /* XXX Do we need to handle that? */
+ case NG_HCI_OCF_READ_PIN_TYPE:
+ case NG_HCI_OCF_WRITE_PIN_TYPE:
+ case NG_HCI_OCF_CREATE_NEW_UNIT_KEY:
+ case NG_HCI_OCF_WRITE_STORED_LINK_KEY:
+ case NG_HCI_OCF_WRITE_CON_ACCEPT_TIMO:
+ case NG_HCI_OCF_WRITE_PAGE_TIMO:
+ case NG_HCI_OCF_READ_SCAN_ENABLE:
+ case NG_HCI_OCF_WRITE_SCAN_ENABLE:
+ case NG_HCI_OCF_WRITE_PAGE_SCAN_ACTIVITY:
+ case NG_HCI_OCF_WRITE_INQUIRY_SCAN_ACTIVITY:
+ case NG_HCI_OCF_READ_AUTH_ENABLE:
+ case NG_HCI_OCF_WRITE_AUTH_ENABLE:
+ case NG_HCI_OCF_READ_ENCRYPTION_MODE:
+ case NG_HCI_OCF_WRITE_ENCRYPTION_MODE:
+ case NG_HCI_OCF_WRITE_VOICE_SETTINGS:
+ case NG_HCI_OCF_READ_NUM_BROADCAST_RETRANS:
+ case NG_HCI_OCF_WRITE_NUM_BROADCAST_RETRANS:
+ case NG_HCI_OCF_READ_HOLD_MODE_ACTIVITY:
+ case NG_HCI_OCF_WRITE_HOLD_MODE_ACTIVITY:
+ case NG_HCI_OCF_READ_SCO_FLOW_CONTROL:
+ case NG_HCI_OCF_WRITE_SCO_FLOW_CONTROL:
+ case NG_HCI_OCF_H2HC_FLOW_CONTROL: /* XXX Not supported this time */
+ case NG_HCI_OCF_HOST_BUFFER_SIZE:
+ case NG_HCI_OCF_READ_IAC_LAP:
+ case NG_HCI_OCF_WRITE_IAC_LAP:
+ case NG_HCI_OCF_READ_PAGE_SCAN_PERIOD:
+ case NG_HCI_OCF_WRITE_PAGE_SCAN_PERIOD:
+ case NG_HCI_OCF_READ_PAGE_SCAN:
+ case NG_HCI_OCF_WRITE_PAGE_SCAN:
+ case NG_HCI_OCF_READ_LINK_SUPERVISION_TIMO:
+ case NG_HCI_OCF_WRITE_LINK_SUPERVISION_TIMO:
+ case NG_HCI_OCF_READ_SUPPORTED_IAC_NUM:
+ case NG_HCI_OCF_READ_STORED_LINK_KEY:
+ case NG_HCI_OCF_DELETE_STORED_LINK_KEY:
+ case NG_HCI_OCF_READ_CON_ACCEPT_TIMO:
+ case NG_HCI_OCF_READ_PAGE_TIMO:
+ case NG_HCI_OCF_READ_PAGE_SCAN_ACTIVITY:
+ case NG_HCI_OCF_READ_INQUIRY_SCAN_ACTIVITY:
+ case NG_HCI_OCF_READ_VOICE_SETTINGS:
+ case NG_HCI_OCF_READ_AUTO_FLUSH_TIMO:
+ case NG_HCI_OCF_WRITE_AUTO_FLUSH_TIMO:
+ case NG_HCI_OCF_READ_XMIT_LEVEL:
+ case NG_HCI_OCF_HOST_NUM_COMPL_PKTS: /* XXX Can get here? */
+ case NG_HCI_OCF_CHANGE_LOCAL_NAME:
+ case NG_HCI_OCF_READ_LOCAL_NAME:
+ case NG_HCI_OCF_READ_UNIT_CLASS:
+ case NG_HCI_OCF_WRITE_UNIT_CLASS:
+ /* These do not need post processing */
+ break;
+
+ case NG_HCI_OCF_RESET: {
+ ng_hci_unit_con_p con = NULL;
+ int size;
+
+ /*
+ * XXX
+ *
+ * After RESET command unit goes into standby mode
+ * and all operational state is lost. Host controller
+ * will revert to default values for all parameters.
+ *
+ * For now we shall terminate all connections and drop
+ * inited bit. After RESET unit must be re-initialized.
+ */
+
+ while (!LIST_EMPTY(&unit->con_list)) {
+ con = LIST_FIRST(&unit->con_list);
+
+ /* Connection terminated by local host */
+ ng_hci_lp_discon_ind(con, 0x16);
+ ng_hci_free_con(con);
+ }
+
+ NG_HCI_BUFF_ACL_TOTAL(unit->buffer, size);
+ NG_HCI_BUFF_ACL_FREE(unit->buffer, size);
+
+ NG_HCI_BUFF_SCO_TOTAL(unit->buffer, size);
+ NG_HCI_BUFF_SCO_FREE(unit->buffer, size);
+
+ unit->state &= ~NG_HCI_UNIT_INITED;
+ } break;
+
+ default:
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+ NG_FREE_M(mrp);
+
+ return (error);
+} /* process_hc_baseband_params */
+
+/*
+ * Process info command return parameters
+ */
+
+static int
+process_info_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
+ struct mbuf *mrp)
+{
+ int error = 0, len;
+
+ switch (ocf) {
+ case NG_HCI_OCF_READ_LOCAL_VER:
+ case NG_HCI_OCF_READ_COUNTRY_CODE:
+ break;
+
+ case NG_HCI_OCF_READ_LOCAL_FEATURES:
+ m_adj(mrp, sizeof(u_int8_t));
+ len = min(mrp->m_pkthdr.len, sizeof(unit->features));
+ m_copydata(mrp, 0, len, (caddr_t) unit->features);
+ break;
+
+ case NG_HCI_OCF_READ_BUFFER_SIZE: {
+ ng_hci_read_buffer_size_rp *rp = NULL;
+
+ /* Do not update buffer descriptor if node was initialized */
+ if ((unit->state & NG_HCI_UNIT_READY) == NG_HCI_UNIT_READY)
+ break;
+
+ NG_HCI_M_PULLUP(mrp, sizeof(*rp));
+ if (mrp != NULL) {
+ rp = mtod(mrp, ng_hci_read_buffer_size_rp *);
+
+ NG_HCI_BUFF_ACL_SET(
+ unit->buffer,
+ le16toh(rp->num_acl_pkt), /* number */
+ le16toh(rp->max_acl_size), /* size */
+ le16toh(rp->num_acl_pkt) /* free */
+ );
+
+ NG_HCI_BUFF_SCO_SET(
+ unit->buffer,
+ le16toh(rp->num_sco_pkt), /* number */
+ rp->max_sco_size, /* size */
+ le16toh(rp->num_sco_pkt) /* free */
+ );
+
+ /* Let upper layers know */
+ ng_hci_node_is_up(unit->node, unit->acl, NULL, 0);
+ ng_hci_node_is_up(unit->node, unit->sco, NULL, 0);
+ } else
+ error = ENOBUFS;
+ } break;
+
+ case NG_HCI_OCF_READ_BDADDR:
+ /* Do not update BD_ADDR if node was initialized */
+ if ((unit->state & NG_HCI_UNIT_READY) == NG_HCI_UNIT_READY)
+ break;
+
+ m_adj(mrp, sizeof(u_int8_t));
+ len = min(mrp->m_pkthdr.len, sizeof(unit->bdaddr));
+ m_copydata(mrp, 0, len, (caddr_t) &unit->bdaddr);
+
+ /* Let upper layers know */
+ ng_hci_node_is_up(unit->node, unit->acl, NULL, 0);
+ ng_hci_node_is_up(unit->node, unit->sco, NULL, 0);
+ break;
+
+ default:
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+ NG_FREE_M(mrp);
+
+ return (error);
+} /* process_info_params */
+
+/*
+ * Process status command return parameters
+ */
+
+static int
+process_status_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
+ struct mbuf *mrp)
+{
+ int error = 0;
+
+ switch (ocf) {
+ case NG_HCI_OCF_READ_FAILED_CONTACT_CNTR:
+ case NG_HCI_OCF_RESET_FAILED_CONTACT_CNTR:
+ case NG_HCI_OCF_GET_LINK_QUALITY:
+ case NG_HCI_OCF_READ_RSSI:
+ /* These do not need post processing */
+ break;
+
+ default:
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+ NG_FREE_M(mrp);
+
+ return (error);
+} /* process_status_params */
+
+/*
+ * Process testing command return parameters
+ */
+
+int
+process_testing_params(ng_hci_unit_p unit, u_int16_t ocf, struct mbuf *mcp,
+ struct mbuf *mrp)
+{
+ int error = 0;
+
+ switch (ocf) {
+
+ /*
+ * XXX FIXME
+ * We do not support these features at this time. However,
+ * HCI node could support this and do something smart. At least
+ * node can change unit state.
+ */
+
+ case NG_HCI_OCF_READ_LOOPBACK_MODE:
+ case NG_HCI_OCF_WRITE_LOOPBACK_MODE:
+ case NG_HCI_OCF_ENABLE_UNIT_UNDER_TEST:
+ break;
+
+ default:
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+ NG_FREE_M(mrp);
+
+ return (error);
+} /* process_testing_params */
+
+/*
+ * Process link control command status
+ */
+
+static int
+process_link_control_status(ng_hci_unit_p unit, ng_hci_command_status_ep *ep,
+ struct mbuf *mcp)
+{
+ int error = 0;
+
+ switch (NG_HCI_OCF(ep->opcode)) {
+ case NG_HCI_OCF_INQUIRY:
+ case NG_HCI_OCF_DISCON: /* XXX */
+ case NG_HCI_OCF_REJECT_CON: /* XXX */
+ case NG_HCI_OCF_CHANGE_CON_PKT_TYPE:
+ case NG_HCI_OCF_AUTH_REQ:
+ case NG_HCI_OCF_SET_CON_ENCRYPTION:
+ case NG_HCI_OCF_CHANGE_CON_LINK_KEY:
+ case NG_HCI_OCF_MASTER_LINK_KEY:
+ case NG_HCI_OCF_REMOTE_NAME_REQ:
+ case NG_HCI_OCF_READ_REMOTE_FEATURES:
+ case NG_HCI_OCF_READ_REMOTE_VER_INFO:
+ case NG_HCI_OCF_READ_CLOCK_OFFSET:
+ /* These do not need post processing */
+ break;
+
+ case NG_HCI_OCF_CREATE_CON:
+ break;
+
+ case NG_HCI_OCF_ADD_SCO_CON:
+ break;
+
+ case NG_HCI_OCF_ACCEPT_CON:
+ break;
+
+ case NG_HCI_OCF_INQUIRY_CANCEL:
+ case NG_HCI_OCF_PERIODIC_INQUIRY:
+ case NG_HCI_OCF_EXIT_PERIODIC_INQUIRY:
+ case NG_HCI_OCF_LINK_KEY_REP:
+ case NG_HCI_OCF_LINK_KEY_NEG_REP:
+ case NG_HCI_OCF_PIN_CODE_REP:
+ case NG_HCI_OCF_PIN_CODE_NEG_REP:
+ default:
+
+ /*
+ * None of these command was supposed to generate
+ * Command_Status event. Instead Command_Complete event
+ * should have been sent.
+ */
+
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+
+ return (error);
+} /* process_link_control_status */
+
+/*
+ * Process link policy command status
+ */
+
+static int
+process_link_policy_status(ng_hci_unit_p unit, ng_hci_command_status_ep *ep,
+ struct mbuf *mcp)
+{
+ int error = 0;
+
+ switch (NG_HCI_OCF(ep->opcode)) {
+ case NG_HCI_OCF_HOLD_MODE:
+ case NG_HCI_OCF_SNIFF_MODE:
+ case NG_HCI_OCF_EXIT_SNIFF_MODE:
+ case NG_HCI_OCF_PARK_MODE:
+ case NG_HCI_OCF_EXIT_PARK_MODE:
+ case NG_HCI_OCF_SWITCH_ROLE:
+ /* These do not need post processing */
+ break;
+
+ case NG_HCI_OCF_QOS_SETUP:
+ break;
+
+ case NG_HCI_OCF_ROLE_DISCOVERY:
+ case NG_HCI_OCF_READ_LINK_POLICY_SETTINGS:
+ case NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS:
+ default:
+
+ /*
+ * None of these command was supposed to generate
+ * Command_Status event. Instead Command_Complete event
+ * should have been sent.
+ */
+
+ error = EINVAL;
+ break;
+ }
+
+ NG_FREE_M(mcp);
+
+ return (error);
+} /* process_link_policy_status */
+
OpenPOWER on IntegriCloud