mirror of
https://github.com/DarkFlippers/unleashed-firmware
synced 2024-12-22 10:43:11 +00:00
561 lines
19 KiB
C
Executable file
561 lines
19 KiB
C
Executable file
|
|
/******************************************************************************
|
|
* \attention
|
|
*
|
|
* <h2><center>© COPYRIGHT 2020 STMicroelectronics</center></h2>
|
|
*
|
|
* Licensed under ST MYLIBERTY SOFTWARE LICENSE AGREEMENT (the "License");
|
|
* You may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at:
|
|
*
|
|
* www.st.com/myliberty
|
|
*
|
|
* 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,
|
|
* AND SPECIFICALLY DISCLAIMING THE IMPLIED WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE, AND NON-INFRINGEMENT.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*
|
|
******************************************************************************/
|
|
|
|
/*
|
|
* PROJECT: ST25R391x firmware
|
|
* Revision:
|
|
* LANGUAGE: ISO C99
|
|
*/
|
|
|
|
/*! \file rfal_st25tb.c
|
|
*
|
|
* \author Gustavo Patricio
|
|
*
|
|
* \brief Implementation of ST25TB interface
|
|
*
|
|
*/
|
|
|
|
/*
|
|
******************************************************************************
|
|
* INCLUDES
|
|
******************************************************************************
|
|
*/
|
|
#include "rfal_st25tb.h"
|
|
#include "utils.h"
|
|
|
|
/*
|
|
******************************************************************************
|
|
* ENABLE SWITCH
|
|
******************************************************************************
|
|
*/
|
|
#ifndef RFAL_FEATURE_ST25TB
|
|
#define RFAL_FEATURE_ST25TB false /* ST25TB module configuration missing. Disabled by default */
|
|
#endif
|
|
|
|
#if RFAL_FEATURE_ST25TB
|
|
|
|
/*
|
|
******************************************************************************
|
|
* GLOBAL DEFINES
|
|
******************************************************************************
|
|
*/
|
|
|
|
#define RFAL_ST25TB_CMD_LEN 1U /*!< ST25TB length of a command */
|
|
#define RFAL_ST25TB_SLOTS 16U /*!< ST25TB number of slots */
|
|
#define RFAL_ST25TB_SLOTNUM_MASK 0x0FU /*!< ST25TB Slot Number bit mask on SlotMarker */
|
|
#define RFAL_ST25TB_SLOTNUM_SHIFT 4U /*!< ST25TB Slot Number shift on SlotMarker */
|
|
|
|
#define RFAL_ST25TB_INITIATE_CMD1 0x06U /*!< ST25TB Initiate command byte1 */
|
|
#define RFAL_ST25TB_INITIATE_CMD2 0x00U /*!< ST25TB Initiate command byte2 */
|
|
#define RFAL_ST25TB_PCALL_CMD1 0x06U /*!< ST25TB Pcall16 command byte1 */
|
|
#define RFAL_ST25TB_PCALL_CMD2 0x04U /*!< ST25TB Pcall16 command byte2 */
|
|
#define RFAL_ST25TB_SELECT_CMD 0x0EU /*!< ST25TB Select command */
|
|
#define RFAL_ST25TB_GET_UID_CMD 0x0BU /*!< ST25TB Get UID command */
|
|
#define RFAL_ST25TB_COMPLETION_CMD 0x0FU /*!< ST25TB Completion command */
|
|
#define RFAL_ST25TB_RESET_INV_CMD 0x0CU /*!< ST25TB Reset to Inventory command */
|
|
#define RFAL_ST25TB_READ_BLOCK_CMD 0x08U /*!< ST25TB Read Block command */
|
|
#define RFAL_ST25TB_WRITE_BLOCK_CMD 0x09U /*!< ST25TB Write Block command */
|
|
|
|
|
|
#define RFAL_ST25TB_T0 2157U /*!< ST25TB t0 159 us ST25TB RF characteristics */
|
|
#define RFAL_ST25TB_T1 2048U /*!< ST25TB t1 151 us ST25TB RF characteristics */
|
|
|
|
#define RFAL_ST25TB_FWT (RFAL_ST25TB_T0 + RFAL_ST25TB_T1) /*!< ST25TB FWT = T0 + T1 */
|
|
#define RFAL_ST25TB_TW rfalConvMsTo1fc(7U) /*!< ST25TB TW : Programming time for write max 7ms */
|
|
|
|
|
|
/*
|
|
******************************************************************************
|
|
* GLOBAL MACROS
|
|
******************************************************************************
|
|
*/
|
|
|
|
/*
|
|
******************************************************************************
|
|
* GLOBAL TYPES
|
|
******************************************************************************
|
|
*/
|
|
|
|
/*! Initiate Request */
|
|
typedef struct
|
|
{
|
|
uint8_t cmd1; /*!< Initiate Request cmd1: 0x06 */
|
|
uint8_t cmd2; /*!< Initiate Request cmd2: 0x00 */
|
|
} rfalSt25tbInitiateReq;
|
|
|
|
/*! Pcall16 Request */
|
|
typedef struct
|
|
{
|
|
uint8_t cmd1; /*!< Pcal16 Request cmd1: 0x06 */
|
|
uint8_t cmd2; /*!< Pcal16 Request cmd2: 0x04 */
|
|
} rfalSt25tbPcallReq;
|
|
|
|
|
|
/*! Select Request */
|
|
typedef struct
|
|
{
|
|
uint8_t cmd; /*!< Select Request cmd: 0x0E */
|
|
uint8_t chipId; /*!< Chip ID */
|
|
} rfalSt25tbSelectReq;
|
|
|
|
/*! Read Block Request */
|
|
typedef struct
|
|
{
|
|
uint8_t cmd; /*!< Select Request cmd: 0x08 */
|
|
uint8_t address; /*!< Block address */
|
|
} rfalSt25tbReadBlockReq;
|
|
|
|
/*! Write Block Request */
|
|
typedef struct
|
|
{
|
|
uint8_t cmd; /*!< Select Request cmd: 0x09 */
|
|
uint8_t address; /*!< Block address */
|
|
rfalSt25tbBlock data; /*!< Block Data */
|
|
} rfalSt25tbWriteBlockReq;
|
|
|
|
|
|
/*
|
|
******************************************************************************
|
|
* LOCAL FUNCTION PROTOTYPES
|
|
******************************************************************************
|
|
*/
|
|
/*!
|
|
*****************************************************************************
|
|
* \brief ST25TB Poller Do Collision Resolution
|
|
*
|
|
* This method performs ST25TB Collision resolution loop for each slot
|
|
*
|
|
* \param[in] devLimit : device limit value, and size st25tbDevList
|
|
* \param[out] st25tbDevList : ST35TB listener device info
|
|
* \param[out] devCnt : Devices found counter
|
|
*
|
|
* \return colPending : true if a collision was detected
|
|
*****************************************************************************
|
|
*/
|
|
static bool rfalSt25tbPollerDoCollisionResolution( uint8_t devLimit, rfalSt25tbListenDevice *st25tbDevList, uint8_t *devCnt );
|
|
|
|
/*
|
|
******************************************************************************
|
|
* LOCAL FUNCTION PROTOTYPES
|
|
******************************************************************************
|
|
*/
|
|
|
|
|
|
static bool rfalSt25tbPollerDoCollisionResolution( uint8_t devLimit, rfalSt25tbListenDevice *st25tbDevList, uint8_t *devCnt )
|
|
{
|
|
uint8_t i;
|
|
uint8_t chipId;
|
|
ReturnCode ret;
|
|
bool col;
|
|
|
|
col = false;
|
|
|
|
for(i = 0; i < RFAL_ST25TB_SLOTS; i++)
|
|
{
|
|
platformDelay(1); /* Wait t2: Answer to new request delay */
|
|
|
|
if( i==0U )
|
|
{
|
|
/* Step 2: Send Pcall16 */
|
|
ret = rfalSt25tbPollerPcall( &chipId );
|
|
}
|
|
else
|
|
{
|
|
/* Step 3-17: Send Pcall16 */
|
|
ret = rfalSt25tbPollerSlotMarker( i, &chipId );
|
|
}
|
|
|
|
if( ret == ERR_NONE )
|
|
{
|
|
/* Found another device */
|
|
st25tbDevList[*devCnt].chipID = chipId;
|
|
st25tbDevList[*devCnt].isDeselected = false;
|
|
|
|
/* Select Device, retrieve its UID */
|
|
ret = rfalSt25tbPollerSelect( chipId );
|
|
|
|
/* By Selecting this device, the previous gets Deselected */
|
|
if( (*devCnt) > 0U )
|
|
{
|
|
st25tbDevList[(*devCnt)-1U].isDeselected = true;
|
|
}
|
|
|
|
if( ERR_NONE == ret )
|
|
{
|
|
rfalSt25tbPollerGetUID( &st25tbDevList[*devCnt].UID );
|
|
}
|
|
|
|
if( ERR_NONE == ret )
|
|
{
|
|
(*devCnt)++;
|
|
}
|
|
}
|
|
else if( (ret == ERR_CRC) || (ret == ERR_FRAMING) )
|
|
{
|
|
col = true;
|
|
}
|
|
else
|
|
{
|
|
/* MISRA 15.7 - Empty else */
|
|
}
|
|
|
|
if( *devCnt >= devLimit )
|
|
{
|
|
break;
|
|
}
|
|
}
|
|
return col;
|
|
}
|
|
|
|
|
|
/*
|
|
******************************************************************************
|
|
* LOCAL VARIABLES
|
|
******************************************************************************
|
|
*/
|
|
|
|
/*
|
|
******************************************************************************
|
|
* GLOBAL FUNCTIONS
|
|
******************************************************************************
|
|
*/
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerInitialize( void )
|
|
{
|
|
return rfalNfcbPollerInitialize();
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerCheckPresence( uint8_t *chipId )
|
|
{
|
|
ReturnCode ret;
|
|
uint8_t chipIdRes;
|
|
|
|
chipIdRes = 0x00;
|
|
|
|
/* Send Initiate Request */
|
|
ret = rfalSt25tbPollerInitiate( &chipIdRes );
|
|
|
|
/* Check if a transmission error was detected */
|
|
if( (ret == ERR_CRC) || (ret == ERR_FRAMING) )
|
|
{
|
|
return ERR_NONE;
|
|
}
|
|
|
|
/* Copy chip ID if requested */
|
|
if( chipId != NULL )
|
|
{
|
|
*chipId = chipIdRes;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerInitiate( uint8_t *chipId )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
rfalSt25tbInitiateReq initiateReq;
|
|
uint8_t rxBuf[RFAL_ST25TB_CHIP_ID_LEN + RFAL_ST25TB_CRC_LEN]; /* In case we receive less data that CRC, RF layer will not remove the CRC from buffer */
|
|
|
|
/* Compute Initiate Request */
|
|
initiateReq.cmd1 = RFAL_ST25TB_INITIATE_CMD1;
|
|
initiateReq.cmd2 = RFAL_ST25TB_INITIATE_CMD2;
|
|
|
|
/* Send Initiate Request */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&initiateReq, sizeof(rfalSt25tbInitiateReq), (uint8_t*)rxBuf, sizeof(rxBuf), &rxLen, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
|
|
/* Check for valid Select Response */
|
|
if( (ret == ERR_NONE) && (rxLen != RFAL_ST25TB_CHIP_ID_LEN) )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
/* Copy chip ID if requested */
|
|
if( chipId != NULL )
|
|
{
|
|
*chipId = *rxBuf;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerPcall( uint8_t *chipId )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
rfalSt25tbPcallReq pcallReq;
|
|
|
|
/* Compute Pcal16 Request */
|
|
pcallReq.cmd1 = RFAL_ST25TB_PCALL_CMD1;
|
|
pcallReq.cmd2 = RFAL_ST25TB_PCALL_CMD2;
|
|
|
|
/* Send Pcal16 Request */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&pcallReq, sizeof(rfalSt25tbPcallReq), (uint8_t*)chipId, RFAL_ST25TB_CHIP_ID_LEN, &rxLen, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
|
|
/* Check for valid Select Response */
|
|
if( (ret == ERR_NONE) && (rxLen != RFAL_ST25TB_CHIP_ID_LEN) )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerSlotMarker( uint8_t slotNum, uint8_t *chipIdRes )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
uint8_t slotMarker;
|
|
|
|
if( (slotNum == 0U) || (slotNum > 15U) )
|
|
{
|
|
return ERR_PARAM;
|
|
}
|
|
|
|
/* Compute SlotMarker */
|
|
slotMarker = ( ((slotNum & RFAL_ST25TB_SLOTNUM_MASK) << RFAL_ST25TB_SLOTNUM_SHIFT) | RFAL_ST25TB_PCALL_CMD1 );
|
|
|
|
|
|
/* Send SlotMarker */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&slotMarker, RFAL_ST25TB_CMD_LEN, (uint8_t*)chipIdRes, RFAL_ST25TB_CHIP_ID_LEN, &rxLen, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
|
|
/* Check for valid ChipID Response */
|
|
if( (ret == ERR_NONE) && (rxLen != RFAL_ST25TB_CHIP_ID_LEN) )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerSelect( uint8_t chipId )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
rfalSt25tbSelectReq selectReq;
|
|
uint8_t chipIdRes;
|
|
|
|
/* Compute Select Request */
|
|
selectReq.cmd = RFAL_ST25TB_SELECT_CMD;
|
|
selectReq.chipId = chipId;
|
|
|
|
/* Send Select Request */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&selectReq, sizeof(rfalSt25tbSelectReq), (uint8_t*)&chipIdRes, RFAL_ST25TB_CHIP_ID_LEN, &rxLen, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
|
|
/* Check for valid Select Response */
|
|
if( (ret == ERR_NONE) && ((rxLen != RFAL_ST25TB_CHIP_ID_LEN) || (chipIdRes != chipId)) )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerGetUID( rfalSt25tbUID *UID )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
uint8_t getUidReq;
|
|
|
|
|
|
/* Compute Get UID Request */
|
|
getUidReq = RFAL_ST25TB_GET_UID_CMD;
|
|
|
|
/* Send Select Request */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&getUidReq, RFAL_ST25TB_CMD_LEN, (uint8_t*)UID, sizeof(rfalSt25tbUID), &rxLen, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
|
|
/* Check for valid UID Response */
|
|
if( (ret == ERR_NONE) && (rxLen != RFAL_ST25TB_UID_LEN) )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerCollisionResolution( uint8_t devLimit, rfalSt25tbListenDevice *st25tbDevList, uint8_t *devCnt )
|
|
{
|
|
|
|
uint8_t chipId;
|
|
ReturnCode ret;
|
|
bool detected; /* collision or device was detected */
|
|
|
|
if( (st25tbDevList == NULL) || (devCnt == NULL) || (devLimit == 0U) )
|
|
{
|
|
return ERR_PARAM;
|
|
}
|
|
|
|
*devCnt = 0;
|
|
|
|
/* Step 1: Send Initiate */
|
|
ret = rfalSt25tbPollerInitiate( &chipId );
|
|
if( ret == ERR_NONE )
|
|
{
|
|
/* If only 1 answer is detected */
|
|
st25tbDevList[*devCnt].chipID = chipId;
|
|
st25tbDevList[*devCnt].isDeselected = false;
|
|
|
|
/* Retrieve its UID and keep it Selected*/
|
|
ret = rfalSt25tbPollerSelect( chipId );
|
|
|
|
if( ERR_NONE == ret )
|
|
{
|
|
ret = rfalSt25tbPollerGetUID( &st25tbDevList[*devCnt].UID );
|
|
}
|
|
|
|
if( ERR_NONE == ret )
|
|
{
|
|
(*devCnt)++;
|
|
}
|
|
}
|
|
/* Always proceed to Pcall16 anticollision as phase differences of tags can lead to no tag recognized, even if there is one */
|
|
if( *devCnt < devLimit )
|
|
{
|
|
/* Multiple device responses */
|
|
do
|
|
{
|
|
detected = rfalSt25tbPollerDoCollisionResolution( devLimit, st25tbDevList, devCnt );
|
|
}
|
|
while( (detected == true) && (*devCnt < devLimit) );
|
|
}
|
|
|
|
return ERR_NONE;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerReadBlock( uint8_t blockAddress, rfalSt25tbBlock *blockData )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
rfalSt25tbReadBlockReq readBlockReq;
|
|
|
|
|
|
/* Compute Read Block Request */
|
|
readBlockReq.cmd = RFAL_ST25TB_READ_BLOCK_CMD;
|
|
readBlockReq.address = blockAddress;
|
|
|
|
/* Send Read Block Request */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&readBlockReq, sizeof(rfalSt25tbReadBlockReq), (uint8_t*)blockData, sizeof(rfalSt25tbBlock), &rxLen, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
|
|
/* Check for valid UID Response */
|
|
if( (ret == ERR_NONE) && (rxLen != RFAL_ST25TB_BLOCK_LEN) )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerWriteBlock( uint8_t blockAddress, const rfalSt25tbBlock *blockData )
|
|
{
|
|
ReturnCode ret;
|
|
uint16_t rxLen;
|
|
rfalSt25tbWriteBlockReq writeBlockReq;
|
|
rfalSt25tbBlock tmpBlockData;
|
|
|
|
|
|
/* Compute Write Block Request */
|
|
writeBlockReq.cmd = RFAL_ST25TB_WRITE_BLOCK_CMD;
|
|
writeBlockReq.address = blockAddress;
|
|
ST_MEMCPY( &writeBlockReq.data, blockData, RFAL_ST25TB_BLOCK_LEN );
|
|
|
|
/* Send Write Block Request */
|
|
ret = rfalTransceiveBlockingTxRx( (uint8_t*)&writeBlockReq, sizeof(rfalSt25tbWriteBlockReq), tmpBlockData, RFAL_ST25TB_BLOCK_LEN, &rxLen, RFAL_TXRX_FLAGS_DEFAULT, (RFAL_ST25TB_FWT + RFAL_ST25TB_TW) );
|
|
|
|
|
|
/* Check if there was any error besides timeout */
|
|
if( ret != ERR_TIMEOUT )
|
|
{
|
|
/* Check if an unexpected answer was received */
|
|
if( ret == ERR_NONE )
|
|
{
|
|
return ERR_PROTO;
|
|
}
|
|
|
|
/* Check whether a transmission error occurred */
|
|
if( (ret != ERR_CRC) && (ret != ERR_FRAMING) && (ret != ERR_NOMEM) && (ret != ERR_RF_COLLISION) )
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
/* If a transmission error occurred (maybe noise while commiting data) wait maximum programming time and verify data afterwards */
|
|
rfalSetGT( (RFAL_ST25TB_FWT + RFAL_ST25TB_TW) );
|
|
rfalFieldOnAndStartGT();
|
|
}
|
|
|
|
ret = rfalSt25tbPollerReadBlock(blockAddress, &tmpBlockData);
|
|
if( ret == ERR_NONE )
|
|
{
|
|
if( ST_BYTECMP( &tmpBlockData, blockData, RFAL_ST25TB_BLOCK_LEN ) == 0 )
|
|
{
|
|
return ERR_NONE;
|
|
}
|
|
return ERR_PROTO;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerCompletion( void )
|
|
{
|
|
uint8_t completionReq;
|
|
|
|
/* Compute Completion Request */
|
|
completionReq = RFAL_ST25TB_COMPLETION_CMD;
|
|
|
|
/* Send Completion Request, no response is expected */
|
|
return rfalTransceiveBlockingTxRx( (uint8_t*)&completionReq, RFAL_ST25TB_CMD_LEN, NULL, 0, NULL, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
}
|
|
|
|
|
|
/*******************************************************************************/
|
|
ReturnCode rfalSt25tbPollerResetToInventory( void )
|
|
{
|
|
uint8_t resetInvReq;
|
|
|
|
/* Compute Completion Request */
|
|
resetInvReq = RFAL_ST25TB_RESET_INV_CMD;
|
|
|
|
/* Send Completion Request, no response is expected */
|
|
return rfalTransceiveBlockingTxRx( (uint8_t*)&resetInvReq, RFAL_ST25TB_CMD_LEN, NULL, 0, NULL, RFAL_TXRX_FLAGS_DEFAULT, RFAL_ST25TB_FWT );
|
|
}
|
|
|
|
#endif /* RFAL_FEATURE_ST25TB */
|