mirror of
https://github.com/DarkFlippers/unleashed-firmware.git
synced 2024-12-17 02:13:19 +03:00
389ff92cc1
* Makefile, Scripts: new linter * About: remove ID from IC * Firmware: remove double define for DIVC/DIVR * Scripts: check folder names too. Docker: replace syntax check with make lint. * Reformat Sources and Migrate to new file naming convention * Docker: symlink clang-format-12 to clang-format * Add coding style guide
564 lines
17 KiB
C
564 lines
17 KiB
C
|
|
/******************************************************************************
|
|
* \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 */
|