/***************************************************************************** ** ** Function rw_t1t_handle_rid_rsp ** ** Description Handles response to RID: Collects HR, UID, notify up the ** stack ** ** Returns event to notify application ** *****************************************************************************/ static tRW_EVENT rw_t1t_handle_rid_rsp (BT_HDR *p_pkt) { tRW_T1T_CB *p_t1t = &rw_cb.tcb.t1t; tRW_DATA evt_data; UINT8 *p_rid_rsp; evt_data.status = NFC_STATUS_OK; evt_data.data.p_data = p_pkt; /* Assume the data is just the response byte sequence */ p_rid_rsp = (UINT8 *) (p_pkt + 1) + p_pkt->offset; /* Response indicates tag is present */ if (p_t1t->state == RW_T1T_STATE_CHECK_PRESENCE) { /* If checking for the presence of the tag then just notify */ return RW_T1T_PRESENCE_CHECK_EVT; } /* Extract HR and UID from response */ STREAM_TO_ARRAY (p_t1t->hr, p_rid_rsp, T1T_HR_LEN); #if (BT_TRACE_VERBOSE == TRUE) RW_TRACE_DEBUG2 ("hr0:0x%x, hr1:0x%x", p_t1t->hr[0], p_t1t->hr[1]); RW_TRACE_DEBUG4 ("rw_t1t_handle_rid_rsp (): UID0-3=%02x%02x%02x%02x", p_rid_rsp[0], p_rid_rsp[1], p_rid_rsp[2], p_rid_rsp[3]); #else RW_TRACE_DEBUG0 ("rw_t1t_handle_rid_rsp ()"); #endif /* Fetch UID0-3 from RID response message */ STREAM_TO_ARRAY (p_t1t->mem, p_rid_rsp, T1T_CMD_UID_LEN); /* Notify RID response Event */ return RW_T1T_RID_EVT; }
/******************************************************************************* ** ** Function nfc_enabled ** ** Description NFCC enabled, proceed with stack start up. ** ** Returns void ** *******************************************************************************/ void nfc_enabled (tNFC_STATUS nfc_status, BT_HDR *p_init_rsp_msg) { tNFC_RESPONSE evt_data; tNFC_CONN_CB *p_cb = &nfc_cb.conn_cb[NFC_RF_CONN_ID]; UINT8 *p; UINT8 num_interfaces = 0, xx; int yy = 0; memset (&evt_data, 0, sizeof (tNFC_RESPONSE)); if (nfc_status == NCI_STATUS_OK) { nfc_set_state (NFC_STATE_IDLE); p = (UINT8 *) (p_init_rsp_msg + 1) + p_init_rsp_msg->offset + NCI_MSG_HDR_SIZE + 1; /* we currently only support NCI of the same version. * We may need to change this, when we support multiple version of NFCC */ evt_data.enable.nci_version = NCI_VERSION; STREAM_TO_UINT32 (evt_data.enable.nci_features, p); STREAM_TO_UINT8 (num_interfaces, p); evt_data.enable.nci_interfaces = 0; for (xx = 0; xx < num_interfaces; xx++) { if ((*p) <= NCI_INTERFACE_MAX) evt_data.enable.nci_interfaces |= (1 << (*p)); #if(NFC_NXP_NOT_OPEN_INCLUDED == TRUE) else if (((*p) >= NCI_INTERFACE_FIRST_VS) && (yy < NFC_NFCC_MAX_NUM_VS_INTERFACE)) #else else if (((*p) > NCI_INTERFACE_FIRST_VS) && (yy < NFC_NFCC_MAX_NUM_VS_INTERFACE)) #endif { /* save the VS RF interface in control block, if there's still room */ nfc_cb.vs_interface[yy++] = *p; } p++; } nfc_cb.nci_interfaces = evt_data.enable.nci_interfaces; memcpy (evt_data.enable.vs_interface, nfc_cb.vs_interface, NFC_NFCC_MAX_NUM_VS_INTERFACE); evt_data.enable.max_conn = *p++; STREAM_TO_UINT16 (evt_data.enable.max_ce_table, p); #if (NFC_RW_ONLY == FALSE) nfc_cb.max_ce_table = evt_data.enable.max_ce_table; nfc_cb.nci_features = evt_data.enable.nci_features; nfc_cb.max_conn = evt_data.enable.max_conn; #endif nfc_cb.nci_ctrl_size = *p++; /* Max Control Packet Payload Length */ p_cb->init_credits = p_cb->num_buff = 0; STREAM_TO_UINT16 (evt_data.enable.max_param_size, p); nfc_set_conn_id (p_cb, NFC_RF_CONN_ID); evt_data.enable.manufacture_id = *p++; STREAM_TO_ARRAY (evt_data.enable.nfcc_info, p, NFC_NFCC_INFO_LEN); NFC_DiscoveryMap (nfc_cb.num_disc_maps, (tNCI_DISCOVER_MAPS *) nfc_cb.p_disc_maps, NULL); }
/******************************************************************************* ** ** Function nfc_hal_prm_spd_send_next_segment ** ** Description Send next patch segment (for secure patch download) ** ** Returns void ** *******************************************************************************/ void nfc_hal_prm_spd_send_next_segment (void) { UINT8 *p_src; UINT16 len, offset = nfc_hal_cb.prm.cur_patch_offset; UINT8 hcit, oid, hdr0, type; UINT8 chipverlen; UINT8 chipverstr[NCI_SPD_HEADER_CHIPVER_LEN]; UINT8 patch_hdr_size = NCI_MSG_HDR_SIZE + 1; /* 1 is for HCIT */ /* Validate that segment is at least big enought to have NCI_MSG_HDR_SIZE + 1 (hcit) */ if (nfc_hal_cb.prm.cur_patch_len_remaining < patch_hdr_size) { HAL_TRACE_ERROR0 ("Unexpected end of patch."); nfc_hal_prm_spd_handle_download_complete (NFC_HAL_PRM_ABORT_INVALID_PATCH_EVT); return; } /* Parse NCI command header */ p_src = (UINT8*) (nfc_hal_cb.prm.p_cur_patch_data + offset); STREAM_TO_UINT8 (hcit, p_src); STREAM_TO_UINT8 (hdr0, p_src); STREAM_TO_UINT8 (oid, p_src); STREAM_TO_UINT8 (len, p_src); STREAM_TO_UINT8 (type, p_src); /* Update number of bytes comsumed */ nfc_hal_cb.prm.cur_patch_offset += (len + patch_hdr_size); nfc_hal_cb.prm.cur_patch_len_remaining -= (len + patch_hdr_size); /* Check if sending signature byte */ if ( (oid == NCI_MSG_SECURE_PATCH_DOWNLOAD ) &&(type == NCI_SPD_TYPE_SIGNATURE) ) { nfc_hal_cb.prm.flags |= NFC_HAL_PRM_FLAGS_SIGNATURE_SENT; } /* Check for header */ else if ( (oid == NCI_MSG_SECURE_PATCH_DOWNLOAD ) &&(type == NCI_SPD_TYPE_HEADER) ) { /* Check if patch is for BCM20791B3 */ p_src += NCI_SPD_HEADER_OFFSET_CHIPVERLEN; STREAM_TO_UINT8 (chipverlen, p_src); if (memcmp (nfc_hal_cb.nvm_cb.chip_ver, p_src, chipverlen) != 0) { HAL_TRACE_ERROR0 ("Unexpected chip ver."); nfc_hal_prm_spd_handle_download_complete (NFC_HAL_PRM_ABORT_INVALID_PATCH_EVT); return; } STREAM_TO_ARRAY (chipverstr, p_src, NCI_SPD_HEADER_CHIPVER_LEN); if (memcmp (NFC_HAL_PRM_BCM20791B3_STR, chipverstr, NFC_HAL_PRM_BCM20791B3_STR_LEN) == 0) { /* Patch is for BCM2079B3 - do not wait for RESET_NTF after patch download */ nfc_hal_cb.prm.flags |= NFC_HAL_PRM_FLAGS_BCM20791B3; } else { /* Patch is for BCM2079B4 or newer - wait for RESET_NTF after patch download */ nfc_hal_cb.prm.flags &= ~NFC_HAL_PRM_FLAGS_BCM20791B3; } } /* Send the command (not including HCIT here) */ nfc_hal_dm_send_nci_cmd ((UINT8*) (nfc_hal_cb.prm.p_cur_patch_data + offset + 1), (UINT8) (len + NCI_MSG_HDR_SIZE), nfc_hal_prm_nci_command_complete_cback); }
/******************************************************************************* ** ** Function nci_proc_ee_management_ntf ** ** Description Process NCI notifications in the NFCEE Management group ** ** Returns void ** *******************************************************************************/ void nci_proc_ee_management_ntf (BT_HDR *p_msg) { UINT8 *p; UINT8 *pp, len, op_code; tNFC_RESPONSE_CBACK *p_cback = nfc_cb.p_resp_cback; tNFC_NFCEE_INFO_REVT nfcee_info; tNFC_RESPONSE *p_evt = (tNFC_RESPONSE *) &nfcee_info; tNFC_RESPONSE_EVT event = NFC_NFCEE_INFO_REVT; UINT8 xx; UINT8 yy; UINT8 ee_status; tNFC_NFCEE_TLV *p_tlv; /* find the start of the NCI message and parse the NCI header */ p = (UINT8 *) (p_msg + 1) + p_msg->offset; pp = p+1; NCI_MSG_PRS_HDR1 (pp, op_code); NFC_TRACE_DEBUG1 ("nci_proc_ee_management_ntf opcode:0x%x", op_code); len = *pp++; if (op_code == NCI_MSG_NFCEE_DISCOVER) { nfcee_info.nfcee_id = *pp++; ee_status = *pp++; nfcee_info.ee_status = ee_status; yy = *pp; nfcee_info.num_interface = *pp++; p = pp; if (nfcee_info.num_interface > NFC_MAX_EE_INTERFACE) nfcee_info.num_interface = NFC_MAX_EE_INTERFACE; for (xx = 0; xx < nfcee_info.num_interface; xx++) { nfcee_info.ee_interface[xx] = *pp++; } pp = p + yy; nfcee_info.num_tlvs = *pp++; NFC_TRACE_DEBUG4 ("nfcee_id: 0x%x num_interface:0x%x/0x%x, num_tlvs:0x%x", nfcee_info.nfcee_id, nfcee_info.num_interface, yy, nfcee_info.num_tlvs); if (nfcee_info.num_tlvs > NFC_MAX_EE_TLVS) nfcee_info.num_tlvs = NFC_MAX_EE_TLVS; p_tlv = &nfcee_info.ee_tlv[0]; for (xx = 0; xx < nfcee_info.num_tlvs; xx++, p_tlv++) { p_tlv->tag = *pp++; p_tlv->len = yy = *pp++; NFC_TRACE_DEBUG2 ("tag:0x%x, len:0x%x", p_tlv->tag, p_tlv->len); if (p_tlv->len > NFC_MAX_EE_INFO) p_tlv->len = NFC_MAX_EE_INFO; p = pp; STREAM_TO_ARRAY (p_tlv->info, pp, p_tlv->len); pp = p += yy; } } else { p_cback = NULL; NFC_TRACE_ERROR1 ("unknown opcode:0x%x", op_code); } if (p_cback) (*p_cback) (event, p_evt); }
/******************************************************************************* ** ** Function nfc_hal_dm_proc_msg_during_init ** ** Description Process NCI message while initializing NFCC ** ** Returns void ** *******************************************************************************/ void nfc_hal_dm_proc_msg_during_init (NFC_HDR *p_msg) { UINT8 *p; UINT8 reset_reason, reset_type; UINT8 mt, pbf, gid, op_code; UINT8 *p_old, old_gid, old_oid, old_mt; UINT8 u8; tNFC_HAL_NCI_CBACK *p_cback = NULL; UINT8 chipverlen; UINT8 chipverstr[NCI_SPD_HEADER_CHIPVER_LEN]; UINT32 hw_id = 0; HAL_TRACE_DEBUG1 ("nfc_hal_dm_proc_msg_during_init(): init state:%d", nfc_hal_cb.dev_cb.initializing_state); p = (UINT8 *) (p_msg + 1) + p_msg->offset; NCI_MSG_PRS_HDR0 (p, mt, pbf, gid); NCI_MSG_PRS_HDR1 (p, op_code); /* check if waiting for this response */ if ( (nfc_hal_cb.ncit_cb.nci_wait_rsp == NFC_HAL_WAIT_RSP_CMD) ||(nfc_hal_cb.ncit_cb.nci_wait_rsp == NFC_HAL_WAIT_RSP_VSC) ) { if (mt == NCI_MT_RSP) { p_old = nfc_hal_cb.ncit_cb.last_hdr; NCI_MSG_PRS_HDR0 (p_old, old_mt, pbf, old_gid); old_oid = ((*p_old) & NCI_OID_MASK); /* make sure this is the RSP we are waiting for before updating the command window */ if ((old_gid == gid) && (old_oid == op_code)) { nfc_hal_cb.ncit_cb.nci_wait_rsp = NFC_HAL_WAIT_RSP_NONE; p_cback = (tNFC_HAL_NCI_CBACK *)nfc_hal_cb.ncit_cb.p_vsc_cback; nfc_hal_cb.ncit_cb.p_vsc_cback = NULL; nfc_hal_main_stop_quick_timer (&nfc_hal_cb.ncit_cb.nci_wait_rsp_timer); } } } if (gid == NCI_GID_CORE) { if (op_code == NCI_MSG_CORE_RESET) { if (mt == NCI_MT_NTF) { if ( (nfc_hal_cb.dev_cb.initializing_state == NFC_HAL_INIT_STATE_W4_NFCC_ENABLE) ||(nfc_hal_cb.dev_cb.initializing_state == NFC_HAL_INIT_STATE_POST_XTAL_SET) ) { /* ** Core reset ntf in the following cases; ** 1) after power up (raising REG_PU) ** 2) after setting xtal index ** Start pre-initializing NFCC */ nfc_hal_main_stop_quick_timer (&nfc_hal_cb.timer); nfc_hal_dm_pre_init_nfcc (); } else { /* Core reset ntf after post-patch download, Call reset notification callback */ p++; /* Skip over param len */ STREAM_TO_UINT8 (reset_reason, p); STREAM_TO_UINT8 (reset_type, p); nfc_hal_prm_spd_reset_ntf (reset_reason, reset_type); } } } else if (p_cback) { (*p_cback) ((tNFC_HAL_NCI_EVT) (op_code), p_msg->len, (UINT8 *) (p_msg + 1) + p_msg->offset); } } else if (gid == NCI_GID_PROP) /* this is for download patch */ { if (mt == NCI_MT_NTF) op_code |= NCI_NTF_BIT; else op_code |= NCI_RSP_BIT; if (nfc_hal_cb.dev_cb.initializing_state == NFC_HAL_INIT_STATE_W4_XTAL_SET) { if (op_code == (NCI_RSP_BIT|NCI_MSG_GET_XTAL_INDEX_FROM_DH)) { /* start timer in case that NFCC doesn't send RESET NTF after loading patch from NVM */ NFC_HAL_SET_INIT_STATE (NFC_HAL_INIT_STATE_POST_XTAL_SET); nfc_hal_main_start_quick_timer (&nfc_hal_cb.timer, NFC_HAL_TTYPE_NFCC_ENABLE, ((p_nfc_hal_cfg->nfc_hal_post_xtal_timeout)*QUICK_TIMER_TICKS_PER_SEC)/1000); } } else if ( (op_code == NFC_VS_GET_BUILD_INFO_EVT) &&(nfc_hal_cb.dev_cb.initializing_state == NFC_HAL_INIT_STATE_W4_BUILD_INFO) ) { p += NCI_BUILD_INFO_OFFSET_HWID; STREAM_TO_UINT32 (hw_id, p); nfc_hal_cb.dev_cb.brcm_hw_id = nfc_hal_dm_adjust_hw_id (hw_id); HAL_TRACE_DEBUG2 ("brcm_hw_id: 0x%x -> 0x%x", hw_id, nfc_hal_cb.dev_cb.brcm_hw_id); STREAM_TO_UINT8 (chipverlen, p); memset (chipverstr, 0, NCI_SPD_HEADER_CHIPVER_LEN); STREAM_TO_ARRAY (chipverstr, p, chipverlen); nfc_hal_hci_handle_build_info (chipverlen, chipverstr); nfc_hal_cb.pre_set_mem_idx = 0; if (!nfc_hal_dm_check_pre_set_mem()) { /* pre-set mem started */ return; } nfc_hal_dm_check_xtal(); } else if ( (op_code == NFC_VS_GET_PATCH_VERSION_EVT) &&(nfc_hal_cb.dev_cb.initializing_state == NFC_HAL_INIT_STATE_W4_PATCH_INFO) ) { /* Store NVM info to control block */ /* Skip over rsp len */ p++; /* Get project id */ STREAM_TO_UINT16 (nfc_hal_cb.nvm_cb.project_id, p); /* RFU */ p++; /* Get chip version string */ STREAM_TO_UINT8 (u8, p); if (u8 > NFC_HAL_PRM_MAX_CHIP_VER_LEN) u8 = NFC_HAL_PRM_MAX_CHIP_VER_LEN; memcpy (nfc_hal_cb.nvm_cb.chip_ver, p, u8); p += NCI_PATCH_INFO_VERSION_LEN; /* Get major/minor version */ STREAM_TO_UINT16 (nfc_hal_cb.nvm_cb.ver_major, p); STREAM_TO_UINT16 (nfc_hal_cb.nvm_cb.ver_minor, p); /* Skip over max_size and patch_max_size */ p += 4; /* Get current lpm patch size */ STREAM_TO_UINT16 (nfc_hal_cb.nvm_cb.lpm_size, p); STREAM_TO_UINT16 (nfc_hal_cb.nvm_cb.fpm_size, p); /* clear all flags which may be set during previous initialization */ nfc_hal_cb.nvm_cb.flags = 0; /* Set patch present flag */ if ((nfc_hal_cb.nvm_cb.fpm_size) || (nfc_hal_cb.nvm_cb.lpm_size)) nfc_hal_cb.nvm_cb.flags |= NFC_HAL_NVM_FLAGS_PATCH_PRESENT; /* LPMPatchCodeHasBadCRC (if not bad crc, then indicate LPM patch is present in nvm) */ STREAM_TO_UINT8 (u8, p); if (u8) { /* LPM patch in NVM fails CRC check */ nfc_hal_cb.nvm_cb.flags |= NFC_HAL_NVM_FLAGS_LPM_BAD; } /* FPMPatchCodeHasBadCRC (if not bad crc, then indicate LPM patch is present in nvm) */ STREAM_TO_UINT8 (u8, p); if (u8) { /* FPM patch in NVM fails CRC check */ nfc_hal_cb.nvm_cb.flags |= NFC_HAL_NVM_FLAGS_FPM_BAD; } /* Check if downloading patch to RAM only (no NVM) */ STREAM_TO_UINT8 (nfc_hal_cb.nvm_cb.nvm_type, p); if (nfc_hal_cb.nvm_cb.nvm_type == NCI_SPD_NVM_TYPE_NONE) { nfc_hal_cb.nvm_cb.flags |= NFC_HAL_NVM_FLAGS_NO_NVM; } /* let platform update baudrate or download patch */ NFC_HAL_SET_INIT_STATE (NFC_HAL_INIT_STATE_W4_APP_COMPLETE); nfc_hal_post_reset_init (nfc_hal_cb.dev_cb.brcm_hw_id, nfc_hal_cb.nvm_cb.nvm_type); } else if (p_cback) { (*p_cback) ((tNFC_HAL_NCI_EVT) (op_code), p_msg->len, (UINT8 *) (p_msg + 1) + p_msg->offset); } else if (op_code == NFC_VS_SEC_PATCH_AUTH_EVT) { HAL_TRACE_DEBUG0 ("signature!!"); nfc_hal_prm_nci_command_complete_cback ((tNFC_HAL_NCI_EVT) (op_code), p_msg->len, (UINT8 *) (p_msg + 1) + p_msg->offset); } } }