static NFCSTATUS phFriNfc_TopazDynamicFormat_ProcessWritingTermTlvBytes(phFriNfc_sNdefSmtCrdFmt_t* NdefSmtCrdFmt) { static const uint8_t c_expectedResponse[] = { PH_FRINFC_TOPAZ_TLV_TERM_T, /* Terminator TLV */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* Rest of data bytes are zeros */ }; NFCSTATUS wStatus = NFCSTATUS_SUCCESS; PH_LOG_NDEF_FUNC_ENTRY(); assert(NdefSmtCrdFmt != NULL); if ((*NdefSmtCrdFmt->SendRecvLength != sizeof(c_expectedResponse)) || (0 != phOsalNfc_MemCompare(NdefSmtCrdFmt->SendRecvBuf, (void*)c_expectedResponse, sizeof(c_expectedResponse)))) { PH_LOG_NDEF_WARN_STR("Unexpected response received. Formatting failed"); wStatus = PHNFCSTVAL(CID_FRI_NFC_NDEF_SMTCRDFMT, NFCSTATUS_FORMAT_ERROR); } else { PH_LOG_NDEF_INFO_STR("Successfully formatted dynamic Topaz card"); } PH_LOG_NDEF_FUNC_EXIT(); return wStatus; }
static NFCSTATUS phFriNfc_TopazDynamicFormat_ProcessWritingMemCtrlBytes(phFriNfc_sNdefSmtCrdFmt_t* NdefSmtCrdFmt) { static const uint8_t c_expectedResponse[] = { PH_FRINFC_TOPAZ_TLV_LOCK_CTRL_V2, /* Lock control bytes */ PH_FRINFC_TOPAZ_TLV_MEM_CTRL_T, PH_FRINFC_TOPAZ_TLV_MEM_CTRL_L, PH_FRINFC_TOPAZ_TLV_MEM_CTRL_V0, PH_FRINFC_TOPAZ_TLV_MEM_CTRL_V1, PH_FRINFC_TOPAZ_TLV_MEM_CTRL_V2, /* Memory control bytes */ PH_FRINFC_TOPAZ_TLV_NDEF_T, PH_FRINFC_TOPAZ_TLV_NDEF_L, /* NDEF TLV */ }; uint8_t write8Cmd[] = { PH_FRINFC_TOPAZ_CMD_WRITE_E8, /* WRITE-E8 */ 0x03, /* Block 0x3 */ PH_FRINFC_TOPAZ_TLV_TERM_T, /* Terminator TLV */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* Rest of data bytes are zeros */ 0x00, 0x00, 0x00, 0x00 /* UID bytes (need to be copied over) */ }; NFCSTATUS wStatus = NFCSTATUS_SUCCESS; PH_LOG_NDEF_FUNC_ENTRY(); assert(NdefSmtCrdFmt != NULL); if ((*NdefSmtCrdFmt->SendRecvLength != sizeof(c_expectedResponse)) || (0 != phOsalNfc_MemCompare(NdefSmtCrdFmt->SendRecvBuf, (void*)c_expectedResponse, sizeof(c_expectedResponse)))) { PH_LOG_NDEF_WARN_STR("Unexpected response received. Formatting failed"); wStatus = PHNFCSTVAL(CID_FRI_NFC_NDEF_SMTCRDFMT, NFCSTATUS_FORMAT_ERROR); } else { /* Copy the UID to the end of command buffer */ phOsalNfc_MemCopy(&write8Cmd[10], NdefSmtCrdFmt->psRemoteDevInfo->RemoteDevInfo.Jewel_Info.Uid, TOPAZ_UID_LENGTH); NdefSmtCrdFmt->State = PH_FRINFC_TOPAZ_STATE_WRITE_TERM_TLV_BYTES; wStatus = phFriNfc_TopazFormat_Transceive(NdefSmtCrdFmt, write8Cmd, sizeof(write8Cmd)); } PH_LOG_NDEF_FUNC_EXIT(); return wStatus; }
static NFCSTATUS phFriNfc_ISO15693_H_GetMaxDataSize ( phFriNfc_sNdefSmtCrdFmt_t *psNdefSmtCrdFmt, uint8_t *p_recv_buf, uint8_t recv_length) { NFCSTATUS result = NFCSTATUS_SUCCESS; phFriNfc_ISO15693_AddInfo_t *ps_iso15693_info = &(psNdefSmtCrdFmt->AddInfo.s_iso15693_info); phHal_sIso15693Info_t *ps_rem_iso_15693_info = &(psNdefSmtCrdFmt->psRemoteDevInfo->RemoteDevInfo.Iso15693_Info); uint8_t recv_index = 0; if ((ISO15693_GET_SYS_INFO_RESP_LEN == recv_length) && (ISO15693_MAX_SIZE_MASK == (*p_recv_buf & ISO15693_MAX_SIZE_MASK))) { uint8_t information_flag = *p_recv_buf; /* MAX size is present in the system information and also response length is correct */ recv_index = (uint8_t)(recv_index + 1); if (!phOsalNfc_MemCompare ((void *)ps_rem_iso_15693_info->Uid, (void *)(p_recv_buf + recv_index), ps_rem_iso_15693_info->UidLength)) { /* UID comaparision successful */ uint8_t no_of_blocks = 0; uint8_t blk_size_in_bytes = 0; uint8_t ic_reference = 0; /* So skip the UID size compared in the received buffer */ recv_index = (uint8_t)(recv_index + ps_rem_iso_15693_info->UidLength); if (information_flag & ISO15693_DSFID_MASK) { /* Skip DFSID */ recv_index = (uint8_t)(recv_index + ISO15693_SKIP_DFSID); } if (information_flag & ISO15693_AFI_MASK) { /* Skip AFI */ recv_index = (uint8_t)(recv_index + ISO15693_SKIP_AFI); } /* To get the number of blocks in the card */ no_of_blocks = (uint8_t)(*(p_recv_buf + recv_index) + 1); recv_index = (uint8_t)(recv_index + 1); /* To get the each block size in bytes */ blk_size_in_bytes = (uint8_t)((*(p_recv_buf + recv_index) & ISO15693_BLOCK_SIZE_IN_BYTES_MASK) + 1); recv_index = (uint8_t)(recv_index + 1); if (information_flag & ISO15693_ICREF_MASK) { /* Get the IC reference */ ic_reference = (uint8_t)(*(p_recv_buf + recv_index)); if (ic_reference == 0x03) { no_of_blocks = 8; } } /* calculate maximum data size in the card */ ps_iso15693_info->max_data_size = (uint16_t) (no_of_blocks * blk_size_in_bytes); } else { result = PHNFCSTVAL (CID_FRI_NFC_NDEF_SMTCRDFMT, NFCSTATUS_INVALID_DEVICE_REQUEST); } } else { result = PHNFCSTVAL (CID_FRI_NFC_NDEF_SMTCRDFMT, NFCSTATUS_INVALID_DEVICE_REQUEST); } return result; }
NFCSTATUS phHciNfc_Admin_Initialise( phHciNfc_sContext_t *psHciContext, void *pHwRef ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_Pipe_Info_t *p_pipe_info = NULL; phHciNfc_AdminGate_Info_t *p_admin_info=NULL; uint8_t length = 0; if( (NULL == psHciContext) || (NULL == pHwRef ) ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else { if( ( NULL == psHciContext->p_admin_info ) && (phHciNfc_Allocate_Resource((void **)(&p_admin_info), sizeof(phHciNfc_AdminGate_Info_t))== NFCSTATUS_SUCCESS) ) { psHciContext->p_admin_info = (void *) p_admin_info; p_admin_info->current_seq = ADMIN_PIPE_OPEN; p_admin_info->next_seq = ADMIN_END_SEQUENCE; p_admin_info->admin_pipe_info = NULL; } else { p_admin_info = (phHciNfc_AdminGate_Info_t * ) psHciContext->p_admin_info ; } if( NULL == p_admin_info) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INSUFFICIENT_RESOURCES); } else { switch(p_admin_info->current_seq) { /* Admin pipe open sequence , Initially open the Admin Pipe */ case ADMIN_PIPE_OPEN: { if(phHciNfc_Allocate_Resource((void **)(&p_pipe_info), sizeof(phHciNfc_Pipe_Info_t))!= NFCSTATUS_SUCCESS) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INSUFFICIENT_RESOURCES); } else { /* Populate the pipe information in the pipe handle */ ((phHciNfc_Pipe_Info_t *)p_pipe_info)->pipe.pipe_id = PIPETYPE_STATIC_ADMIN; ((phHciNfc_Pipe_Info_t *)p_pipe_info)->recv_resp = &phHciNfc_Recv_Admin_Response; ((phHciNfc_Pipe_Info_t *)p_pipe_info)->recv_cmd = &phHciNfc_Recv_Admin_Cmd; ((phHciNfc_Pipe_Info_t *)p_pipe_info)->recv_event = &phHciNfc_Recv_Admin_Event; psHciContext->p_pipe_list[PIPETYPE_STATIC_ADMIN] = p_pipe_info ; status = phHciNfc_Open_Pipe( psHciContext, pHwRef,p_pipe_info ); if(status == NFCSTATUS_SUCCESS) { p_admin_info->admin_pipe_info = p_pipe_info ; p_admin_info->next_seq = ADMIN_GET_SESSION; status = NFCSTATUS_PENDING; } } break; } case ADMIN_GET_SESSION: { p_pipe_info = p_admin_info->admin_pipe_info; p_pipe_info->reg_index = SESSION_INDEX; p_pipe_info->prev_status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, (uint8_t)HCI_ADMIN_PIPE_ID, (uint8_t)ANY_GET_PARAMETER); if(NFCSTATUS_PENDING == p_pipe_info->prev_status ) { #ifdef UICC_SESSION_RESET p_admin_info->next_seq = ADMIN_CLEAR_UICC_PIPES; #elif defined (ESTABLISH_SESSION) p_admin_info->next_seq = ADMIN_VERIFY_SESSION; #else p_admin_info->next_seq = ADMIN_CLEAR_PIPES; #endif status = NFCSTATUS_PENDING; } break; } #ifdef UICC_SESSION_RESET case ADMIN_CLEAR_UICC_PIPES: { uint8_t config = 0x00; p_pipe_info = p_admin_info->admin_pipe_info; /* TODO: Implement the Clear UICC PIPES Using * Memory configuration. */ status = phHciNfc_DevMgmt_Configure( psHciContext, pHwRef, NFC_ADDRESS_UICC_SESSION , config ); if(NFCSTATUS_PENDING == status ) { p_admin_info->next_seq = ADMIN_CLEAR_PIPES; status = NFCSTATUS_PENDING; } break; } #endif case ADMIN_VERIFY_SESSION: { phHal_sHwConfig_t *p_hw_config = (phHal_sHwConfig_t *) psHciContext->p_config_params; phHal_sHwReference_t *p_hw_ref = (phHal_sHwReference_t *) pHwRef; int cmp_val = 0; p_pipe_info = p_admin_info->admin_pipe_info; cmp_val = phOsalNfc_MemCompare(p_hw_config->session_id , p_hw_ref->session_id , sizeof(p_hw_ref->session_id)); if((cmp_val == 0) && ( HCI_SESSION == psHciContext->init_mode) ) { psHciContext->hci_mode = hciMode_Session; status = phHciNfc_Update_Pipe( psHciContext, pHwRef, &p_admin_info->pipe_seq ); if((status == NFCSTATUS_SUCCESS) && (NULL != p_pipe_info)) { p_pipe_info->reg_index = MAX_PIPE_INDEX; status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, (uint8_t)HCI_ADMIN_PIPE_ID, (uint8_t)ANY_GET_PARAMETER ); p_pipe_info->prev_status = status; if(NFCSTATUS_PENDING == status ) { p_admin_info->next_seq = ADMIN_PIPE_CLOSE; status = NFCSTATUS_SUCCESS; } } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } break; } else { /* To clear the pipe information*/ psHciContext->hci_mode = hciMode_Override; p_admin_info->current_seq = ADMIN_CLEAR_PIPES; } } /* fall through */ case ADMIN_CLEAR_PIPES: { p_pipe_info = p_admin_info->admin_pipe_info; p_pipe_info->prev_status = phHciNfc_Send_Admin_Cmd( psHciContext, pHwRef, ADM_CLEAR_ALL_PIPE, length, p_pipe_info); status = ((p_pipe_info->prev_status == NFCSTATUS_PENDING)? NFCSTATUS_SUCCESS : p_pipe_info->prev_status); if(status == NFCSTATUS_SUCCESS) { p_admin_info->next_seq = ADMIN_PIPE_REOPEN; status = NFCSTATUS_PENDING; } break; } /* Admin pipe Re-Open sequence , Re-Open the Admin Pipe */ case ADMIN_PIPE_REOPEN: { p_pipe_info = p_admin_info->admin_pipe_info; status = phHciNfc_Open_Pipe( psHciContext, pHwRef,p_pipe_info ); if(status == NFCSTATUS_SUCCESS) { p_admin_info->next_seq = ADMIN_CREATE_PIPES; status = NFCSTATUS_PENDING; } break; } case ADMIN_CREATE_PIPES: { status = phHciNfc_Create_All_Pipes( psHciContext, pHwRef, &p_admin_info->pipe_seq ); if(status == NFCSTATUS_SUCCESS) { p_admin_info->next_seq = ADMIN_GET_WHITE_LIST; status = NFCSTATUS_PENDING; } break; } case ADMIN_GET_WHITE_LIST: { p_pipe_info = p_admin_info->admin_pipe_info; if(NULL == p_pipe_info ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { p_pipe_info->reg_index = WHITELIST_INDEX; status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, (uint8_t)HCI_ADMIN_PIPE_ID, (uint8_t)ANY_GET_PARAMETER ); p_pipe_info->prev_status = status; if(HCI_SELF_TEST == psHciContext->init_mode) { status = ((NFCSTATUS_PENDING == status )? NFCSTATUS_SUCCESS : status); } else { if(NFCSTATUS_PENDING == status ) { p_admin_info->next_seq = ADMIN_GET_HOST_LIST; /* status = NFCSTATUS_SUCCESS; */ } } } break; } case ADMIN_GET_HOST_LIST: { p_pipe_info = p_admin_info->admin_pipe_info; if(NULL == p_pipe_info ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { p_pipe_info->reg_index = HOST_LIST_INDEX; status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, (uint8_t)HCI_ADMIN_PIPE_ID, (uint8_t)ANY_GET_PARAMETER ); p_pipe_info->prev_status = status; if(NFCSTATUS_PENDING == status ) { #if defined(HOST_WHITELIST) p_admin_info->next_seq = ADMIN_SET_WHITE_LIST; #else p_admin_info->next_seq = ADMIN_SET_SESSION; status = NFCSTATUS_SUCCESS; #endif } } break; } case ADMIN_SET_WHITE_LIST: { p_pipe_info = p_admin_info->admin_pipe_info; if(NULL == p_pipe_info ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { uint8_t i = 0; for (i = 0; i < WHITELIST_MAX_LEN - 2; i++ ) { p_admin_info->whitelist[i] = i + 2; } status = phHciNfc_Set_Param(psHciContext, pHwRef, p_pipe_info, WHITELIST_INDEX, (uint8_t *)p_admin_info->whitelist, i ); if(NFCSTATUS_PENDING == status ) { p_admin_info->next_seq = ADMIN_SET_SESSION; status = NFCSTATUS_SUCCESS; } } break; } case ADMIN_SET_SESSION: { phHal_sHwConfig_t *p_hw_config = (phHal_sHwConfig_t *) psHciContext->p_config_params; p_pipe_info = p_admin_info->admin_pipe_info; status = phHciNfc_Set_Param(psHciContext, pHwRef, p_pipe_info, SESSION_INDEX, (uint8_t *)(p_hw_config->session_id), sizeof(p_hw_config->session_id)); if(NFCSTATUS_PENDING == p_pipe_info->prev_status ) { p_admin_info->next_seq = ADMIN_PIPE_CLOSE; status = NFCSTATUS_SUCCESS; } break; } default: { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); break; } }/* End of the Sequence Switch */ }/* End of the Admin Info Memory Check */ }/* End of Null context Check */ return status; }