diff options
Diffstat (limited to 'src/phHciNfc_RFReaderB.c')
| -rw-r--r-- | src/phHciNfc_RFReaderB.c | 918 |
1 files changed, 918 insertions, 0 deletions
diff --git a/src/phHciNfc_RFReaderB.c b/src/phHciNfc_RFReaderB.c new file mode 100644 index 0000000..4ddd4bf --- /dev/null +++ b/src/phHciNfc_RFReaderB.c @@ -0,0 +1,918 @@ +/* + * 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_RFReaderB.c * +* \brief HCI Reader B Management Routines. * +* * +* * +* Project: NFC-FRI-1.1 * +* * +* $Date: Mon Aug 17 15:17:07 2009 $ * +* $Author: ing04880 $ * +* $Revision: 1.7 $ * +* $Aliases: NFC_FRI1.1_WK934_R31_1,NFC_FRI1.1_WK941_PREP1,NFC_FRI1.1_WK941_PREP2,NFC_FRI1.1_WK941_1,NFC_FRI1.1_WK943_R32_1,NFC_FRI1.1_WK949_PREP1,NFC_FRI1.1_WK943_R32_10,NFC_FRI1.1_WK943_R32_13,NFC_FRI1.1_WK943_R32_14,NFC_FRI1.1_WK1007_R33_1,NFC_FRI1.1_WK1007_R33_4,NFC_FRI1.1_WK1017_PREP1,NFC_FRI1.1_WK1017_R34_1,NFC_FRI1.1_WK1017_R34_2,NFC_FRI1.1_WK1023_R35_1 $ +* * +* =========================================================================== * +*/ + +/* +***************************** Header File Inclusion **************************** +*/ +#include <phNfcCompId.h> +#include <phHciNfc_Pipe.h> +#include <phHciNfc_RFReader.h> +#include <phOsalNfc.h> + +#if defined (TYPE_B) +#include <phHciNfc_RFReaderB.h> +/* +****************************** Macro Definitions ******************************* +*/ + +#define RDR_B_SINGLE_TAG_FOUND 0x00U +#define RDR_B_MULTIPLE_TAGS_FOUND 0x03U +/* Commands exposed to the upper layer */ +#define NXP_WRA_CONTINUE_ACTIVATION 0x12U + +#define RDR_B_PUPI_INDEX 0x03U +#define RDR_B_APP_DATA_INDEX 0x04U +#define RDR_B_AFI_INDEX 0x02U +#define RDR_B_HIGHER_LAYER_RESP_INDEX 0x01U +#define RDR_B_HIGHER_LAYER_DATA_INDEX 0x05U + + +/* +*************************** Structure and Enumeration *************************** +*/ + + +/* +*************************** Static Function Declaration ************************** +*/ + +static +NFCSTATUS +phHciNfc_Recv_ReaderB_Response( + void *psContext, + void *pHwRef, + uint8_t *pResponse, +#ifdef ONE_BYTE_LEN + uint8_t length +#else + uint16_t length +#endif + ); + +static +NFCSTATUS +phHciNfc_Recv_ReaderB_Event( + void *psContext, + void *pHwRef, + uint8_t *pEvent, +#ifdef ONE_BYTE_LEN + uint8_t length +#else + uint16_t length +#endif + ); + +static +NFCSTATUS +phHciNfc_ReaderB_InfoUpdate( + phHciNfc_sContext_t *psHciContext, + uint8_t index, + uint8_t *reg_value, + uint8_t reg_length + ); + +static +NFCSTATUS +phHciNfc_Recv_Iso_B_Packet( + phHciNfc_sContext_t *psHciContext, + uint8_t *pResponse, +#ifdef ONE_BYTE_LEN + uint8_t length +#else + uint16_t length +#endif + ); +/* +*************************** Function Definitions *************************** +*/ + +NFCSTATUS +phHciNfc_ReaderB_Get_PipeID( + phHciNfc_sContext_t *psHciContext, + uint8_t *ppipe_id + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + + if( (NULL != psHciContext) + && ( NULL != ppipe_id ) + && ( NULL != psHciContext->p_reader_b_info ) + ) + { + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + p_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + *ppipe_id = p_rdr_b_info->pipe_id ; + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + } + return status; +} + +NFCSTATUS +phHciNfc_ReaderB_Init_Resources( + phHciNfc_sContext_t *psHciContext + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + if( NULL == psHciContext ) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + } + else + { + if( + ( NULL == psHciContext->p_reader_b_info ) && + (phHciNfc_Allocate_Resource((void **)(&p_rdr_b_info), + sizeof(phHciNfc_ReaderB_Info_t))== NFCSTATUS_SUCCESS) + ) + { + psHciContext->p_reader_b_info = p_rdr_b_info; + p_rdr_b_info->current_seq = RDR_B_INVALID_SEQ; + p_rdr_b_info->next_seq = RDR_B_INVALID_SEQ; + p_rdr_b_info->pipe_id = (uint8_t)HCI_UNKNOWN_PIPE_ID; + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INSUFFICIENT_RESOURCES); + } + + } + return status; +} + +NFCSTATUS +phHciNfc_ReaderB_Update_Info( + phHciNfc_sContext_t *psHciContext, + uint8_t infotype, + void *rdr_b_info + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + + if (NULL == psHciContext) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + } + else if(NULL == psHciContext->p_reader_b_info) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_ReaderB_Info_t *ps_rdr_b_info=NULL; + ps_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + + switch(infotype) + { + case HCI_READER_B_ENABLE: + { + if(NULL != rdr_b_info) + { + ps_rdr_b_info->enable_rdr_b_gate = + *((uint8_t *)rdr_b_info); + } + break; + } + case HCI_READER_B_INFO_SEQ: + { + ps_rdr_b_info->current_seq = RDR_B_PUPI; + ps_rdr_b_info->next_seq = RDR_B_PUPI; + break; + } + default: + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + break; + } + } + } + return status; +} + + +NFCSTATUS +phHciNfc_ReaderB_Update_PipeInfo( + phHciNfc_sContext_t *psHciContext, + uint8_t pipeID, + phHciNfc_Pipe_Info_t *pPipeInfo + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + + if( NULL == psHciContext ) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + } + else if(NULL == psHciContext->p_reader_b_info) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + p_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + /* Update the pipe_id of the reader B Gate obtained from the HCI Response */ + p_rdr_b_info->pipe_id = pipeID; + p_rdr_b_info->p_pipe_info = pPipeInfo; + /* Update the Response Receive routine of the reader B Gate */ + pPipeInfo->recv_resp = &phHciNfc_Recv_ReaderB_Response; + /* Update the event Receive routine of the reader B Gate */ + pPipeInfo->recv_event = &phHciNfc_Recv_ReaderB_Event; + } + + return status; +} + +NFCSTATUS +phHciNfc_ReaderB_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_reader_b_info) || + (HCI_READER_B_ENABLE != + ((phHciNfc_ReaderB_Info_t *)(psHciContext->p_reader_b_info))-> + enable_rdr_b_gate)) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + phHciNfc_Pipe_Info_t *p_pipe_info=NULL; + uint8_t pipeid = 0; + + p_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + p_pipe_info = p_rdr_b_info->p_pipe_info; + if(NULL == p_pipe_info ) + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_SEQUENCE); + } + else + { + switch(p_rdr_b_info->current_seq) + { + case RDR_B_PUPI: + { + p_pipe_info->reg_index = RDR_B_PUPI_INDEX; + pipeid = p_rdr_b_info->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 ) + { + p_rdr_b_info->next_seq = RDR_B_APP_DATA; + } + break; + } + case RDR_B_APP_DATA: + { + p_pipe_info->reg_index = RDR_B_APP_DATA_INDEX; + pipeid = p_rdr_b_info->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 ) + { + p_rdr_b_info->next_seq = RDR_B_AFI; + } + break; + } + case RDR_B_AFI: + { + /* RW to the registry */ + p_pipe_info->reg_index = RDR_B_AFI_INDEX; + pipeid = p_rdr_b_info->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 ) + { + p_rdr_b_info->next_seq = RDR_B_HIGHER_LAYER_RESP; + } + break; + } + + case RDR_B_HIGHER_LAYER_RESP: + { + p_pipe_info->reg_index = RDR_B_HIGHER_LAYER_RESP_INDEX; + pipeid = p_rdr_b_info->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 ) + { + p_rdr_b_info->next_seq = RDR_B_HIGHER_LAYER_DATA; + } + break; + } + + case RDR_B_HIGHER_LAYER_DATA: + { + /* RW to the registry */ + p_pipe_info->reg_index = RDR_B_HIGHER_LAYER_DATA_INDEX; + pipeid = p_rdr_b_info->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 ) + { + p_rdr_b_info->next_seq = RDR_B_END_SEQUENCE; + } + break; + } + case RDR_B_END_SEQUENCE: + { + phNfc_sCompletionInfo_t CompInfo; + if (RDR_B_MULTIPLE_TAGS_FOUND == + p_rdr_b_info->multiple_tgts_found) + { + CompInfo.status = NFCSTATUS_MULTIPLE_TAGS; + } + else + { + CompInfo.status = NFCSTATUS_SUCCESS; + } + + CompInfo.info = &(p_rdr_b_info->reader_b_info); + + p_rdr_b_info->reader_b_info.RemDevType = phHal_eISO14443_B_PICC; + p_rdr_b_info->current_seq = RDR_B_PUPI; + p_rdr_b_info->next_seq = RDR_B_PUPI; + 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_Recv_ReaderB_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) + || (length == 0)) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + } + else if(NULL == psHciContext->p_reader_b_info) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + uint8_t prev_cmd = ANY_GET_PARAMETER; + + p_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + if( NULL == p_rdr_b_info->p_pipe_info) + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_SEQUENCE); + } + else + { + prev_cmd = p_rdr_b_info->p_pipe_info->prev_msg ; + switch(prev_cmd) + { + case ANY_GET_PARAMETER: + { + status = phHciNfc_ReaderB_InfoUpdate(psHciContext, + p_rdr_b_info->p_pipe_info->reg_index, + &pResponse[HCP_HEADER_LEN], + (uint8_t)(length - HCP_HEADER_LEN)); + break; + } + case ANY_SET_PARAMETER: + { + HCI_PRINT("Reader B Parameter Set \n"); + status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, + UPDATE_SEQ); + p_rdr_b_info->next_seq = RDR_B_PUPI; + break; + } + case ANY_OPEN_PIPE: + { + HCI_PRINT("Reader B open pipe complete\n"); + status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, + UPDATE_SEQ); + p_rdr_b_info->next_seq = RDR_B_PUPI; + break; + } + case ANY_CLOSE_PIPE: + { + HCI_PRINT("Reader B close pipe complete\n"); + status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, + UPDATE_SEQ); + break; + } + case NXP_WRA_CONTINUE_ACTIVATION: + case NXP_WR_ACTIVATE_ID: + { + HCI_PRINT("Reader B continue activation or "); + HCI_PRINT("reactivation completed \n"); + status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, + UPDATE_SEQ); + break; + } + case WR_XCHGDATA: + { + if (length >= HCP_HEADER_LEN) + { + uint8_t i = 1; + HCI_PRINT("ISO 14443-4B received \n"); + /* Copy buffer to the receive buffer */ + phHciNfc_Append_HCPFrame(psHciContext->recv_buffer, + 0, pResponse, length); + psHciContext->rx_total = (length - i); + status = phHciNfc_Recv_Iso_B_Packet(psHciContext, + &pResponse[HCP_HEADER_LEN], + (length - HCP_HEADER_LEN)); + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + } + break; + } + case NXP_WR_PRESCHECK: + { + HCI_PRINT("Presence check completed \n"); + break; + } + case NXP_WR_ACTIVATE_NEXT: + { + if (length > HCP_HEADER_LEN) + { + if (RDR_B_MULTIPLE_TAGS_FOUND == pResponse[HCP_HEADER_LEN]) + { + p_rdr_b_info->multiple_tgts_found = + RDR_B_MULTIPLE_TAGS_FOUND; + } + else + { + p_rdr_b_info->multiple_tgts_found = FALSE; + } + HCI_PRINT("Activate next completed \n"); + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + } + break; + } + case NXP_WR_DISPATCH_TO_UICC: + { + switch(length) + { + case HCP_HEADER_LEN: + { + /* Error code field is optional, if no error + code field in the response, then the command + is successfully completed */ + p_rdr_b_info->uicc_activation = + UICC_CARD_ACTIVATION_SUCCESS; + break; + } + case (HCP_HEADER_LEN + 1): + { + p_rdr_b_info->uicc_activation = + pResponse[HCP_HEADER_LEN]; + break; + } /* End of case (HCP_HEADER_LEN + index) */ + default: + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + break; + } + } /* End of switch(length) */ + if (NFCSTATUS_SUCCESS == status) + { + status = phHciNfc_ReaderMgmt_Update_Sequence(psHciContext, + UPDATE_SEQ); + } + break; + } + default: + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_HCI_RESPONSE); + break; + } + } + if( NFCSTATUS_SUCCESS == status ) + { + p_rdr_b_info->p_pipe_info->prev_status = NFCSTATUS_SUCCESS; + p_rdr_b_info->current_seq = p_rdr_b_info->next_seq; + } + } + } + return status; +} + + +static +NFCSTATUS +phHciNfc_Recv_ReaderB_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_reader_b_info) || + (HCI_READER_B_ENABLE != + ((phHciNfc_ReaderB_Info_t *)(psHciContext->p_reader_b_info))-> + enable_rdr_b_gate)) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_HCP_Packet_t *p_packet = NULL; + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + phHciNfc_HCP_Message_t *message = NULL; + uint8_t instruction=0, + i = 0; + + p_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_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) + && ((RDR_B_MULTIPLE_TAGS_FOUND == message->payload[i] ) + || (RDR_B_SINGLE_TAG_FOUND == message->payload[i])) + ) + { + phNfc_sCompletionInfo_t pCompInfo; + + if (RDR_B_MULTIPLE_TAGS_FOUND == message->payload[i]) + { + p_rdr_b_info->multiple_tgts_found = RDR_B_MULTIPLE_TAGS_FOUND; + pCompInfo.status = NFCSTATUS_MULTIPLE_TAGS; + } + else + { + p_rdr_b_info->multiple_tgts_found = FALSE; + pCompInfo.status = NFCSTATUS_SUCCESS; + } + + psHciContext->host_rf_type = phHal_eISO14443_B_PCD; + p_rdr_b_info->reader_b_info.RemDevType = phHal_eISO14443_B_PICC; + p_rdr_b_info->current_seq = RDR_B_PUPI; + + /* 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; +} + +static +NFCSTATUS +phHciNfc_ReaderB_InfoUpdate( + phHciNfc_sContext_t *psHciContext, + uint8_t index, + uint8_t *reg_value, + uint8_t reg_length + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + phHciNfc_ReaderB_Info_t *p_rdr_b_info=NULL; + phHal_sIso14443BInfo_t *p_tag_b_info = NULL; + + p_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + (psHciContext->p_reader_b_info ); + p_tag_b_info = &(p_rdr_b_info->reader_b_info.RemoteDevInfo.Iso14443B_Info); + + switch(index) + { + case RDR_B_PUPI_INDEX: + { + HCI_PRINT_BUFFER("\tReader B PUPI", reg_value, reg_length); + /* Update PUPI buffer and length in the remote device info, + PUPI length is 4 bytes */ + if(PHHAL_PUPI_LENGTH == reg_length) + { + (void)memcpy((void *)p_tag_b_info->AtqB.AtqResInfo.Pupi, + (void *)reg_value, reg_length); + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + } + break; + } + case RDR_B_APP_DATA_INDEX: + { + HCI_PRINT_BUFFER("\tReader B Application data", reg_value, reg_length); + /* Update application data buffer and length, 3 bytes, + this includes CRC_B and number of application + */ + if(PHHAL_APP_DATA_B_LENGTH == reg_length) + { + (void)memcpy((void *)p_tag_b_info->AtqB.AtqResInfo.AppData, + (void *)reg_value, reg_length); + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + } + break; + } + case RDR_B_AFI_INDEX: + { + HCI_PRINT_BUFFER("\tReader B AFI", reg_value, reg_length); + /* Update AFI byte, Only one byte */ + if(sizeof(*reg_value) == reg_length) + { + p_tag_b_info->Afi = *reg_value; + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + } + break; + } + + case RDR_B_HIGHER_LAYER_RESP_INDEX: + { + HCI_PRINT_BUFFER("\tReader B higher layer response", reg_value, reg_length); + /* Update higher layer response buffer and length */ + if (reg_length <= PHHAL_MAX_ATR_LENGTH) + { + (void)memcpy((void *)p_tag_b_info->HiLayerResp, + (void *)reg_value, reg_length); + } + else + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + } + break; + } + + case RDR_B_HIGHER_LAYER_DATA_INDEX: + { + HCI_PRINT_BUFFER("\tReader B higher layer data", reg_value, reg_length); + /* Update higher layer data buffer and length */ + break; + } + default: + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_RESPONSE); + break; + } + } + return status; +} + + +static +NFCSTATUS +phHciNfc_Recv_Iso_B_Packet( + phHciNfc_sContext_t *psHciContext, + uint8_t *pResponse, +#ifdef ONE_BYTE_LEN + uint8_t length +#else + uint16_t length +#endif + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + uint8_t i = 1; + + psHciContext->rx_index = HCP_HEADER_LEN; + /* command WR_XCHG_DATA: so give ISO 14443-4B data to the upper layer */ + HCI_PRINT_BUFFER("ISO 14443-4B Bytes received", pResponse, length); + if(FALSE != pResponse[(length - i)]) + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_RF_ERROR); + } + return status; +} + + +NFCSTATUS +phHciNfc_ReaderB_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_reader_b_info) || + (HCI_READER_B_ENABLE != + ((phHciNfc_ReaderB_Info_t *)(psHciContext->p_reader_b_info))-> + enable_rdr_b_gate)) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_ReaderB_Info_t *ps_rdr_b_info=NULL; + phHciNfc_Pipe_Info_t *p_pipe_info=NULL; + uint8_t pipeid = 0; + + ps_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + p_pipe_info = ps_rdr_b_info->p_pipe_info; + if(NULL == p_pipe_info ) + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_SEQUENCE); + } + else + { + pipeid = ps_rdr_b_info->pipe_id ; + p_pipe_info->reg_index = RDR_B_AFI_INDEX; + + p_pipe_info->param_info = &afi_value; + p_pipe_info->param_length = sizeof(uint8_t); + /* Fill the data buffer and send the command to the + device */ + status = + phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, + pipeid, (uint8_t)ANY_SET_PARAMETER); + } + } + return status; +} + +NFCSTATUS +phHciNfc_ReaderB_Set_LayerData( + void *psContext, + void *pHwRef, + phNfc_sData_t *layer_data_info + ) +{ + NFCSTATUS status = NFCSTATUS_SUCCESS; + phHciNfc_sContext_t *psHciContext = + (phHciNfc_sContext_t *)psContext ; + + if( (NULL == psHciContext) || (NULL == pHwRef) || + (NULL == layer_data_info) || (NULL == layer_data_info->buffer) + || (0 == layer_data_info->length)) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_INVALID_PARAMETER); + } + else if((NULL == psHciContext->p_reader_b_info) || + (HCI_READER_B_ENABLE != + ((phHciNfc_ReaderB_Info_t *)(psHciContext->p_reader_b_info))-> + enable_rdr_b_gate)) + { + status = PHNFCSTVAL(CID_NFC_HCI, NFCSTATUS_FEATURE_NOT_SUPPORTED); + } + else + { + phHciNfc_ReaderB_Info_t *ps_rdr_b_info=NULL; + phHciNfc_Pipe_Info_t *p_pipe_info=NULL; + uint8_t pipeid = 0; + + ps_rdr_b_info = (phHciNfc_ReaderB_Info_t *) + psHciContext->p_reader_b_info ; + p_pipe_info = ps_rdr_b_info->p_pipe_info; + if(NULL == p_pipe_info ) + { + status = PHNFCSTVAL(CID_NFC_HCI, + NFCSTATUS_INVALID_HCI_SEQUENCE); + } + else + { + p_pipe_info->reg_index = RDR_B_HIGHER_LAYER_DATA_INDEX; + pipeid = ps_rdr_b_info->pipe_id ; + p_pipe_info->param_info = (void *)layer_data_info->buffer; + p_pipe_info->param_length = (uint8_t) + layer_data_info->length; + /* Fill the data buffer and send the command to the + device */ + status = phHciNfc_Send_Generic_Cmd( psHciContext, pHwRef, + pipeid, (uint8_t)ANY_SET_PARAMETER); + } + } + return status; +} +#endif /* #if defined (TYPE_B) */ + + |