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;
}
