/* * Copyright (C) 2010 NXP Semiconductors * * 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. */ /*! * =========================================================================== * * * * * * \file phHciNfc_ISO15693.c * * \brief HCI ISO-15693 management routines. * * * * * * Project: NFC-FRI-1.1 * * * * $Date: Thu Feb 11 18:54:47 2010 $ * * $Author: ing04880 $ * * $Revision: 1.7 $ * * $Aliases: $ * * * =========================================================================== * */ /* ***************************** Header File Inclusion **************************** */ #include #include #include #include #if defined (TYPE_ISO15693) #include /* ****************************** Macro Definitions ******************************* */ #define ISO_15693_INVENTORY_INDEX 0x01U #define ISO_15693_AFI_INDEX 0x02U #define ISO_15693_INVENTORY_LENGTH 0x0AU #define ISO_15693_AFI_LENGTH 0x01U #define ISO_15693_SINGLE_TAG_FOUND 0x00U #define ISO_15693_MULTIPLE_TAGS_FOUND 0x03U /* *************************** Structure and Enumeration *************************** */ /* *************************** Static Function Declaration ************************** */ static NFCSTATUS phHciNfc_ISO15693_InfoUpdate( phHciNfc_sContext_t *psHciContext, uint8_t index, uint8_t *reg_value, uint8_t reg_length ); static NFCSTATUS phHciNfc_Recv_ISO15693_Response( void *psContext, void *pHwRef, uint8_t *pResponse, #ifdef ONE_BYTE_LEN uint8_t length #else uint16_t length #endif ); static NFCSTATUS phHciNfc_Recv_ISO15693_Event( void *psContext, void *pHwRef, uint8_t *pEvent, #ifdef ONE_BYTE_LEN uint8_t length #else uint16_t length #endif ); /* *************************** Function Definitions *************************** */ NFCSTATUS phHciNfc_ISO15693_Init_Resources( phHciNfc_sContext_t *psHciContext ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_ISO15693_Info_t *ps_15693_info=NULL; if( NULL == psHciContext ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else { if (NULL != psHciContext->p_iso_15693_info) { status = NFCSTATUS_SUCCESS; } else if(( NULL == psHciContext->p_iso_15693_info ) && (phHciNfc_Allocate_Resource((void **)(&ps_15693_info), sizeof(phHciNfc_ISO15693_Info_t))== NFCSTATUS_SUCCESS) ) { psHciContext->p_iso_15693_info = ps_15693_info; ps_15693_info->current_seq = ISO15693_INVENTORY; ps_15693_info->next_seq = ISO15693_INVENTORY; ps_15693_info->ps_15693_pipe_info = NULL; } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INSUFFICIENT_RESOURCES); } } return status; } NFCSTATUS phHciNfc_ISO15693_Get_PipeID( phHciNfc_sContext_t *psHciContext, uint8_t *ppipe_id ) { NFCSTATUS status = NFCSTATUS_SUCCESS; if( (NULL != psHciContext) && ( NULL != ppipe_id ) && ( NULL != psHciContext->p_iso_15693_info ) ) { phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info ; *ppipe_id = ps_15693_info->ps_15693_pipe_info->pipe.pipe_id; } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } return status; } NFCSTATUS phHciNfc_ISO15693_Update_PipeInfo( phHciNfc_sContext_t *psHciContext, uint8_t pipeID, phHciNfc_Pipe_Info_t *pPipeInfo ) { NFCSTATUS status = NFCSTATUS_SUCCESS; if((NULL == psHciContext) || (NULL == pPipeInfo)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if(NULL == psHciContext->p_iso_15693_info) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info ; /* Update the pipe_id of the ISO15693 Gate obtained from the HCI Response */ ps_15693_info->ps_15693_pipe_info = pPipeInfo; ps_15693_info->pipe_id = pipeID; ps_15693_info->ps_15693_pipe_info->pipe.pipe_id = pipeID; /* Update the Response Receive routine of the ISO15693 Gate */ pPipeInfo->recv_resp = &phHciNfc_Recv_ISO15693_Response; /* Update the event Receive routine of the ISO15693 Gate */ pPipeInfo->recv_event = &phHciNfc_Recv_ISO15693_Event; } return status; } NFCSTATUS phHciNfc_ISO15693_Update_Info( phHciNfc_sContext_t *psHciContext, uint8_t infotype, void *iso_15693_info ) { NFCSTATUS status = NFCSTATUS_SUCCESS; if (NULL == psHciContext) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if(NULL == psHciContext->p_iso_15693_info) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info; switch(infotype) { case HCI_ISO_15693_ENABLE: { if (NULL != iso_15693_info) { ps_15693_info->enable_iso_15693_gate = *((uint8_t *)iso_15693_info); } break; } case HCI_ISO_15693_INFO_SEQ: { ps_15693_info->current_seq = ISO15693_INVENTORY; ps_15693_info->next_seq = ISO15693_INVENTORY; break; } default: { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); break; } } } return status; } NFCSTATUS phHciNfc_ISO15693_Info_Sequence ( void *psHciHandle, void *pHwRef ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_sContext_t *psHciContext = ((phHciNfc_sContext_t *)psHciHandle); if( (NULL == psHciContext) || (NULL == pHwRef) ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if((NULL == psHciContext->p_iso_15693_info) || (HCI_ISO_15693_ENABLE != ((phHciNfc_ISO15693_Info_t *)(psHciContext->p_iso_15693_info))-> enable_iso_15693_gate)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; phHciNfc_Pipe_Info_t *ps_pipe_info = NULL; uint8_t pipeid = 0; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info; ps_pipe_info = ps_15693_info->ps_15693_pipe_info; if(NULL == ps_pipe_info ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { switch(ps_15693_info->current_seq) { case ISO15693_INVENTORY: { ps_pipe_info->reg_index = ISO_15693_INVENTORY_INDEX; pipeid = ps_pipe_info->pipe.pipe_id ; /* Fill the data buffer and send the command to the device */ status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, pipeid, (uint8_t)ANY_GET_PARAMETER); if(NFCSTATUS_PENDING == status ) { ps_15693_info->next_seq = ISO15693_AFI; } break; } case ISO15693_AFI: { ps_pipe_info->reg_index = ISO_15693_AFI_INDEX; pipeid = ps_pipe_info->pipe.pipe_id ; /* Fill the data buffer and send the command to the device */ status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, pipeid, (uint8_t)ANY_GET_PARAMETER); if(NFCSTATUS_PENDING == status ) { ps_15693_info->next_seq = ISO15693_END_SEQUENCE; } break; } case ISO15693_END_SEQUENCE: { phNfc_sCompletionInfo_t CompInfo; if (ISO_15693_MULTIPLE_TAGS_FOUND == ps_15693_info->multiple_tgts_found) { CompInfo.status = NFCSTATUS_MULTIPLE_TAGS; } else { CompInfo.status = NFCSTATUS_SUCCESS; } CompInfo.info = &(ps_15693_info->iso15693_info); ps_15693_info->iso15693_info.RemDevType = phHal_eISO15693_PICC; ps_15693_info->current_seq = ISO15693_INVENTORY; ps_15693_info->next_seq = ISO15693_INVENTORY; status = NFCSTATUS_SUCCESS; /* Notify to the upper layer */ phHciNfc_Tag_Notify(psHciContext, pHwRef, NFC_NOTIFY_TARGET_DISCOVERED, &CompInfo); break; } default: { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); break; } } } } return status; } static NFCSTATUS phHciNfc_ISO15693_InfoUpdate( phHciNfc_sContext_t *psHciContext, uint8_t index, uint8_t *reg_value, uint8_t reg_length ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; uint8_t i = 0; ps_15693_info = (phHciNfc_ISO15693_Info_t *) (psHciContext->p_iso_15693_info); switch(index) { case ISO_15693_INVENTORY_INDEX: { if (ISO_15693_INVENTORY_LENGTH == reg_length) { ps_15693_info->iso15693_info.RemoteDevInfo .Iso15693_Info.Flags = *(reg_value + i ); i++; ps_15693_info->iso15693_info.RemoteDevInfo .Iso15693_Info.Dsfid = *(reg_value + i ); i++; (void)memcpy(ps_15693_info->iso15693_info. RemoteDevInfo.Iso15693_Info.Uid, (reg_value+i), (reg_length - i )); ps_15693_info->iso15693_info.RemoteDevInfo .Iso15693_Info.UidLength = ( reg_length - i ); HCI_PRINT_BUFFER("\tISO 15693 inventory", reg_value, reg_length); } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); } break; } case ISO_15693_AFI_INDEX: { if (ISO_15693_AFI_LENGTH == reg_length) { ps_15693_info->iso15693_info.RemoteDevInfo .Iso15693_Info.Afi = *(reg_value + i ); HCI_PRINT_BUFFER("\tISO 15693 AFI", reg_value, reg_length); } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); } break; } default: { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); break; } } return status; } static NFCSTATUS phHciNfc_Recv_ISO15693_Response( void *psContext, void *pHwRef, uint8_t *pResponse, #ifdef ONE_BYTE_LEN uint8_t length #else uint16_t length #endif ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_sContext_t *psHciContext = (phHciNfc_sContext_t *)psContext ; if( (NULL == psHciContext) || (NULL == pHwRef) || (NULL == pResponse) || (0 == length)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if(NULL == psHciContext->p_iso_15693_info) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; phHciNfc_Pipe_Info_t *ps_pipe_info = NULL; uint8_t prev_cmd = ANY_GET_PARAMETER; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info; ps_pipe_info = ps_15693_info->ps_15693_pipe_info; if( NULL == ps_pipe_info) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { prev_cmd = ps_pipe_info->prev_msg ; switch(prev_cmd) { case ANY_GET_PARAMETER: { status = phHciNfc_ISO15693_InfoUpdate(psHciContext, ps_pipe_info->reg_index, &pResponse[HCP_HEADER_LEN], (uint8_t)(length - HCP_HEADER_LEN)); #if 0 status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, UPDATE_SEQ); #endif /* #if 0 */ break; } case ANY_SET_PARAMETER: { HCI_PRINT("ISO 15693 Parameter Set \n"); status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, UPDATE_SEQ); ps_15693_info->next_seq = ISO15693_INVENTORY; break; } case ANY_OPEN_PIPE: { HCI_PRINT("ISO 15693 open pipe complete\n"); status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, UPDATE_SEQ); ps_15693_info->next_seq = ISO15693_INVENTORY; break; } case ANY_CLOSE_PIPE: { HCI_PRINT("ISO 15693 close pipe complete\n"); status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, UPDATE_SEQ); break; } case NXP_ISO15693_CMD: { if (length >= HCP_HEADER_LEN) { HCI_PRINT("ISO 15693 packet received \n"); /* Copy buffer to the receive buffer */ phHciNfc_Append_HCPFrame(psHciContext->recv_buffer, 0, pResponse, length); psHciContext->rx_total = length; psHciContext->rx_index = HCP_HEADER_LEN; HCI_PRINT_BUFFER("ISO 15693 Bytes received", pResponse, length); } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); } break; } default: { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); break; } }/* End of switch(prev_cmd) */ if( NFCSTATUS_SUCCESS == status ) { ps_pipe_info->prev_status = NFCSTATUS_SUCCESS; ps_15693_info->current_seq = ps_15693_info->next_seq; } } } return status; } static NFCSTATUS phHciNfc_Recv_ISO15693_Event( void *psContext, void *pHwRef, uint8_t *pEvent, #ifdef ONE_BYTE_LEN uint8_t length #else uint16_t length #endif ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_sContext_t *psHciContext = (phHciNfc_sContext_t *)psContext ; if( (NULL == psHciContext) || (NULL == pHwRef) || (NULL == pEvent) || (length == 0)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if((NULL == psHciContext->p_iso_15693_info) || (HCI_ISO_15693_ENABLE != ((phHciNfc_ISO15693_Info_t *)(psHciContext->p_iso_15693_info))-> enable_iso_15693_gate)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_HCP_Packet_t *p_packet = NULL; phHciNfc_ISO15693_Info_t *ps_15693_info=NULL; phHciNfc_HCP_Message_t *message = NULL; uint8_t instruction=0, i = 0; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info; p_packet = (phHciNfc_HCP_Packet_t *)pEvent; message = &p_packet->msg.message; /* Get the instruction bits from the Message Header */ instruction = (uint8_t) GET_BITS8( message->msg_header, HCP_MSG_INSTRUCTION_OFFSET, HCP_MSG_INSTRUCTION_LEN); if ((EVT_TARGET_DISCOVERED == instruction) && ((ISO_15693_MULTIPLE_TAGS_FOUND == message->payload[i]) || (ISO_15693_SINGLE_TAG_FOUND == message->payload[i])) ) { phNfc_sCompletionInfo_t pCompInfo; /* #define NFC_ISO_15693_MULTIPLE_TAGS_SUPPORT 0x00 */ #if (NFC_ISO_15693_MULTIPLE_TAGS_SUPPORT >= 0x01) if (ISO_15693_MULTIPLE_TAGS_FOUND == message->payload[i]) { ps_15693_info->multiple_tgts_found = ISO_15693_MULTIPLE_TAGS_FOUND; pCompInfo.status = NFCSTATUS_MULTIPLE_TAGS; } else #endif /* #if (NFC_ISO_15693_MULTIPLE_TAGS_SUPPORT <= 0x01) */ { ps_15693_info->multiple_tgts_found = FALSE; pCompInfo.status = NFCSTATUS_SUCCESS; } /* CompInfo.info = &(ps_15693_info->iso15693_info); */ psHciContext->host_rf_type = phHal_eISO15693_PCD; ps_15693_info->iso15693_info.RemDevType = phHal_eISO15693_PICC; ps_15693_info->current_seq = ISO15693_INVENTORY; /* Notify to the HCI Generic layer To Update the FSM */ phHciNfc_Notify_Event(psHciContext, pHwRef, NFC_NOTIFY_TARGET_DISCOVERED, &pCompInfo); } else { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); } } return status; } NFCSTATUS phHciNfc_Send_ISO15693_Command( phHciNfc_sContext_t *psHciContext, void *pHwRef, uint8_t pipe_id, uint8_t cmd ) { NFCSTATUS status = NFCSTATUS_SUCCESS; if( (NULL == psHciContext) || (NULL == pHwRef) ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if((NULL == psHciContext->p_iso_15693_info) || (HCI_ISO_15693_ENABLE != ((phHciNfc_ISO15693_Info_t *)(psHciContext->p_iso_15693_info))-> enable_iso_15693_gate) || (HCI_UNKNOWN_PIPE_ID == ((phHciNfc_ISO15693_Info_t *)(psHciContext->p_iso_15693_info))-> pipe_id) || (pipe_id != ((phHciNfc_ISO15693_Info_t *)(psHciContext->p_iso_15693_info))-> pipe_id)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_ISO15693_Info_t *ps_15693_info=NULL; phHciNfc_Pipe_Info_t *ps_pipe_info=NULL; phHciNfc_HCP_Packet_t *hcp_packet = NULL; phHciNfc_HCP_Message_t *hcp_message = NULL; uint8_t i = 0; uint16_t length = HCP_HEADER_LEN; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info ; ps_pipe_info = ps_15693_info->ps_15693_pipe_info; if(NULL == ps_pipe_info ) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { psHciContext->tx_total = 0 ; hcp_packet = (phHciNfc_HCP_Packet_t *) psHciContext->send_buffer; /* Construct the HCP Frame */ if (NXP_ISO15693_CMD == cmd) { phHciNfc_Build_HCPFrame(hcp_packet,HCP_CHAINBIT_DEFAULT, (uint8_t) pipe_id, HCP_MSG_TYPE_COMMAND, cmd); hcp_message = &(hcp_packet->msg.message); #if 0 /* Command */ hcp_message->payload[i++] = psHciContext->p_xchg_info->params.tag_info.cmd_type ; /* Address */ hcp_message->payload[i++] = psHciContext->p_xchg_info->params.tag_info.addr ; #endif /* #if 0 */ phHciNfc_Append_HCPFrame((uint8_t *)hcp_message->payload, i, (uint8_t *)ps_pipe_info->param_info, ps_pipe_info->param_length); length =(uint16_t)(length + i + ps_pipe_info->param_length); ps_pipe_info->sent_msg_type = (uint8_t)HCP_MSG_TYPE_COMMAND; ps_pipe_info->prev_msg = cmd; psHciContext->tx_total = length; psHciContext->response_pending = TRUE; /* Send the Constructed HCP packet to the lower layer */ status = phHciNfc_Send_HCP( psHciContext, pHwRef); ps_pipe_info->prev_status = status; } } } return status; } NFCSTATUS phHciNfc_ISO15693_Set_AFI( void *psContext, void *pHwRef, uint8_t afi_value ) { NFCSTATUS status = NFCSTATUS_SUCCESS; phHciNfc_sContext_t *psHciContext = (phHciNfc_sContext_t *)psContext ; if( (NULL == psHciContext) || (NULL == pHwRef)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); } else if((NULL == psHciContext->p_iso_15693_info) || (HCI_ISO_15693_ENABLE != ((phHciNfc_ISO15693_Info_t *)(psHciContext->p_iso_15693_info))-> enable_iso_15693_gate)) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); } else { phHciNfc_ISO15693_Info_t *ps_15693_info = NULL; phHciNfc_Pipe_Info_t *ps_pipe_info = NULL; uint8_t pipeid = 0; ps_15693_info = (phHciNfc_ISO15693_Info_t *) psHciContext->p_iso_15693_info ; ps_pipe_info = ps_15693_info->ps_15693_pipe_info; if( NULL == ps_pipe_info) { status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_SEQUENCE); } else { ps_pipe_info->reg_index = ISO_15693_AFI_INDEX; ps_pipe_info->param_info = &afi_value; ps_pipe_info->param_length = sizeof(afi_value); pipeid = ps_pipe_info->pipe.pipe_id ; status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, pipeid, (uint8_t)ANY_SET_PARAMETER); } } return status; } #endif /* #if defined (TYPE_ISO15693) */