Snapshot 7ddd630e136a035ba463c427285c5c3e9f199ee0
Change-Id: If08c7b905da667dd9e5110231e4592842b634006
diff --git a/src/nfa/hci/nfa_hci_act.c b/src/nfa/hci/nfa_hci_act.c
new file mode 100644
index 0000000..f89061c
--- /dev/null
+++ b/src/nfa/hci/nfa_hci_act.c
@@ -0,0 +1,2054 @@
+/******************************************************************************
+ *
+ * Copyright (C) 2010-2012 Broadcom Corporation
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at:
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ ******************************************************************************/
+
+/******************************************************************************
+ *
+ * This file contains the action functions for the NFA HCI.
+ *
+ ******************************************************************************/
+#include <string.h>
+#include "trace_api.h"
+#include "nfc_api.h"
+#include "nfa_sys.h"
+#include "nfa_sys_int.h"
+#include "nfa_hci_api.h"
+#include "nfa_hci_int.h"
+#include "nfa_nv_co.h"
+#include "nfa_mem_co.h"
+#include "nfa_hci_defs.h"
+
+
+/* Static local functions */
+static void nfa_hci_api_register (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_get_gate_pipe_list (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_alloc_gate (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_get_host_list (tNFA_HCI_EVENT_DATA *p_evt_data);
+static BOOLEAN nfa_hci_api_get_reg_value (tNFA_HCI_EVENT_DATA *p_evt_data);
+static BOOLEAN nfa_hci_api_set_reg_value (tNFA_HCI_EVENT_DATA *p_evt_data);
+static BOOLEAN nfa_hci_api_create_pipe (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_open_pipe (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_close_pipe (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_delete_pipe (tNFA_HCI_EVENT_DATA *p_evt_data);
+static BOOLEAN nfa_hci_api_send_event (tNFA_HCI_EVENT_DATA *p_evt_data);
+static BOOLEAN nfa_hci_api_send_cmd (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_send_rsp (tNFA_HCI_EVENT_DATA *p_evt_data);
+static void nfa_hci_api_add_static_pipe (tNFA_HCI_EVENT_DATA *p_evt_data);
+
+static void nfa_hci_handle_identity_mgmt_gate_pkt (UINT8 *p_data, tNFA_HCI_DYN_PIPE *p_pipe);
+static void nfa_hci_handle_loopback_gate_pkt (UINT8 *p_data, UINT16 data_len, tNFA_HCI_DYN_PIPE *p_pipe);
+static void nfa_hci_handle_connectivity_gate_pkt (UINT8 *p_data, UINT16 data_len, tNFA_HCI_DYN_PIPE *p_pipe);
+static void nfa_hci_handle_generic_gate_cmd (UINT8 *p_data, UINT8 data_len, tNFA_HCI_DYN_GATE *p_gate, tNFA_HCI_DYN_PIPE *p_pipe);
+static void nfa_hci_handle_generic_gate_rsp (UINT8 *p_data, UINT8 data_len, tNFA_HCI_DYN_GATE *p_gate, tNFA_HCI_DYN_PIPE *p_pipe);
+static void nfa_hci_handle_generic_gate_evt (UINT8 *p_data, UINT16 data_len, tNFA_HCI_DYN_GATE *p_gate, tNFA_HCI_DYN_PIPE *p_pipe);
+
+
+/*******************************************************************************
+**
+** Function nfa_hci_check_pending_api_requests
+**
+** Description This function handles pending API requests
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_check_pending_api_requests (void)
+{
+ BT_HDR *p_msg;
+ tNFA_HCI_EVENT_DATA *p_evt_data;
+ BOOLEAN b_free;
+ UINT8 b_cmd_flag = 0;
+
+ /* If busy, or API queue is empty, then exit */
+ if ( (nfa_hci_cb.hci_state != NFA_HCI_STATE_IDLE)
+ ||((p_msg = (BT_HDR *) GKI_dequeue (&nfa_hci_cb.hci_host_reset_api_q)) == NULL) )
+ return;
+
+ /* Process API request */
+ p_evt_data = (tNFA_HCI_EVENT_DATA *)p_msg;
+
+ /* Save the application handle */
+ nfa_hci_cb.app_in_use = p_evt_data->comm.hci_handle;
+
+ b_free = TRUE;
+ switch (p_msg->event)
+ {
+ case NFA_HCI_API_CREATE_PIPE_EVT:
+ if (nfa_hci_api_create_pipe (p_evt_data) == FALSE)
+ b_free = FALSE;
+ break;
+
+ case NFA_HCI_API_GET_REGISTRY_EVT:
+ if (nfa_hci_api_get_reg_value (p_evt_data) == FALSE)
+ b_free = FALSE;
+ break;
+
+ case NFA_HCI_API_SET_REGISTRY_EVT:
+ if (nfa_hci_api_set_reg_value (p_evt_data) == FALSE)
+ b_free = FALSE;
+ break;
+
+ case NFA_HCI_API_SEND_CMD_EVT:
+ if (nfa_hci_api_send_cmd (p_evt_data) == FALSE)
+ b_free = FALSE;
+ break;
+ case NFA_HCI_API_SEND_EVENT_EVT:
+ if (nfa_hci_api_send_event (p_evt_data) == FALSE)
+ b_free = FALSE;
+ break;
+ }
+
+ if (b_free)
+ GKI_freebuf (p_msg);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_check_api_requests
+**
+** Description This function handles API requests
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_check_api_requests (void)
+{
+ BT_HDR *p_msg;
+ tNFA_HCI_EVENT_DATA *p_evt_data;
+
+ for ( ; ; )
+ {
+ /* If busy, or API queue is empty, then exit */
+ if ( (nfa_hci_cb.hci_state != NFA_HCI_STATE_IDLE)
+ ||((p_msg = (BT_HDR *) GKI_dequeue (&nfa_hci_cb.hci_api_q)) == NULL) )
+ break;
+
+ /* Process API request */
+ p_evt_data = (tNFA_HCI_EVENT_DATA *)p_msg;
+
+ /* Save the application handle */
+ nfa_hci_cb.app_in_use = p_evt_data->comm.hci_handle;
+
+ switch (p_msg->event)
+ {
+ case NFA_HCI_API_REGISTER_APP_EVT:
+ nfa_hci_api_register (p_evt_data);
+ break;
+
+ case NFA_HCI_API_DEREGISTER_APP_EVT:
+ nfa_hci_api_deregister (p_evt_data);
+ break;
+
+ case NFA_HCI_API_GET_APP_GATE_PIPE_EVT:
+ nfa_hci_api_get_gate_pipe_list (p_evt_data);
+ break;
+
+ case NFA_HCI_API_ALLOC_GATE_EVT:
+ nfa_hci_api_alloc_gate (p_evt_data);
+ break;
+
+ case NFA_HCI_API_DEALLOC_GATE_EVT:
+ nfa_hci_api_dealloc_gate (p_evt_data);
+ break;
+
+ case NFA_HCI_API_GET_HOST_LIST_EVT:
+ nfa_hci_api_get_host_list (p_evt_data);
+ break;
+
+ case NFA_HCI_API_GET_REGISTRY_EVT:
+ if (nfa_hci_api_get_reg_value (p_evt_data) == FALSE)
+ continue;
+ break;
+
+ case NFA_HCI_API_SET_REGISTRY_EVT:
+ if (nfa_hci_api_set_reg_value (p_evt_data) == FALSE)
+ continue;
+ break;
+
+ case NFA_HCI_API_CREATE_PIPE_EVT:
+ if (nfa_hci_api_create_pipe (p_evt_data) == FALSE)
+ continue;
+ break;
+
+ case NFA_HCI_API_OPEN_PIPE_EVT:
+ nfa_hci_api_open_pipe (p_evt_data);
+ break;
+
+ case NFA_HCI_API_CLOSE_PIPE_EVT:
+ nfa_hci_api_close_pipe (p_evt_data);
+ break;
+
+ case NFA_HCI_API_DELETE_PIPE_EVT:
+ nfa_hci_api_delete_pipe (p_evt_data);
+ break;
+
+ case NFA_HCI_API_SEND_CMD_EVT:
+ if (nfa_hci_api_send_cmd (p_evt_data) == FALSE)
+ continue;
+ break;
+
+ case NFA_HCI_API_SEND_RSP_EVT:
+ nfa_hci_api_send_rsp (p_evt_data);
+ break;
+
+ case NFA_HCI_API_SEND_EVENT_EVT:
+ if (nfa_hci_api_send_event (p_evt_data) == FALSE)
+ continue;
+ break;
+
+ case NFA_HCI_API_ADD_STATIC_PIPE_EVT:
+ nfa_hci_api_add_static_pipe (p_evt_data);
+ break;
+
+ default:
+ NFA_TRACE_ERROR1 ("nfa_hci_check_api_requests () Unknown event: 0x%04x", p_msg->event);
+ break;
+ }
+
+ GKI_freebuf (p_msg);
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_register
+**
+** Description action function to register the events for the given AID
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_register (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ char *p_app_name = p_evt_data->app_info.app_name;
+ tNFA_HCI_CBACK *p_cback = p_evt_data->app_info.p_cback;
+ int xx,yy;
+ UINT8 num_gates = 0,num_pipes = 0;
+ tNFA_HCI_DYN_GATE *pg = nfa_hci_cb.cfg.dyn_gates;
+
+ /* First, see if the application was already registered */
+ for (xx = 0; xx < NFA_HCI_MAX_APP_CB; xx++)
+ {
+ if ( (nfa_hci_cb.cfg.reg_app_names[xx][0] != 0)
+ && !strncmp (p_app_name, &nfa_hci_cb.cfg.reg_app_names[xx][0], strlen (p_app_name)) )
+ {
+ NFA_TRACE_EVENT2 ("nfa_hci_api_register (%s) Reusing: %u", p_app_name, xx);
+ break;
+ }
+ }
+
+ if (xx != NFA_HCI_MAX_APP_CB)
+ {
+ nfa_hci_cb.app_in_use = (tNFA_HANDLE) (xx | NFA_HANDLE_GROUP_HCI);
+ /* The app was registered, find the number of gates and pipes associated to the app */
+
+ for ( yy = 0; yy < NFA_HCI_MAX_GATE_CB; yy++, pg++)
+ {
+ if (pg->gate_owner == nfa_hci_cb.app_in_use)
+ {
+ num_gates++;
+ num_pipes += nfa_hciu_count_pipes_on_gate (pg);
+ }
+ }
+ }
+ else
+ {
+ /* Not registered, look for a free entry */
+ for (xx = 0; xx < NFA_HCI_MAX_APP_CB; xx++)
+ {
+ if (nfa_hci_cb.cfg.reg_app_names[xx][0] == 0)
+ {
+ memset (&nfa_hci_cb.cfg.reg_app_names[xx][0], 0, sizeof (nfa_hci_cb.cfg.reg_app_names[xx]));
+ BCM_STRNCPY_S (&nfa_hci_cb.cfg.reg_app_names[xx][0], sizeof (nfa_hci_cb.cfg.reg_app_names[xx]), p_app_name, NFA_MAX_HCI_APP_NAME_LEN);
+ nfa_hci_cb.nv_write_needed = TRUE;
+ NFA_TRACE_EVENT2 ("nfa_hci_api_register (%s) Allocated: %u", p_app_name, xx);
+ break;
+ }
+ }
+
+ if (xx == NFA_HCI_MAX_APP_CB)
+ {
+ NFA_TRACE_ERROR1 ("nfa_hci_api_register (%s) NO ENTRIES", p_app_name);
+
+ evt_data.hci_register.status = NFA_STATUS_FAILED;
+ p_evt_data->app_info.p_cback (NFA_HCI_REGISTER_EVT, &evt_data);
+ return;
+ }
+ }
+
+ evt_data.hci_register.num_pipes = num_pipes;
+ evt_data.hci_register.num_gates = num_gates;
+ nfa_hci_cb.p_app_cback[xx] = p_cback;
+
+ nfa_hci_cb.cfg.b_send_conn_evts[xx] = p_evt_data->app_info.b_send_conn_evts;
+
+ evt_data.hci_register.hci_handle = (tNFA_HANDLE) (xx | NFA_HANDLE_GROUP_HCI);
+
+ evt_data.hci_register.status = NFA_STATUS_OK;
+
+ /* notify NFA_HCI_REGISTER_EVT to the application */
+ p_evt_data->app_info.p_cback (NFA_HCI_REGISTER_EVT, &evt_data);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_deregister
+**
+** Description action function to deregister the given application
+**
+** Returns None
+**
+*******************************************************************************/
+void nfa_hci_api_deregister (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HCI_CBACK *p_cback = NULL;
+ int xx;
+ tNFA_HCI_DYN_PIPE *p_pipe;
+ tNFA_HCI_DYN_GATE *p_gate;
+
+ /* If needed, find the application registration handle */
+ if (p_evt_data != NULL)
+ {
+ for (xx = 0; xx < NFA_HCI_MAX_APP_CB; xx++)
+ {
+ if ( (nfa_hci_cb.cfg.reg_app_names[xx][0] != 0)
+ && !strncmp (p_evt_data->app_info.app_name, &nfa_hci_cb.cfg.reg_app_names[xx][0], strlen (p_evt_data->app_info.app_name)) )
+ {
+ NFA_TRACE_EVENT2 ("nfa_hci_api_deregister (%s) inx: %u", p_evt_data->app_info.app_name, xx);
+ break;
+ }
+ }
+
+ if (xx == NFA_HCI_MAX_APP_CB)
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_deregister () Unknown app: %s", p_evt_data->app_info.app_name);
+ return;
+ }
+ nfa_hci_cb.app_in_use = (tNFA_HANDLE) (xx | NFA_HANDLE_GROUP_HCI);
+ p_cback = nfa_hci_cb.p_app_cback[xx];
+ }
+ else
+ {
+ nfa_sys_stop_timer (&nfa_hci_cb.timer);
+ /* We are recursing through deleting all the app's pipes and gates */
+ p_cback = nfa_hci_cb.p_app_cback[nfa_hci_cb.app_in_use & NFA_HANDLE_MASK];
+ }
+
+ /* See if any pipe is owned by this app */
+ if ((p_pipe = nfa_hciu_find_pipe_by_owner (nfa_hci_cb.app_in_use)) == NULL)
+ {
+ /* No pipes, release all gates owned by this app */
+ while ((p_gate = nfa_hciu_find_gate_by_owner (nfa_hci_cb.app_in_use)) != NULL)
+ nfa_hciu_release_gate (p_gate->gate_id);
+
+ memset (&nfa_hci_cb.cfg.reg_app_names[nfa_hci_cb.app_in_use & NFA_HANDLE_MASK][0], 0, NFA_MAX_HCI_APP_NAME_LEN + 1);
+ nfa_hci_cb.p_app_cback[nfa_hci_cb.app_in_use & NFA_HANDLE_MASK] = NULL;
+
+ nfa_hci_cb.nv_write_needed = TRUE;
+
+ evt_data.hci_deregister.status = NFC_STATUS_OK;
+
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_APP_DEREGISTER)
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_IDLE;
+
+ /* notify NFA_HCI_DEREGISTER_EVT to the application */
+ if (p_cback)
+ p_cback (NFA_HCI_DEREGISTER_EVT, &evt_data);
+ }
+ else if ((p_pipe = nfa_hciu_find_active_pipe_by_owner (nfa_hci_cb.app_in_use)) == NULL)
+ {
+ /* No pipes, release all gates owned by this app */
+ while ((p_gate = nfa_hciu_find_gate_with_nopipes_by_owner (nfa_hci_cb.app_in_use)) != NULL)
+ nfa_hciu_release_gate (p_gate->gate_id);
+
+ nfa_hci_cb.p_app_cback[nfa_hci_cb.app_in_use & NFA_HANDLE_MASK] = NULL;
+
+ nfa_hci_cb.nv_write_needed = TRUE;
+
+ evt_data.hci_deregister.status = NFC_STATUS_FAILED;
+
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_APP_DEREGISTER)
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_IDLE;
+
+ /* notify NFA_HCI_DEREGISTER_EVT to the application */
+ if (p_cback)
+ p_cback (NFA_HCI_DEREGISTER_EVT, &evt_data);
+ }
+ else
+ {
+ /* Delete all active pipes created for the application before de registering
+ **/
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_APP_DEREGISTER;
+
+ nfa_hciu_send_delete_pipe_cmd (p_pipe->pipe_id);
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_get_gate_pipe_list
+**
+** Description action function to get application allocated gates and
+** application created pipes
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_get_gate_pipe_list (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ int xx,yy;
+ tNFA_HCI_DYN_GATE *pg = nfa_hci_cb.cfg.dyn_gates;
+ tNFA_HCI_DYN_PIPE *pp = nfa_hci_cb.cfg.dyn_pipes;
+
+ evt_data.gates_pipes.num_gates = 0;
+ evt_data.gates_pipes.num_pipes = 0;
+
+ for ( xx = 0; xx < NFA_HCI_MAX_GATE_CB; xx++, pg++)
+ {
+ if (pg->gate_owner == p_evt_data->get_gate_pipe_list.hci_handle)
+ {
+ evt_data.gates_pipes.gate[evt_data.gates_pipes.num_gates++] = pg->gate_id;
+
+ pp = nfa_hci_cb.cfg.dyn_pipes;
+
+ /* Loop through looking for a match */
+ for ( yy = 0; yy < NFA_HCI_MAX_PIPE_CB; yy++, pp++)
+ {
+ if (pp->local_gate == pg->gate_id)
+ evt_data.gates_pipes.pipe[evt_data.gates_pipes.num_pipes++] = *(tNFA_HCI_PIPE_INFO*)pp;
+ }
+ }
+ }
+ evt_data.gates_pipes.status = NFA_STATUS_OK;
+
+ /* notify NFA_HCI_GET_GATE_PIPE_LIST_EVT to the application */
+ nfa_hciu_send_to_app (NFA_HCI_GET_GATE_PIPE_LIST_EVT, &evt_data, p_evt_data->get_gate_pipe_list.hci_handle);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_alloc_gate
+**
+** Description action function to allocate a generic gate
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_alloc_gate (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HANDLE app_handle = p_evt_data->comm.hci_handle;
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HCI_DYN_GATE *p_gate;
+
+ p_gate = nfa_hciu_alloc_gate (0, app_handle);
+
+ evt_data.allocated.gate = p_gate ? p_gate->gate_id : 0;
+ evt_data.allocated.status = p_gate ? NFA_STATUS_OK : NFA_STATUS_FAILED;
+
+ /* notify NFA_HCI_ALLOCATE_GATE_EVT to the application */
+ nfa_hciu_send_to_app (NFA_HCI_ALLOCATE_GATE_EVT, &evt_data, app_handle);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_dealloc_gate
+**
+** Description action function to deallocate the given generic gate
+**
+** Returns None
+**
+*******************************************************************************/
+void nfa_hci_api_dealloc_gate (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ UINT8 gate_id;
+ tNFA_HCI_DYN_GATE *p_gate;
+ tNFA_HCI_DYN_PIPE *p_pipe;
+ tNFA_HANDLE app_handle;
+
+ /* p_evt_data may be NULL if we are recursively deleting pipes */
+ if (p_evt_data)
+ {
+ gate_id = p_evt_data->gate_dealloc.gate;
+ app_handle = p_evt_data->gate_dealloc.hci_handle;
+
+ }
+ else
+ {
+ nfa_sys_stop_timer (&nfa_hci_cb.timer);
+ gate_id = nfa_hci_cb.local_gate_in_use;
+ app_handle = nfa_hci_cb.app_in_use;
+ }
+
+ evt_data.deallocated.gate = gate_id;;
+
+ p_gate = nfa_hciu_find_gate_by_gid (gate_id);
+
+ if (p_gate == NULL)
+ {
+ evt_data.deallocated.status = NFA_STATUS_UNKNOWN_GID;
+ }
+ else if (p_gate->gate_owner != app_handle)
+ {
+ evt_data.deallocated.status = NFA_STATUS_FAILED;
+ }
+ else
+ {
+ /* See if any pipe is owned by this app */
+ if ((p_pipe = nfa_hciu_find_pipe_on_gate (p_gate->gate_id)) == NULL)
+ {
+ nfa_hciu_release_gate (p_gate->gate_id);
+
+ nfa_hci_cb.nv_write_needed = TRUE;
+ evt_data.deallocated.status = NFA_STATUS_OK;
+
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_REMOVE_GATE)
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_IDLE;
+ }
+ else if ((p_pipe = nfa_hciu_find_active_pipe_on_gate (p_gate->gate_id)) == NULL)
+ {
+ /* UICC is not active at the moment and cannot delete the pipe */
+ nfa_hci_cb.nv_write_needed = TRUE;
+ evt_data.deallocated.status = NFA_STATUS_FAILED;
+
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_REMOVE_GATE)
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_IDLE;
+ }
+ else
+ {
+ /* Delete pipes on the gate */
+ nfa_hci_cb.local_gate_in_use = gate_id;
+ nfa_hci_cb.app_in_use = app_handle;
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_REMOVE_GATE;
+
+ nfa_hciu_send_delete_pipe_cmd (p_pipe->pipe_id);
+ return;
+ }
+ }
+
+ nfa_hciu_send_to_app (NFA_HCI_DEALLOCATE_GATE_EVT, &evt_data, app_handle);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_get_host_list
+**
+** Description action function to get the host list from HCI network
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_get_host_list (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ UINT8 app_inx = p_evt_data->get_host_list.hci_handle & NFA_HANDLE_MASK;
+
+ nfa_hci_cb.app_in_use = p_evt_data->get_host_list.hci_handle;
+
+ /* First, check if the application handle is valid */
+ if ( ((nfa_hci_cb.app_in_use & NFA_HANDLE_GROUP_MASK) != NFA_HANDLE_GROUP_HCI)
+ ||(app_inx >= NFA_HCI_MAX_APP_CB)
+ ||(nfa_hci_cb.p_app_cback[app_inx] == NULL) )
+ {
+ return;
+ }
+
+ nfa_hciu_send_get_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_HOST_LIST_INDEX);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_create_pipe
+**
+** Description action function to create a pipe
+**
+** Returns TRUE, if the command is processed
+** FALSE, if command is queued for processing later
+**
+*******************************************************************************/
+static BOOLEAN nfa_hci_api_create_pipe (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_DYN_GATE *p_gate = nfa_hciu_find_gate_by_gid (p_evt_data->create_pipe.source_gate);
+ tNFA_HCI_EVT_DATA evt_data;
+
+ /* Verify that the app owns the gate that the pipe is being created on */
+ if ((p_gate == NULL) || (p_gate->gate_owner != p_evt_data->create_pipe.hci_handle))
+ {
+ evt_data.created.source_gate = p_evt_data->create_pipe.source_gate;
+ evt_data.created.status = NFA_STATUS_FAILED;
+
+ NFA_TRACE_ERROR2 ("nfa_hci_api_create_pipe Cannot create pipe! APP: 0x%02x does not own the gate:0x%x", p_evt_data->create_pipe.hci_handle, p_evt_data->create_pipe.source_gate);
+ nfa_hciu_send_to_app (NFA_HCI_CREATE_PIPE_EVT, &evt_data, p_evt_data->open_pipe.hci_handle);
+ }
+ else
+ {
+ if (nfa_hciu_is_host_reseting (p_evt_data->create_pipe.dest_gate))
+ {
+ GKI_enqueue (&nfa_hci_cb.hci_host_reset_api_q, (BT_HDR *) p_evt_data);
+ return FALSE;
+ }
+
+ nfa_hci_cb.local_gate_in_use = p_evt_data->create_pipe.source_gate;
+ nfa_hci_cb.remote_gate_in_use = p_evt_data->create_pipe.dest_gate;
+ nfa_hci_cb.remote_host_in_use = p_evt_data->create_pipe.dest_host;
+ nfa_hci_cb.app_in_use = p_evt_data->create_pipe.hci_handle;
+
+ nfa_hciu_send_create_pipe_cmd (p_evt_data->create_pipe.source_gate, p_evt_data->create_pipe.dest_host, p_evt_data->create_pipe.dest_gate);
+ }
+ return TRUE;
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_open_pipe
+**
+** Description action function to open a pipe
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_open_pipe (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HCI_DYN_PIPE *p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->open_pipe.pipe);
+ tNFA_HCI_DYN_GATE *p_gate = NULL;
+
+ if (p_pipe != NULL)
+ p_gate = nfa_hciu_find_gate_by_gid (p_pipe->local_gate);
+
+ if ( (p_pipe != NULL)
+ &&(p_gate != NULL)
+ &&(nfa_hciu_is_active_host (p_pipe->dest_host))
+ &&(p_gate->gate_owner == p_evt_data->open_pipe.hci_handle))
+ {
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_CLOSED)
+ {
+ nfa_hciu_send_open_pipe_cmd (p_evt_data->open_pipe.pipe);
+ }
+ else
+ {
+ evt_data.opened.pipe = p_evt_data->open_pipe.pipe;
+ evt_data.opened.status = NFA_STATUS_OK;
+
+ nfa_hciu_send_to_app (NFA_HCI_OPEN_PIPE_EVT, &evt_data, p_evt_data->open_pipe.hci_handle);
+ }
+ }
+ else
+ {
+ evt_data.opened.pipe = p_evt_data->open_pipe.pipe;
+ evt_data.opened.status = NFA_STATUS_FAILED;
+
+ nfa_hciu_send_to_app (NFA_HCI_OPEN_PIPE_EVT, &evt_data, p_evt_data->open_pipe.hci_handle);
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_get_reg_value
+**
+** Description action function to get the reg value of the specified index
+**
+** Returns TRUE, if the command is processed
+** FALSE, if command is queued for processing later
+**
+*******************************************************************************/
+static BOOLEAN nfa_hci_api_get_reg_value (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_DYN_PIPE *p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->get_registry.pipe);
+ tNFA_HCI_DYN_GATE *p_gate;
+ tNFA_STATUS status = NFA_STATUS_FAILED;
+ tNFA_HCI_EVT_DATA evt_data;
+
+ if (p_pipe != NULL)
+ {
+ p_gate = nfa_hciu_find_gate_by_gid (p_pipe->local_gate);
+
+ if ((p_gate != NULL) && (nfa_hciu_is_active_host (p_pipe->dest_host)) && (p_gate->gate_owner == p_evt_data->get_registry.hci_handle))
+ {
+ nfa_hci_cb.app_in_use = p_evt_data->get_registry.hci_handle;
+
+ if (nfa_hciu_is_host_reseting (p_pipe->dest_host))
+ {
+ GKI_enqueue (&nfa_hci_cb.hci_host_reset_api_q, (BT_HDR *) p_evt_data);
+ return FALSE;
+ }
+
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_CLOSED)
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_get_reg_value pipe:%d not open", p_evt_data->get_registry.pipe);
+ }
+ else
+ {
+ if ((status = nfa_hciu_send_get_param_cmd (p_evt_data->get_registry.pipe, p_evt_data->get_registry.reg_inx)) == NFA_STATUS_OK)
+ return TRUE;
+ }
+ }
+ }
+
+ evt_data.cmd_sent.status = status;
+
+ /* Send NFA_HCI_CMD_SENT_EVT to notify failure */
+ nfa_hciu_send_to_app (NFA_HCI_CMD_SENT_EVT, &evt_data, p_evt_data->get_registry.hci_handle);
+ return TRUE;
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_set_reg_value
+**
+** Description action function to set the reg value at specified index
+**
+** Returns TRUE, if the command is processed
+** FALSE, if command is queued for processing later
+**
+*******************************************************************************/
+static BOOLEAN nfa_hci_api_set_reg_value (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_DYN_PIPE *p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->set_registry.pipe);
+ tNFA_HCI_DYN_GATE *p_gate;
+ tNFA_STATUS status = NFA_STATUS_FAILED;
+ tNFA_HCI_EVT_DATA evt_data;
+
+ if (p_pipe != NULL)
+ {
+ p_gate = nfa_hciu_find_gate_by_gid (p_pipe->local_gate);
+
+ if ((p_gate != NULL) && (nfa_hciu_is_active_host (p_pipe->dest_host)) && (p_gate->gate_owner == p_evt_data->set_registry.hci_handle))
+ {
+ nfa_hci_cb.app_in_use = p_evt_data->set_registry.hci_handle;
+
+ if (nfa_hciu_is_host_reseting (p_pipe->dest_host))
+ {
+ GKI_enqueue (&nfa_hci_cb.hci_host_reset_api_q, (BT_HDR *) p_evt_data);
+ return FALSE;
+ }
+
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_CLOSED)
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_set_reg_value pipe:%d not open", p_evt_data->set_registry.pipe);
+ }
+ else
+ {
+ if ((status = nfa_hciu_send_set_param_cmd (p_evt_data->set_registry.pipe, p_evt_data->set_registry.reg_inx, p_evt_data->set_registry.size, p_evt_data->set_registry.data)) == NFA_STATUS_OK)
+ return TRUE;
+ }
+ }
+ }
+ evt_data.cmd_sent.status = status;
+
+ /* Send NFA_HCI_CMD_SENT_EVT to notify failure */
+ nfa_hciu_send_to_app (NFA_HCI_CMD_SENT_EVT, &evt_data, p_evt_data->set_registry.hci_handle);
+ return TRUE;
+
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_close_pipe
+**
+** Description action function to close a pipe
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_close_pipe (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HCI_DYN_PIPE *p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->close_pipe.pipe);
+ tNFA_HCI_DYN_GATE *p_gate = NULL;
+
+ if (p_pipe != NULL)
+ p_gate = nfa_hciu_find_gate_by_gid (p_pipe->local_gate);
+
+ if ( (p_pipe != NULL)
+ &&(p_gate != NULL)
+ &&(nfa_hciu_is_active_host (p_pipe->dest_host))
+ &&(p_gate->gate_owner == p_evt_data->close_pipe.hci_handle) )
+ {
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_OPENED)
+ {
+ nfa_hciu_send_close_pipe_cmd (p_evt_data->close_pipe.pipe);
+ }
+ else
+ {
+ evt_data.closed.status = NFA_STATUS_OK;
+ evt_data.closed.pipe = p_evt_data->close_pipe.pipe;
+
+ nfa_hciu_send_to_app (NFA_HCI_CLOSE_PIPE_EVT, &evt_data, p_evt_data->close_pipe.hci_handle);
+ }
+ }
+ else
+ {
+ evt_data.closed.status = NFA_STATUS_FAILED;
+ evt_data.closed.pipe = 0x00;
+
+ nfa_hciu_send_to_app (NFA_HCI_CLOSE_PIPE_EVT, &evt_data, p_evt_data->close_pipe.hci_handle);
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_delete_pipe
+**
+** Description action function to delete a pipe
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_delete_pipe (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HCI_DYN_PIPE *p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->delete_pipe.pipe);
+ tNFA_HCI_DYN_GATE *p_gate = NULL;
+
+ if (p_pipe != NULL)
+ {
+ p_gate = nfa_hciu_find_gate_by_gid (p_pipe->local_gate);
+ if ( (p_gate != NULL)
+ &&(p_gate->gate_owner == p_evt_data->delete_pipe.hci_handle)
+ &&(nfa_hciu_is_active_host (p_pipe->dest_host)) )
+ {
+ nfa_hciu_send_delete_pipe_cmd (p_evt_data->delete_pipe.pipe);
+ return;
+ }
+ }
+
+ evt_data.deleted.status = NFA_STATUS_FAILED;
+ evt_data.deleted.pipe = 0x00;
+ nfa_hciu_send_to_app (NFA_HCI_DELETE_PIPE_EVT, &evt_data, p_evt_data->close_pipe.hci_handle);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_send_cmd
+**
+** Description action function to send command on the given pipe
+**
+** Returns TRUE, if the command is processed
+** FALSE, if command is queued for processing later
+**
+*******************************************************************************/
+static BOOLEAN nfa_hci_api_send_cmd (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_STATUS status = NFA_STATUS_FAILED;
+ tNFA_HCI_DYN_PIPE *p_pipe;
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HANDLE app_handle;
+
+ if ((p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->send_cmd.pipe)) != NULL)
+ {
+ app_handle = nfa_hciu_get_pipe_owner (p_evt_data->send_cmd.pipe);
+
+ if ( (nfa_hciu_is_active_host (p_pipe->dest_host))
+ &&(app_handle == p_evt_data->send_cmd.hci_handle) )
+ {
+ if (nfa_hciu_is_host_reseting (p_pipe->dest_host))
+ {
+ GKI_enqueue (&nfa_hci_cb.hci_host_reset_api_q, (BT_HDR *) p_evt_data);
+ return FALSE;
+ }
+
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_OPENED)
+ {
+ nfa_hci_cb.pipe_in_use = p_evt_data->send_cmd.pipe;
+ if ((status = nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_COMMAND_TYPE, p_evt_data->send_cmd.cmd_code,
+ p_evt_data->send_cmd.cmd_len, p_evt_data->send_cmd.data)) == NFA_STATUS_OK)
+ return TRUE;
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_cmd pipe:%d not open", p_pipe->pipe_id);
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_cmd pipe:%d Owned by different application or Destination host is not active",
+ p_pipe->pipe_id);
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_cmd pipe:%d not found", p_evt_data->send_cmd.pipe);
+ }
+
+ evt_data.cmd_sent.status = status;
+
+ /* Send NFA_HCI_CMD_SENT_EVT to notify failure */
+ nfa_hciu_send_to_app (NFA_HCI_CMD_SENT_EVT, &evt_data, p_evt_data->send_cmd.hci_handle);
+ return TRUE;
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_send_rsp
+**
+** Description action function to send response on the given pipe
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_send_rsp (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_STATUS status = NFA_STATUS_FAILED;
+ tNFA_HCI_DYN_PIPE *p_pipe;
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HANDLE app_handle;
+
+ if ((p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->send_rsp.pipe)) != NULL)
+ {
+ app_handle = nfa_hciu_get_pipe_owner (p_evt_data->send_rsp.pipe);
+
+ if ( (nfa_hciu_is_active_host (p_pipe->dest_host))
+ &&(app_handle == p_evt_data->send_rsp.hci_handle) )
+ {
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_OPENED)
+ {
+ if ((status = nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_RESPONSE_TYPE, p_evt_data->send_rsp.response,
+ p_evt_data->send_rsp.size, p_evt_data->send_rsp.data)) == NFA_STATUS_OK)
+ return;
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_rsp pipe:%d not open", p_pipe->pipe_id);
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_rsp pipe:%d Owned by different application or Destination host is not active",
+ p_pipe->pipe_id);
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_rsp pipe:%d not found", p_evt_data->send_rsp.pipe);
+ }
+
+ evt_data.rsp_sent.status = status;
+
+ /* Send NFA_HCI_RSP_SENT_EVT to notify failure */
+ nfa_hciu_send_to_app (NFA_HCI_RSP_SENT_EVT, &evt_data, p_evt_data->send_rsp.hci_handle);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_send_event
+**
+** Description action function to send an event to the given pipe
+**
+** Returns TRUE, if the event is processed
+** FALSE, if event is queued for processing later
+**
+*******************************************************************************/
+static BOOLEAN nfa_hci_api_send_event (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_STATUS status = NFA_STATUS_FAILED;
+ tNFA_HCI_DYN_PIPE *p_pipe;
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HANDLE app_handle;
+
+ if ((p_pipe = nfa_hciu_find_pipe_by_pid (p_evt_data->send_evt.pipe)) != NULL)
+ {
+ app_handle = nfa_hciu_get_pipe_owner (p_evt_data->send_evt.pipe);
+
+ if ( (nfa_hciu_is_active_host (p_pipe->dest_host))
+ &&(app_handle == p_evt_data->send_evt.hci_handle) )
+ {
+ if (nfa_hciu_is_host_reseting (p_pipe->dest_host))
+ {
+ GKI_enqueue (&nfa_hci_cb.hci_host_reset_api_q, (BT_HDR *) p_evt_data);
+ return FALSE;
+ }
+
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_OPENED)
+ {
+ status = nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_EVENT_TYPE, p_evt_data->send_evt.evt_code,
+ p_evt_data->send_evt.evt_len, p_evt_data->send_evt.p_evt_buf);
+
+ if (status == NFA_STATUS_OK)
+ {
+ if (p_evt_data->send_evt.rsp_len)
+ {
+ nfa_hci_cb.pipe_in_use = p_evt_data->send_evt.pipe;
+ nfa_hci_cb.rsp_buf_size = p_evt_data->send_evt.rsp_len;
+ nfa_hci_cb.p_rsp_buf = p_evt_data->send_evt.p_rsp_buf;
+ if (p_evt_data->send_evt.rsp_timeout)
+ {
+ nfa_hci_cb.w4_rsp_evt = TRUE;
+ nfa_hci_cb.hci_state = NFA_HCI_STATE_WAIT_RSP;
+ nfa_sys_start_timer (&nfa_hci_cb.timer, NFA_HCI_RSP_TIMEOUT_EVT, p_evt_data->send_evt.rsp_timeout);
+ }
+ }
+ else
+ {
+ nfa_hci_cb.rsp_buf_size = 0;
+ nfa_hci_cb.p_rsp_buf = NULL;
+ }
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_event pipe:%d not open", p_pipe->pipe_id);
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_event pipe:%d Owned by different application or Destination host is not active",
+ p_pipe->pipe_id);
+ }
+ }
+ else
+ {
+ NFA_TRACE_WARNING1 ("nfa_hci_api_send_event pipe:%d not found", p_evt_data->send_evt.pipe);
+ }
+
+ evt_data.evt_sent.status = status;
+
+ /* Send NFC_HCI_EVENT_SENT_EVT to notify failure */
+ nfa_hciu_send_to_app (NFA_HCI_EVENT_SENT_EVT, &evt_data, p_evt_data->send_evt.hci_handle);
+ return TRUE;
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_api_add_static_pipe
+**
+** Description action function to add static pipe
+**
+** Returns None
+**
+*******************************************************************************/
+static void nfa_hci_api_add_static_pipe (tNFA_HCI_EVENT_DATA *p_evt_data)
+{
+ tNFA_HCI_DYN_GATE *pg;
+ tNFA_HCI_DYN_PIPE *pp;
+ tNFA_HCI_EVT_DATA evt_data;
+
+ /* Allocate a proprietary gate */
+ if ((pg = nfa_hciu_alloc_gate (p_evt_data->add_static_pipe.gate, p_evt_data->add_static_pipe.hci_handle)) != NULL)
+ {
+ /* Assign new owner to the gate */
+ pg->gate_owner = p_evt_data->add_static_pipe.hci_handle;
+
+ /* Add the dynamic pipe to the proprietary gate */
+ if (nfa_hciu_add_pipe_to_gate (p_evt_data->add_static_pipe.pipe,pg->gate_id, p_evt_data->add_static_pipe.host, p_evt_data->add_static_pipe.gate) != NFA_HCI_ANY_OK)
+ {
+ /* Unable to add the dynamic pipe, so release the gate */
+ nfa_hciu_release_gate (pg->gate_id);
+ evt_data.pipe_added.status = NFA_STATUS_FAILED;
+ nfa_hciu_send_to_app (NFA_HCI_ADD_STATIC_PIPE_EVT, &evt_data, p_evt_data->add_static_pipe.hci_handle);
+ return;
+ }
+ if ((pp = nfa_hciu_find_pipe_by_pid (p_evt_data->add_static_pipe.pipe)) != NULL)
+ {
+ /* This pipe is always opened */
+ pp->pipe_state = NFA_HCI_PIPE_OPENED;
+ evt_data.pipe_added.status = NFA_STATUS_OK;
+ nfa_hciu_send_to_app (NFA_HCI_ADD_STATIC_PIPE_EVT, &evt_data, p_evt_data->add_static_pipe.hci_handle);
+ return;
+ }
+ }
+ /* Unable to add static pipe */
+ evt_data.pipe_added.status = NFA_STATUS_FAILED;
+ nfa_hciu_send_to_app (NFA_HCI_ADD_STATIC_PIPE_EVT, &evt_data, p_evt_data->add_static_pipe.hci_handle);
+
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_link_mgm_gate_cmd
+**
+** Description This function handles incoming link management gate hci
+** commands
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_handle_link_mgm_gate_cmd (UINT8 *p_data)
+{
+ UINT8 index;
+ UINT8 data[2];
+ UINT8 rsp_len = 0;
+ UINT8 response = NFA_HCI_ANY_OK;
+
+ if ( (nfa_hci_cb.cfg.link_mgmt_gate.pipe00_state != NFA_HCI_PIPE_OPENED)
+ &&(nfa_hci_cb.inst != NFA_HCI_ANY_OPEN_PIPE) )
+ {
+ nfa_hciu_send_msg (NFA_HCI_LINK_MANAGEMENT_PIPE, NFA_HCI_RESPONSE_TYPE, NFA_HCI_ANY_E_PIPE_NOT_OPENED, 0, NULL);
+ return;
+ }
+
+ switch (nfa_hci_cb.inst)
+ {
+ case NFA_HCI_ANY_SET_PARAMETER:
+ STREAM_TO_UINT8 (index, p_data);
+
+ if (index == 1)
+ {
+ STREAM_TO_UINT16 (nfa_hci_cb.cfg.link_mgmt_gate.rec_errors, p_data);
+ }
+ else
+ response = NFA_HCI_ANY_E_REG_PAR_UNKNOWN;
+ break;
+
+ case NFA_HCI_ANY_GET_PARAMETER:
+ STREAM_TO_UINT8 (index, p_data);
+ if (index == 1)
+ {
+ data[0] = (UINT8) ((nfa_hci_cb.cfg.link_mgmt_gate.rec_errors >> 8) & 0x00FF);
+ data[1] = (UINT8) (nfa_hci_cb.cfg.link_mgmt_gate.rec_errors & 0x000F);
+ rsp_len = 2;
+ }
+ else
+ response = NFA_HCI_ANY_E_REG_PAR_UNKNOWN;
+ break;
+
+ case NFA_HCI_ANY_OPEN_PIPE:
+ data[0] = 0;
+ rsp_len = 1;
+ nfa_hci_cb.cfg.link_mgmt_gate.pipe00_state = NFA_HCI_PIPE_OPENED;
+ break;
+
+ case NFA_HCI_ANY_CLOSE_PIPE:
+ nfa_hci_cb.cfg.link_mgmt_gate.pipe00_state = NFA_HCI_PIPE_CLOSED;
+ break;
+
+ default:
+ response = NFA_HCI_ANY_E_CMD_NOT_SUPPORTED;
+ break;
+ }
+
+ nfa_hciu_send_msg (NFA_HCI_LINK_MANAGEMENT_PIPE, NFA_HCI_RESPONSE_TYPE, response, rsp_len, data);
+}
+
+
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_pipe_open_close_cmd
+**
+** Description This function handles all generic gates (excluding
+** connectivity gate) commands
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_handle_pipe_open_close_cmd (tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ UINT8 data[1];
+ UINT8 rsp_len = 0;
+ tNFA_HCI_RESPONSE response = NFA_HCI_ANY_OK;
+ tNFA_HCI_DYN_GATE *p_gate;
+
+ if (nfa_hci_cb.inst == NFA_HCI_ANY_OPEN_PIPE)
+ {
+ if ((p_gate = nfa_hciu_find_gate_by_gid(p_pipe->local_gate)) != NULL)
+ data[0] = nfa_hciu_count_open_pipes_on_gate (p_gate);
+ else
+ data[0] = 0;
+
+ p_pipe->pipe_state = NFA_HCI_PIPE_OPENED;
+ rsp_len = 1;
+ }
+ else if (nfa_hci_cb.inst == NFA_HCI_ANY_CLOSE_PIPE)
+ {
+ p_pipe->pipe_state = NFA_HCI_PIPE_CLOSED;
+ }
+
+ nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_RESPONSE_TYPE, response, rsp_len, data);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_admin_gate_cmd
+**
+** Description This function handles incoming commands on ADMIN gate
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_handle_admin_gate_cmd (UINT8 *p_data)
+{
+ UINT8 source_host, source_gate, dest_host, dest_gate, pipe;
+ UINT8 data = 0;
+ UINT8 rsp_len = 0;
+ tNFA_HCI_RESPONSE response = NFA_HCI_ANY_OK;
+ tNFA_HCI_DYN_GATE *pgate;
+ tNFA_HCI_EVT_DATA evt_data;
+
+ switch (nfa_hci_cb.inst)
+ {
+ case NFA_HCI_ANY_OPEN_PIPE:
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = NFA_HCI_PIPE_OPENED;
+ data = 0;
+ rsp_len = 1;
+ break;
+
+ case NFA_HCI_ANY_CLOSE_PIPE:
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = NFA_HCI_PIPE_CLOSED;
+ /* Reopen the pipe immediately */
+ nfa_hciu_send_msg (NFA_HCI_ADMIN_PIPE, NFA_HCI_RESPONSE_TYPE, response, rsp_len, &data);
+ nfa_hci_cb.app_in_use = NFA_HANDLE_INVALID;
+ nfa_hciu_send_open_pipe_cmd (NFA_HCI_ADMIN_PIPE);
+ return;
+ break;
+
+ case NFA_HCI_ADM_NOTIFY_PIPE_CREATED:
+ STREAM_TO_UINT8 (source_host, p_data);
+ STREAM_TO_UINT8 (source_gate, p_data);
+ STREAM_TO_UINT8 (dest_host, p_data);
+ STREAM_TO_UINT8 (dest_gate, p_data);
+ STREAM_TO_UINT8 (pipe, p_data);
+
+ if ( (dest_gate == NFA_HCI_IDENTITY_MANAGEMENT_GATE)
+ ||(dest_gate == NFA_HCI_LOOP_BACK_GATE) )
+ {
+ response = nfa_hciu_add_pipe_to_static_gate (dest_gate, pipe, source_host, source_gate);
+ }
+ else
+ {
+ if ((pgate = nfa_hciu_find_gate_by_gid (dest_gate)) != NULL)
+ {
+ /* If the gate is valid, add the pipe to it */
+ if ((response = nfa_hciu_add_pipe_to_gate (pipe, dest_gate, source_host, source_gate)) == NFA_HCI_ANY_OK)
+ {
+ /* Tell the application a pipe was created with its gate */
+
+ evt_data.created.status = NFA_STATUS_OK;
+ evt_data.created.pipe = pipe;
+ evt_data.created.source_gate = dest_gate;
+ evt_data.created.dest_host = source_host;
+ evt_data.created.dest_gate = source_gate;
+
+ nfa_hciu_send_to_app (NFA_HCI_CREATE_PIPE_EVT, &evt_data, pgate->gate_owner);
+ }
+ }
+ else
+ response = NFA_HCI_ANY_E_NOK;
+ }
+ break;
+
+ case NFA_HCI_ADM_NOTIFY_PIPE_DELETED:
+ STREAM_TO_UINT8 (pipe, p_data);
+ response = nfa_hciu_release_pipe (pipe);
+ break;
+
+ case NFA_HCI_ADM_NOTIFY_ALL_PIPE_CLEARED:
+ STREAM_TO_UINT8 (source_host, p_data);
+
+ nfa_hciu_remove_all_pipes_from_host (source_host);
+
+ if (source_host == NFA_HCI_HOST_CONTROLLER)
+ {
+ nfa_hci_cb.cfg.link_mgmt_gate.pipe00_state = NFA_HCI_PIPE_CLOSED;
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = NFA_HCI_PIPE_CLOSED;
+
+ /* Reopen the admin pipe immediately */
+ nfa_hci_cb.app_in_use = NFA_HANDLE_INVALID;
+ nfa_hciu_send_open_pipe_cmd (NFA_HCI_ADMIN_PIPE);
+ return;
+ }
+ else
+ {
+ if ( (source_host >= NFA_HCI_HOST_ID_UICC0)
+ &&(source_host < (NFA_HCI_HOST_ID_UICC0 + NFA_HCI_MAX_HOST_IN_NETWORK)) )
+ {
+ nfa_hci_cb.reset_host[source_host - NFA_HCI_HOST_ID_UICC0] = source_host;
+ }
+ }
+ break;
+
+ default:
+ response = NFA_HCI_ANY_E_CMD_NOT_SUPPORTED;
+ break;
+ }
+
+ nfa_hciu_send_msg (NFA_HCI_ADMIN_PIPE, NFA_HCI_RESPONSE_TYPE, response, rsp_len, &data);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_admin_gate_rsp
+**
+** Description This function handles response received on admin gate
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_handle_admin_gate_rsp (UINT8 *p_data, UINT8 data_len)
+{
+ UINT8 hosts[2] = {NFA_HCI_HOST_ID_UICC0, (NFA_HCI_HOST_ID_UICC0 + 1)};
+ UINT8 source_host;
+ UINT8 source_gate = nfa_hci_cb.local_gate_in_use;
+ UINT8 dest_host = nfa_hci_cb.remote_host_in_use;
+ UINT8 dest_gate = nfa_hci_cb.remote_gate_in_use;
+ UINT8 pipe = 0;
+ tNFA_STATUS status;
+ tNFA_HCI_EVT_DATA evt_data;
+ UINT8 default_session[NFA_HCI_SESSION_ID_LEN] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
+ UINT8 host_count = 0;
+ UINT8 host_id = 0;
+ UINT32 os_tick;
+
+#if (BT_TRACE_VERBOSE == TRUE)
+ NFA_TRACE_DEBUG4 ("nfa_hci_handle_admin_gate_rsp - LastCmdSent: %s App: 0x%04x Gate: 0x%02x Pipe: 0x%02x",
+ nfa_hciu_instr_2_str(nfa_hci_cb.cmd_sent), nfa_hci_cb.app_in_use, nfa_hci_cb.local_gate_in_use, nfa_hci_cb.pipe_in_use);
+#else
+ NFA_TRACE_DEBUG4 ("nfa_hci_handle_admin_gate_rsp LastCmdSent: %u App: 0x%04x Gate: 0x%02x Pipe: 0x%02x",
+ nfa_hci_cb.cmd_sent, nfa_hci_cb.app_in_use, nfa_hci_cb.local_gate_in_use, nfa_hci_cb.pipe_in_use);
+#endif
+
+ if (nfa_hci_cb.inst == NFA_HCI_ANY_E_PIPE_NOT_OPENED)
+ {
+ nfa_hciu_send_open_pipe_cmd (NFA_HCI_ADMIN_PIPE);
+ return;
+ }
+
+ /* If starting up, handle events here */
+ if ( (nfa_hci_cb.hci_state == NFA_HCI_STATE_STARTUP)
+ ||(nfa_hci_cb.hci_state == NFA_HCI_STATE_RESTORE)
+ ||(nfa_hci_cb.hci_state == NFA_HCI_STATE_WAIT_NETWK_ENABLE) )
+ {
+ if (nfa_hci_cb.inst != NFA_HCI_ANY_OK)
+ {
+ NFA_TRACE_ERROR0 ("nfa_hci_handle_admin_gate_rsp - Initialization failed");
+ nfa_hci_startup_complete (NFA_STATUS_FAILED);
+ return;
+ }
+
+ switch (nfa_hci_cb.cmd_sent)
+ {
+ case NFA_HCI_ANY_SET_PARAMETER:
+ if (nfa_hci_cb.param_in_use == NFA_HCI_SESSION_IDENTITY_INDEX)
+ {
+ /* Set WHITELIST */
+ nfa_hciu_send_set_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_WHITELIST_INDEX, 0x02, hosts);
+ }
+ else if (nfa_hci_cb.param_in_use == NFA_HCI_WHITELIST_INDEX)
+ {
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_STARTUP)
+ nfa_hci_dh_startup_complete ();
+
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_RESTORE)
+ nfa_hci_startup_complete (NFA_STATUS_OK);
+ }
+ break;
+
+ case NFA_HCI_ANY_GET_PARAMETER:
+ if (nfa_hci_cb.param_in_use == NFA_HCI_HOST_LIST_INDEX)
+ {
+ host_count = 0;
+ while (host_count < NFA_HCI_MAX_HOST_IN_NETWORK)
+ {
+ nfa_hci_cb.inactive_host[host_count] = NFA_HCI_HOST_ID_UICC0 + host_count;
+ host_count++;
+ }
+
+ host_count = 0;
+ /* Collect active host in the Host Network */
+ while (host_count < data_len)
+ {
+ host_id = (UINT8) *p_data++;
+
+ if ( (host_id >= NFA_HCI_HOST_ID_UICC0)
+ &&(host_id < NFA_HCI_HOST_ID_UICC0 + NFA_HCI_MAX_HOST_IN_NETWORK) )
+ {
+ nfa_hci_cb.inactive_host[host_id - NFA_HCI_HOST_ID_UICC0] = 0x00;
+ nfa_hci_cb.reset_host[host_id - NFA_HCI_HOST_ID_UICC0] = 0x00;
+ }
+
+ host_count++;
+ }
+ nfa_hci_startup_complete (NFA_STATUS_OK);
+ }
+ else if (nfa_hci_cb.param_in_use == NFA_HCI_SESSION_IDENTITY_INDEX)
+ {
+ /* The only parameter we get when initializing is the session ID. Check for match. */
+ if (!memcmp ((UINT8 *) nfa_hci_cb.cfg.admin_gate.session_id, p_data, NFA_HCI_SESSION_ID_LEN) )
+ {
+ /* Session has not changed. Set the WHITELIST */
+ nfa_hciu_send_set_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_WHITELIST_INDEX, 0x01, hosts);
+ }
+ else
+ {
+ /* Something wrong, NVRAM data could be corrupt or first start with default session id */
+ nfa_hciu_send_clear_all_pipe_cmd ();
+ nfa_hci_cb.b_hci_netwk_reset = TRUE;
+ }
+ }
+ break;
+
+ case NFA_HCI_ANY_OPEN_PIPE:
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = NFA_HCI_PIPE_OPENED;
+
+ if (nfa_hci_cb.b_hci_netwk_reset)
+ {
+ nfa_hci_cb.b_hci_netwk_reset = FALSE;
+ /* Session ID is reset, Set New session id */
+ memcpy (&nfa_hci_cb.cfg.admin_gate.session_id[NFA_HCI_SESSION_ID_LEN / 2], nfa_hci_cb.cfg.admin_gate.session_id, (NFA_HCI_SESSION_ID_LEN / 2));
+ os_tick = GKI_get_os_tick_count ();
+ memcpy (nfa_hci_cb.cfg.admin_gate.session_id, (UINT8 *)&os_tick, (NFA_HCI_SESSION_ID_LEN / 2));
+ nfa_hciu_send_set_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_SESSION_IDENTITY_INDEX, NFA_HCI_SESSION_ID_LEN, (UINT8 *) nfa_hci_cb.cfg.admin_gate.session_id);
+ }
+ else
+ {
+ /* First thing is to get the session ID */
+ nfa_hciu_send_get_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_SESSION_IDENTITY_INDEX);
+ }
+ break;
+
+ case NFA_HCI_ADM_CLEAR_ALL_PIPE:
+ nfa_hciu_remove_all_pipes_from_host (0);
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = NFA_HCI_PIPE_CLOSED;
+ nfa_hci_cb.cfg.link_mgmt_gate.pipe00_state = NFA_HCI_PIPE_CLOSED;
+ nfa_hci_cb.nv_write_needed = TRUE;
+
+ /* Open admin */
+ nfa_hciu_send_open_pipe_cmd (NFA_HCI_ADMIN_PIPE);
+ break;
+ }
+ }
+ else
+ {
+ status = (nfa_hci_cb.inst == NFA_HCI_ANY_OK) ? NFA_STATUS_OK : NFA_STATUS_FAILED;
+
+ switch (nfa_hci_cb.cmd_sent)
+ {
+ case NFA_HCI_ANY_SET_PARAMETER:
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_APP_DEREGISTER)
+ nfa_hci_api_deregister (NULL);
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_REMOVE_GATE)
+ nfa_hci_api_dealloc_gate (NULL);
+ break;
+
+ case NFA_HCI_ANY_GET_PARAMETER:
+ if (nfa_hci_cb.param_in_use == NFA_HCI_SESSION_IDENTITY_INDEX)
+ {
+ if (!memcmp ((UINT8 *) default_session, p_data , NFA_HCI_SESSION_ID_LEN))
+ {
+ memcpy (&nfa_hci_cb.cfg.admin_gate.session_id[(NFA_HCI_SESSION_ID_LEN / 2)], nfa_hci_cb.cfg.admin_gate.session_id, (NFA_HCI_SESSION_ID_LEN / 2));
+ os_tick = GKI_get_os_tick_count ();
+ memcpy (nfa_hci_cb.cfg.admin_gate.session_id, (UINT8 *) &os_tick, (NFA_HCI_SESSION_ID_LEN / 2));
+ nfa_hci_cb.nv_write_needed = TRUE;
+ nfa_hciu_send_set_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_SESSION_IDENTITY_INDEX, NFA_HCI_SESSION_ID_LEN, (UINT8 *) nfa_hci_cb.cfg.admin_gate.session_id);
+ }
+ else
+ {
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_APP_DEREGISTER)
+ nfa_hci_api_deregister (NULL);
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_REMOVE_GATE)
+ nfa_hci_api_dealloc_gate (NULL);
+ }
+ }
+ else if (nfa_hci_cb.param_in_use == NFA_HCI_HOST_LIST_INDEX)
+ {
+ evt_data.hosts.status = status;
+ evt_data.hosts.num_hosts = data_len;
+ memcpy (evt_data.hosts.host, p_data, data_len);
+
+ host_count = 0;
+ while (host_count < NFA_HCI_MAX_HOST_IN_NETWORK)
+ {
+ nfa_hci_cb.inactive_host[host_count] = NFA_HCI_HOST_ID_UICC0 + host_count;
+ host_count++;
+ }
+
+ host_count = 0;
+ /* Collect active host in the Host Network */
+ while (host_count < data_len)
+ {
+ host_id = (UINT8) *p_data++;
+
+ if ( (host_id >= NFA_HCI_HOST_ID_UICC0)
+ &&(host_id < NFA_HCI_HOST_ID_UICC0 + NFA_HCI_MAX_HOST_IN_NETWORK) )
+ {
+ nfa_hci_cb.inactive_host[host_id - NFA_HCI_HOST_ID_UICC0] = 0x00;
+ nfa_hci_cb.reset_host[host_id - NFA_HCI_HOST_ID_UICC0] = 0x00;
+ }
+ host_count++;
+ }
+ if (nfa_hciu_is_no_host_resetting ())
+ nfa_hci_check_pending_api_requests ();
+ nfa_hciu_send_to_app (NFA_HCI_HOST_LIST_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ break;
+
+ case NFA_HCI_ADM_CREATE_PIPE:
+ if (status == NFA_STATUS_OK)
+ {
+ STREAM_TO_UINT8 (source_host, p_data);
+ STREAM_TO_UINT8 (source_gate, p_data);
+ STREAM_TO_UINT8 (dest_host, p_data);
+ STREAM_TO_UINT8 (dest_gate, p_data);
+ STREAM_TO_UINT8 (pipe, p_data);
+
+ /* Sanity check */
+ if (source_gate != nfa_hci_cb.local_gate_in_use)
+ {
+ NFA_TRACE_WARNING2 ("nfa_hci_handle_admin_gate_rsp sent create pipe with gate: %u got back: %u",
+ nfa_hci_cb.local_gate_in_use, source_gate);
+ break;
+ }
+
+ nfa_hciu_add_pipe_to_gate (pipe, source_gate, dest_host, dest_gate);
+
+ }
+
+ /* Tell the application his pipe was created or not */
+ evt_data.created.status = status;
+ evt_data.created.pipe = pipe;
+ evt_data.created.source_gate = source_gate;
+ evt_data.created.dest_host = dest_host;
+ evt_data.created.dest_gate = dest_gate;
+
+ nfa_hciu_send_to_app (NFA_HCI_CREATE_PIPE_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ break;
+
+ case NFA_HCI_ADM_DELETE_PIPE:
+ if (status == NFA_STATUS_OK)
+ {
+ nfa_hciu_release_pipe (nfa_hci_cb.pipe_in_use);
+
+ /* If only deleting one pipe, tell the app we are done */
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_IDLE)
+ {
+ evt_data.deleted.status = status;
+ evt_data.deleted.pipe = nfa_hci_cb.pipe_in_use;
+
+ nfa_hciu_send_to_app (NFA_HCI_DELETE_PIPE_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_APP_DEREGISTER)
+ nfa_hci_api_deregister (NULL);
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_REMOVE_GATE)
+ nfa_hci_api_dealloc_gate (NULL);
+ }
+ else
+ {
+ /* If only deleting one pipe, tell the app we are done */
+ if (nfa_hci_cb.hci_state == NFA_HCI_STATE_IDLE)
+ {
+ evt_data.deleted.status = status;
+ evt_data.deleted.pipe = nfa_hci_cb.pipe_in_use;
+
+ nfa_hciu_send_to_app (NFA_HCI_DELETE_PIPE_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_APP_DEREGISTER)
+ {
+ nfa_hciu_release_pipe (nfa_hci_cb.pipe_in_use);
+ nfa_hci_api_deregister (NULL);
+ }
+ else if (nfa_hci_cb.hci_state == NFA_HCI_STATE_REMOVE_GATE)
+ {
+ nfa_hciu_release_pipe (nfa_hci_cb.pipe_in_use);
+ nfa_hci_api_dealloc_gate (NULL);
+ }
+ }
+ break;
+
+ case NFA_HCI_ANY_OPEN_PIPE:
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = status ? NFA_HCI_PIPE_CLOSED:NFA_HCI_PIPE_OPENED;
+ nfa_hci_cb.nv_write_needed = TRUE;
+ if (nfa_hci_cb.cfg.admin_gate.pipe01_state == NFA_HCI_PIPE_OPENED)
+ {
+ /* First thing is to get the session ID */
+ nfa_hciu_send_get_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_SESSION_IDENTITY_INDEX);
+ }
+ break;
+
+ case NFA_HCI_ADM_CLEAR_ALL_PIPE:
+ nfa_hciu_remove_all_pipes_from_host (0);
+ nfa_hci_cb.cfg.admin_gate.pipe01_state = NFA_HCI_PIPE_CLOSED;
+ nfa_hci_cb.cfg.link_mgmt_gate.pipe00_state = NFA_HCI_PIPE_CLOSED;
+ nfa_hci_cb.nv_write_needed = TRUE;
+ /* Open admin */
+ nfa_hciu_send_open_pipe_cmd (NFA_HCI_ADMIN_PIPE);
+ break;
+
+ }
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_admin_gate_evt
+**
+** Description This function handles events received on admin gate
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_handle_admin_gate_evt (UINT8 *p_data)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+
+ if (nfa_hci_cb.inst != NFA_HCI_EVT_HOT_PLUG)
+ {
+ NFA_TRACE_ERROR0 ("nfa_hci_handle_admin_gate_evt - Unknown event on ADMIN Pipe");
+ return;
+ }
+
+ evt_data.rcvd_evt.evt_code = nfa_hci_cb.inst;
+
+ nfa_hciu_send_get_param_cmd (NFA_HCI_ADMIN_PIPE, NFA_HCI_HOST_LIST_INDEX);
+ nfa_hciu_send_to_all_apps (NFA_HCI_EVENT_RCVD_EVT, &evt_data);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_dyn_pipe_pkt
+**
+** Description This function handles data received via dynamic pipe
+**
+** Returns none
+**
+*******************************************************************************/
+void nfa_hci_handle_dyn_pipe_pkt (UINT8 pipe_id, UINT8 *p_data, UINT16 data_len)
+{
+ tNFA_HCI_DYN_PIPE *p_pipe = nfa_hciu_find_pipe_by_pid (pipe_id);
+ tNFA_HCI_DYN_GATE *p_gate;
+
+ if (p_pipe == NULL)
+ {
+ /* Invalid pipe ID */
+ NFA_TRACE_ERROR1 ("nfa_hci_handle_dyn_pipe_pkt - Unknown pipe %d",pipe_id);
+ if (nfa_hci_cb.type == NFA_HCI_COMMAND_TYPE)
+ nfa_hciu_send_msg (pipe_id, NFA_HCI_RESPONSE_TYPE, NFA_HCI_ANY_E_NOK, 0, NULL);
+ return;
+ }
+
+ if (p_pipe->local_gate == NFA_HCI_IDENTITY_MANAGEMENT_GATE)
+ {
+ nfa_hci_handle_identity_mgmt_gate_pkt (p_data, p_pipe);
+ }
+ else if (p_pipe->local_gate == NFA_HCI_LOOP_BACK_GATE)
+ {
+ nfa_hci_handle_loopback_gate_pkt (p_data, data_len, p_pipe);
+ }
+ else if (p_pipe->local_gate == NFA_HCI_CONNECTIVITY_GATE)
+ {
+ nfa_hci_handle_connectivity_gate_pkt (p_data, data_len, p_pipe);
+ }
+ else
+ {
+ p_gate = nfa_hciu_find_gate_by_gid (p_pipe->local_gate);
+ if (p_gate == NULL)
+ {
+ NFA_TRACE_ERROR1 ("nfa_hci_handle_dyn_pipe_pkt - Pipe's gate %d is corrupt",p_pipe->local_gate);
+ if (nfa_hci_cb.type == NFA_HCI_COMMAND_TYPE)
+ nfa_hciu_send_msg (pipe_id, NFA_HCI_RESPONSE_TYPE, NFA_HCI_ANY_E_NOK, 0, NULL);
+ return;
+ }
+
+ /* Check if data packet is a command, response or event */
+ switch (nfa_hci_cb.type)
+ {
+ case NFA_HCI_COMMAND_TYPE:
+ nfa_hci_handle_generic_gate_cmd (p_data, (UINT8) data_len, p_gate, p_pipe);
+ break;
+
+ case NFA_HCI_RESPONSE_TYPE:
+ nfa_hci_handle_generic_gate_rsp (p_data, (UINT8) data_len, p_gate, p_pipe);
+ break;
+
+ case NFA_HCI_EVENT_TYPE:
+ nfa_hci_handle_generic_gate_evt (p_data, data_len, p_gate, p_pipe);
+ break;
+ }
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_identity_mgmt_gate_pkt
+**
+** Description This function handles incoming Identity Management gate hci
+** commands
+**
+** Returns none
+**
+*******************************************************************************/
+static void nfa_hci_handle_identity_mgmt_gate_pkt (UINT8 *p_data, tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ UINT8 data[20];
+ UINT8 index;
+ UINT8 gate_rsp[3 + NFA_HCI_MAX_GATE_CB], num_gates;
+ UINT16 rsp_len = 0;
+ UINT8 *p_rsp = data;
+ tNFA_HCI_RESPONSE response = NFA_HCI_ANY_OK;
+
+ /* We never send commands on a pipe where the local gate is the identity management
+ * gate, so only commands should be processed.
+ */
+ if (nfa_hci_cb.type != NFA_HCI_COMMAND_TYPE)
+ return;
+
+ switch (nfa_hci_cb.inst)
+ {
+ case NFA_HCI_ANY_GET_PARAMETER:
+ index = *(p_data++);
+ if (p_pipe->pipe_state == NFA_HCI_PIPE_OPENED)
+ {
+ switch (index)
+ {
+ case NFA_HCI_VERSION_SW_INDEX:
+ data[0] = (UINT8) ((NFA_HCI_VERSION_SW >> 16 ) & 0xFF);
+ data[1] = (UINT8) ((NFA_HCI_VERSION_SW >> 8 ) & 0xFF);
+ data[2] = (UINT8) ((NFA_HCI_VERSION_SW ) & 0xFF);
+ rsp_len = 3;
+ break;
+
+ case NFA_HCI_HCI_VERSION_INDEX:
+ data[0] = NFA_HCI_VERSION;
+ rsp_len = 1;
+ break;
+
+ case NFA_HCI_VERSION_HW_INDEX:
+ data[0] = (UINT8) ((NFA_HCI_VERSION_HW >> 16 ) & 0xFF);
+ data[1] = (UINT8) ((NFA_HCI_VERSION_HW >> 8 ) & 0xFF);
+ data[2] = (UINT8) ((NFA_HCI_VERSION_HW ) & 0xFF);
+ rsp_len = 3;
+ break;
+
+ case NFA_HCI_VENDOR_NAME_INDEX:
+ memcpy (data,NFA_HCI_VENDOR_NAME,strlen (NFA_HCI_VENDOR_NAME));
+ rsp_len = (UINT8) strlen (NFA_HCI_VENDOR_NAME);
+ break;
+
+ case NFA_HCI_MODEL_ID_INDEX:
+ data[0] = NFA_HCI_MODEL_ID;
+ rsp_len = 1;
+ break;
+
+ case NFA_HCI_GATES_LIST_INDEX:
+ gate_rsp[0] = NFA_HCI_LOOP_BACK_GATE;
+ gate_rsp[1] = NFA_HCI_IDENTITY_MANAGEMENT_GATE;
+ gate_rsp[2] = NFA_HCI_CONNECTIVITY_GATE;
+ num_gates = nfa_hciu_get_allocated_gate_list (&gate_rsp[3]);
+ rsp_len = num_gates + 3;
+ p_rsp = gate_rsp;
+ break;
+
+ default:
+ response = NFA_HCI_ANY_E_NOK;
+ break;
+ }
+ }
+ else
+ {
+ response = NFA_HCI_ANY_E_PIPE_NOT_OPENED;
+ }
+ break;
+
+ case NFA_HCI_ANY_OPEN_PIPE:
+ data[0] = 0;
+ rsp_len = 1;
+ p_pipe->pipe_state = NFA_HCI_PIPE_OPENED;
+ break;
+
+ case NFA_HCI_ANY_CLOSE_PIPE:
+ p_pipe->pipe_state = NFA_HCI_PIPE_CLOSED;
+ break;
+
+ default:
+ response = NFA_HCI_ANY_E_CMD_NOT_SUPPORTED;
+ break;
+ }
+
+ nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_RESPONSE_TYPE, response, rsp_len, p_rsp);
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_generic_gate_cmd
+**
+** Description This function handles all generic gates (excluding
+** connectivity gate) commands
+**
+** Returns none
+**
+*******************************************************************************/
+static void nfa_hci_handle_generic_gate_cmd (UINT8 *p_data, UINT8 data_len, tNFA_HCI_DYN_GATE *p_gate, tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_HANDLE app_handle = nfa_hciu_get_pipe_owner (p_pipe->pipe_id);
+
+ switch (nfa_hci_cb.inst)
+ {
+ case NFA_HCI_ANY_SET_PARAMETER:
+ evt_data.registry.pipe = p_pipe->pipe_id;
+ evt_data.registry.index = *p_data++;
+ if (data_len > 0)
+ data_len--;
+ evt_data.registry.data_len = data_len;
+
+ if (data_len <= NFA_MAX_HCI_DATA_LEN)
+ memcpy (evt_data.registry.reg_data, p_data, data_len);
+
+ nfa_hciu_send_to_app (NFA_HCI_SET_REG_CMD_EVT, &evt_data, app_handle);
+ break;
+
+ case NFA_HCI_ANY_GET_PARAMETER:
+ evt_data.registry.pipe = p_pipe->pipe_id;
+ evt_data.registry.index = *p_data;
+ evt_data.registry.data_len = 0;
+
+ nfa_hciu_send_to_app (NFA_HCI_GET_REG_CMD_EVT, &evt_data, app_handle);
+ break;
+
+ case NFA_HCI_ANY_OPEN_PIPE:
+ nfa_hci_handle_pipe_open_close_cmd (p_pipe);
+
+ evt_data.opened.pipe = p_pipe->pipe_id;
+ evt_data.opened.status = NFA_STATUS_OK;
+
+ nfa_hciu_send_to_app (NFA_HCI_OPEN_PIPE_EVT, &evt_data, app_handle);
+ break;
+
+ case NFA_HCI_ANY_CLOSE_PIPE:
+ nfa_hci_handle_pipe_open_close_cmd (p_pipe);
+
+ evt_data.closed.pipe = p_pipe->pipe_id;
+ evt_data.opened.status = NFA_STATUS_OK;
+
+ nfa_hciu_send_to_app (NFA_HCI_CLOSE_PIPE_EVT, &evt_data, app_handle);
+ break;
+
+ default:
+ /* Could be application specific command, pass it on */
+ evt_data.cmd_rcvd.status = NFA_STATUS_OK;
+ evt_data.cmd_rcvd.pipe = p_pipe->pipe_id;;
+ evt_data.cmd_rcvd.cmd_code = nfa_hci_cb.inst;
+ evt_data.cmd_rcvd.cmd_len = data_len;
+
+ if (data_len <= NFA_MAX_HCI_CMD_LEN)
+ memcpy (evt_data.cmd_rcvd.cmd_data, p_data, data_len);
+
+ nfa_hciu_send_to_app (NFA_HCI_CMD_RCVD_EVT, &evt_data, app_handle);
+ break;
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_generic_gate_rsp
+**
+** Description This function handles all generic gates (excluding
+** connectivity) response
+**
+** Returns none
+**
+*******************************************************************************/
+static void nfa_hci_handle_generic_gate_rsp (UINT8 *p_data, UINT8 data_len, tNFA_HCI_DYN_GATE *p_gate, tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+ tNFA_STATUS status = NFA_STATUS_OK;
+
+ if (nfa_hci_cb.inst != NFA_HCI_ANY_OK)
+ status = NFA_STATUS_FAILED;
+
+ if (nfa_hci_cb.cmd_sent == NFA_HCI_ANY_OPEN_PIPE)
+ {
+ if (status == NFA_STATUS_OK)
+ p_pipe->pipe_state = NFA_HCI_PIPE_OPENED;
+
+ nfa_hci_cb.nv_write_needed = TRUE;
+ /* Tell application */
+ evt_data.opened.status = status;
+ evt_data.opened.pipe = p_pipe->pipe_id;
+
+ nfa_hciu_send_to_app (NFA_HCI_OPEN_PIPE_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ else if (nfa_hci_cb.cmd_sent == NFA_HCI_ANY_CLOSE_PIPE)
+ {
+ p_pipe->pipe_state = NFA_HCI_PIPE_CLOSED;
+
+ nfa_hci_cb.nv_write_needed = TRUE;
+ /* Tell application */
+ evt_data.opened.status = status;;
+ evt_data.opened.pipe = p_pipe->pipe_id;
+
+ nfa_hciu_send_to_app (NFA_HCI_CLOSE_PIPE_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ else if (nfa_hci_cb.cmd_sent == NFA_HCI_ANY_GET_PARAMETER)
+ {
+ /* Tell application */
+ evt_data.registry.status = status;
+ evt_data.registry.pipe = p_pipe->pipe_id;
+ evt_data.registry.data_len = data_len;
+ evt_data.registry.index = nfa_hci_cb.param_in_use;
+
+ memcpy (evt_data.registry.reg_data, p_data, data_len);
+
+ nfa_hciu_send_to_app (NFA_HCI_GET_REG_RSP_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ else if (nfa_hci_cb.cmd_sent == NFA_HCI_ANY_SET_PARAMETER)
+ {
+ /* Tell application */
+ evt_data.registry.status = status;;
+ evt_data.registry.pipe = p_pipe->pipe_id;
+
+ nfa_hciu_send_to_app (NFA_HCI_SET_REG_RSP_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+ else
+ {
+ /* Could be a response to application specific command sent, pass it on */
+ evt_data.rsp_rcvd.status = NFA_STATUS_OK;
+ evt_data.rsp_rcvd.pipe = p_pipe->pipe_id;;
+ evt_data.rsp_rcvd.rsp_code = nfa_hci_cb.inst;
+ evt_data.rsp_rcvd.rsp_len = data_len;
+
+ if (data_len <= NFA_MAX_HCI_RSP_LEN)
+ memcpy (evt_data.rsp_rcvd.rsp_data, p_data, data_len);
+
+ nfa_hciu_send_to_app (NFA_HCI_RSP_RCVD_EVT, &evt_data, nfa_hci_cb.app_in_use);
+ }
+
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_connectivity_gate_pkt
+**
+** Description This function handles incoming connectivity gate packets
+**
+** Returns none
+**
+*******************************************************************************/
+static void nfa_hci_handle_connectivity_gate_pkt (UINT8 *p_data, UINT16 data_len, tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+
+ if (nfa_hci_cb.type == NFA_HCI_COMMAND_TYPE)
+ {
+ switch (nfa_hci_cb.inst)
+ {
+ case NFA_HCI_ANY_OPEN_PIPE:
+ case NFA_HCI_ANY_CLOSE_PIPE:
+ nfa_hci_handle_pipe_open_close_cmd (p_pipe);
+ break;
+
+ case NFA_HCI_CON_PRO_HOST_REQUEST:
+ /* A request to the DH to activate another host. This is not supported for */
+ /* now, we will implement it when the spec is clearer and UICCs need it. */
+ nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_RESPONSE_TYPE, NFA_HCI_ANY_E_CMD_NOT_SUPPORTED, 0, NULL);
+ break;
+
+ default:
+ nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_RESPONSE_TYPE, NFA_HCI_ANY_E_CMD_NOT_SUPPORTED, 0, NULL);
+ break;
+ }
+ }
+ else if (nfa_hci_cb.type == NFA_HCI_RESPONSE_TYPE)
+ {
+ if ((nfa_hci_cb.cmd_sent == NFA_HCI_ANY_OPEN_PIPE) && (nfa_hci_cb.inst == NFA_HCI_ANY_OK))
+ p_pipe->pipe_state = NFA_HCI_PIPE_OPENED;
+ else if (nfa_hci_cb.cmd_sent == NFA_HCI_ANY_CLOSE_PIPE)
+ p_pipe->pipe_state = NFA_HCI_PIPE_CLOSED;
+ }
+ else if (nfa_hci_cb.type == NFA_HCI_EVENT_TYPE)
+ {
+ evt_data.rcvd_evt.pipe = p_pipe->pipe_id;
+ evt_data.rcvd_evt.evt_code = nfa_hci_cb.inst;
+ evt_data.rcvd_evt.evt_len = data_len;
+ evt_data.rcvd_evt.p_evt_buf = p_data;
+
+ /* notify NFA_HCI_EVENT_RCVD_EVT to the application */
+ nfa_hciu_send_to_apps_handling_connectivity_evts (NFA_HCI_EVENT_RCVD_EVT, &evt_data);
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_loopback_gate_pkt
+**
+** Description This function handles incoming loopback gate hci events
+**
+** Returns none
+**
+*******************************************************************************/
+static void nfa_hci_handle_loopback_gate_pkt (UINT8 *p_data, UINT16 data_len, tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ UINT8 data[1];
+ UINT8 rsp_len = 0;
+ tNFA_HCI_RESPONSE response = NFA_HCI_ANY_OK;
+
+
+ /* Check if data packet is a command, response or event */
+ if (nfa_hci_cb.type == NFA_HCI_COMMAND_TYPE)
+ {
+ if (nfa_hci_cb.inst == NFA_HCI_ANY_OPEN_PIPE)
+ {
+ data[0] = 0;
+ rsp_len = 1;
+ p_pipe->pipe_state = NFA_HCI_PIPE_OPENED;
+ }
+ else if (nfa_hci_cb.inst == NFA_HCI_ANY_CLOSE_PIPE)
+ {
+ p_pipe->pipe_state = NFA_HCI_PIPE_CLOSED;
+ }
+ else
+ response = NFA_HCI_ANY_E_PIPE_NOT_OPENED;
+
+ nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_RESPONSE_TYPE, response, rsp_len, data);
+ }
+ else if (nfa_hci_cb.type == NFA_HCI_RESPONSE_TYPE)
+ {
+ /* Since we never send any commands on our local loopback gate,
+ * there should not be any response.
+ */
+ }
+ else if (nfa_hci_cb.type == NFA_HCI_EVENT_TYPE)
+ {
+ if (nfa_hci_cb.inst == NFA_HCI_EVT_POST_DATA)
+ {
+ /* Send back the same data we got */
+ nfa_hciu_send_msg (p_pipe->pipe_id, NFA_HCI_EVENT_TYPE, NFA_HCI_EVT_POST_DATA, data_len, p_data);
+ }
+ }
+}
+
+/*******************************************************************************
+**
+** Function nfa_hci_handle_generic_gate_evt
+**
+** Description This function handles incoming Generic gate hci events
+**
+** Returns none
+**
+*******************************************************************************/
+static void nfa_hci_handle_generic_gate_evt (UINT8 *p_data, UINT16 data_len, tNFA_HCI_DYN_GATE *p_gate, tNFA_HCI_DYN_PIPE *p_pipe)
+{
+ tNFA_HCI_EVT_DATA evt_data;
+
+ evt_data.rcvd_evt.pipe = p_pipe->pipe_id;
+ evt_data.rcvd_evt.evt_code = nfa_hci_cb.inst;
+ evt_data.rcvd_evt.evt_len = data_len;
+
+ if (nfa_hci_cb.assembly_failed)
+ evt_data.rcvd_evt.status = NFA_STATUS_BUFFER_FULL;
+ else
+ evt_data.rcvd_evt.status = NFA_STATUS_OK;
+
+ evt_data.rcvd_evt.p_evt_buf = p_data;
+ nfa_hci_cb.rsp_buf_size = 0;
+ nfa_hci_cb.p_rsp_buf = NULL;
+
+ /* notify NFA_HCI_EVENT_RCVD_EVT to the application */
+ nfa_hciu_send_to_app (NFA_HCI_EVENT_RCVD_EVT, &evt_data, p_gate->gate_owner);
+}
+