diff options
Diffstat (limited to 'sys/netgraph/bluetooth/hci/ng_hci_cmds.c')
-rw-r--r-- | sys/netgraph/bluetooth/hci/ng_hci_cmds.c | 887 |
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 */ + |