/*
* 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) */