NFC: application + rfal + driver.
This commit is contained in:
479
lib/ST25RFAL002/source/rfal_analogConfig.c
Executable file
479
lib/ST25RFAL002/source/rfal_analogConfig.c
Executable file
@@ -0,0 +1,479 @@
|
||||
|
||||
/******************************************************************************
|
||||
* \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_analogConfig.c
|
||||
*
|
||||
* \author bkam
|
||||
*
|
||||
* \brief Funcitons to manage and set analog settings.
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* INCLUDES
|
||||
******************************************************************************
|
||||
*/
|
||||
#include "rfal_analogConfig.h"
|
||||
#include "rfal_chip.h"
|
||||
#include "st_errno.h"
|
||||
#include "platform.h"
|
||||
#include "utils.h"
|
||||
|
||||
|
||||
/* Check whether the Default Analog settings are to be used or custom ones */
|
||||
#ifdef RFAL_ANALOG_CONFIG_CUSTOM
|
||||
extern const uint8_t* rfalAnalogConfigCustomSettings;
|
||||
extern const uint16_t rfalAnalogConfigCustomSettingsLength;
|
||||
#else
|
||||
#include "rfal_analogConfigTbl.h"
|
||||
#endif
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* DEFINES
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
|
||||
#define RFAL_TEST_REG 0x0080U /*!< Test Register indicator */
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* MACROS
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* LOCAL DATA TYPES
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
#if RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG
|
||||
static uint8_t gRfalAnalogConfig[RFAL_ANALOG_CONFIG_TBL_SIZE]; /*!< Analog Configuration Settings List */
|
||||
#endif /* RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG */
|
||||
|
||||
|
||||
/*! Struct for Analog Config Look Up Table Update */
|
||||
typedef struct {
|
||||
const uint8_t *currentAnalogConfigTbl; /*!< Reference to start of current Analog Configuration */
|
||||
uint16_t configTblSize; /*!< Total size of Analog Configuration */
|
||||
bool ready; /*!< Indicate if Look Up Table is complete and ready for use */
|
||||
} rfalAnalogConfigMgmt;
|
||||
|
||||
static rfalAnalogConfigMgmt gRfalAnalogConfigMgmt; /*!< Analog Configuration LUT management */
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* LOCAL TABLES
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* LOCAL FUNCTION PROTOTYPES
|
||||
******************************************************************************
|
||||
*/
|
||||
static rfalAnalogConfigNum rfalAnalogConfigSearch( rfalAnalogConfigId configId, uint16_t *configOffset );
|
||||
|
||||
#if RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG
|
||||
static void rfalAnalogConfigPtrUpdate( const uint8_t* analogConfigTbl );
|
||||
#endif /* RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG */
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* GLOBAL VARIABLE DEFINITIONS
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* GLOBAL FUNCTIONS
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
void rfalAnalogConfigInitialize( void )
|
||||
{
|
||||
/* Use default Analog configuration settings in Flash by default. */
|
||||
|
||||
/* Check whether the Default Analog settings are to be used or custom ones */
|
||||
#ifdef RFAL_ANALOG_CONFIG_CUSTOM
|
||||
gRfalAnalogConfigMgmt.currentAnalogConfigTbl = (const uint8_t *)&rfalAnalogConfigCustomSettings;
|
||||
gRfalAnalogConfigMgmt.configTblSize = rfalAnalogConfigCustomSettingsLength;
|
||||
#else
|
||||
gRfalAnalogConfigMgmt.currentAnalogConfigTbl = (const uint8_t *)&rfalAnalogConfigDefaultSettings;
|
||||
gRfalAnalogConfigMgmt.configTblSize = sizeof(rfalAnalogConfigDefaultSettings);
|
||||
#endif
|
||||
|
||||
gRfalAnalogConfigMgmt.ready = true;
|
||||
} /* rfalAnalogConfigInitialize() */
|
||||
|
||||
|
||||
bool rfalAnalogConfigIsReady( void )
|
||||
{
|
||||
return gRfalAnalogConfigMgmt.ready;
|
||||
}
|
||||
|
||||
ReturnCode rfalAnalogConfigListWriteRaw( const uint8_t *configTbl, uint16_t configTblSize )
|
||||
{
|
||||
#if RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG
|
||||
|
||||
/* Check if the Configuration Table exceed the Table size */
|
||||
if ( configTblSize >= RFAL_ANALOG_CONFIG_TBL_SIZE )
|
||||
{
|
||||
rfalAnalogConfigInitialize(); /* Revert to default Analog Configuration */
|
||||
return ERR_NOMEM;
|
||||
}
|
||||
|
||||
/* Check for invalid parameters */
|
||||
if( (configTbl == NULL) || (configTblSize == 0U) )
|
||||
{
|
||||
return ERR_PARAM;
|
||||
}
|
||||
|
||||
/* NOTE: Function does not check for the validity of the Table contents (conf IDs, conf sets, register address) */
|
||||
ST_MEMCPY( gRfalAnalogConfig, configTbl, configTblSize );
|
||||
|
||||
/* Update the total size of configuration settings */
|
||||
gRfalAnalogConfigMgmt.configTblSize = configTblSize;
|
||||
|
||||
rfalAnalogConfigPtrUpdate(gRfalAnalogConfig);
|
||||
return ERR_NONE;
|
||||
|
||||
#else
|
||||
|
||||
// If Analog Configuration Update is to be disabled
|
||||
NO_WARNING(configTbl);
|
||||
NO_WARNING(configTblSize);
|
||||
return ERR_REQUEST;
|
||||
|
||||
#endif /* RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG */
|
||||
}
|
||||
|
||||
ReturnCode rfalAnalogConfigListWrite( uint8_t more, const rfalAnalogConfig *config )
|
||||
{
|
||||
#if RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG
|
||||
|
||||
rfalAnalogConfigId configId;
|
||||
rfalAnalogConfigNum numConfig;
|
||||
uint8_t configSize;
|
||||
|
||||
if (true == gRfalAnalogConfigMgmt.ready)
|
||||
{ /* First Update to the Configuration list. */
|
||||
gRfalAnalogConfigMgmt.ready = false; // invalidate the config List
|
||||
gRfalAnalogConfigMgmt.configTblSize = 0; // Clear the config List
|
||||
}
|
||||
|
||||
configId = GETU16(config->id);
|
||||
|
||||
/* Check validity of the Configuration ID. */
|
||||
if ( (RFAL_ANALOG_CONFIG_TECH_RFU <= RFAL_ANALOG_CONFIG_ID_GET_TECH(configId))
|
||||
||((RFAL_ANALOG_CONFIG_BITRATE_6780 < RFAL_ANALOG_CONFIG_ID_GET_BITRATE(configId)) && (RFAL_ANALOG_CONFIG_BITRATE_1OF4 > RFAL_ANALOG_CONFIG_ID_GET_BITRATE(configId)))
|
||||
||(RFAL_ANALOG_CONFIG_BITRATE_1OF256 < RFAL_ANALOG_CONFIG_ID_GET_BITRATE(configId))
|
||||
)
|
||||
{
|
||||
rfalAnalogConfigInitialize(); /* Revert to default Analog Configuration */
|
||||
return ERR_PARAM;
|
||||
}
|
||||
|
||||
numConfig = config->num;
|
||||
configSize = (uint8_t)(sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum) + (numConfig * sizeof(rfalAnalogConfigRegAddrMaskVal)));
|
||||
|
||||
/* Check if the Configuration Set exceed the Table size. */
|
||||
if ( RFAL_ANALOG_CONFIG_TBL_SIZE <= (gRfalAnalogConfigMgmt.configTblSize + configSize) )
|
||||
{
|
||||
rfalAnalogConfigInitialize(); /* Revert to default Analog Configuration */
|
||||
return ERR_NOMEM;
|
||||
}
|
||||
|
||||
/* NOTE: Function does not check for the validity of the Register Address. */
|
||||
ST_MEMCPY(&gRfalAnalogConfig[gRfalAnalogConfigMgmt.configTblSize], (const uint8_t*)config, configSize);
|
||||
|
||||
/* Increment the total size of configuration settings. */
|
||||
gRfalAnalogConfigMgmt.configTblSize += configSize;
|
||||
|
||||
/* Check if it is the last Analog Configuration to load. */
|
||||
if (RFAL_ANALOG_CONFIG_UPDATE_LAST == more)
|
||||
{ /* Update the Analog Configuration to the new settings. */
|
||||
rfalAnalogConfigPtrUpdate(gRfalAnalogConfig);
|
||||
}
|
||||
|
||||
return ERR_NONE;
|
||||
|
||||
#else
|
||||
|
||||
// If Analog Configuration Update is to be disabled
|
||||
NO_WARNING(config);
|
||||
NO_WARNING(more);
|
||||
return ERR_DISABLED;
|
||||
|
||||
#endif /* RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG */
|
||||
|
||||
} /* rfalAnalogConfigListUpdate() */
|
||||
|
||||
ReturnCode rfalAnalogConfigListReadRaw( uint8_t *tblBuf, uint16_t tblBufLen, uint16_t *configTblSize )
|
||||
{
|
||||
/* Check if the the current table will fit into the given buffer */
|
||||
if( tblBufLen < gRfalAnalogConfigMgmt.configTblSize )
|
||||
{
|
||||
return ERR_NOMEM;
|
||||
}
|
||||
|
||||
/* Check for invalid parameters */
|
||||
if( configTblSize == NULL )
|
||||
{
|
||||
return ERR_PARAM;
|
||||
}
|
||||
|
||||
/* Copy the whole Table to the given buffer */
|
||||
if( gRfalAnalogConfigMgmt.configTblSize > 0U ) /* MISRA 21.18 */
|
||||
{
|
||||
ST_MEMCPY( tblBuf, gRfalAnalogConfigMgmt.currentAnalogConfigTbl, gRfalAnalogConfigMgmt.configTblSize );
|
||||
}
|
||||
*configTblSize = gRfalAnalogConfigMgmt.configTblSize;
|
||||
|
||||
return ERR_NONE;
|
||||
}
|
||||
|
||||
ReturnCode rfalAnalogConfigListRead( rfalAnalogConfigOffset *configOffset, uint8_t *more, rfalAnalogConfig *config, rfalAnalogConfigNum numConfig )
|
||||
{
|
||||
uint16_t configSize;
|
||||
rfalAnalogConfigOffset offset = *configOffset;
|
||||
rfalAnalogConfigNum numConfigSet;
|
||||
|
||||
/* Check if the number of register-mask-value settings for the respective Configuration ID will fit into the buffer passed in. */
|
||||
if (gRfalAnalogConfigMgmt.currentAnalogConfigTbl[offset + sizeof(rfalAnalogConfigId)] > numConfig)
|
||||
{
|
||||
return ERR_NOMEM;
|
||||
}
|
||||
|
||||
/* Get the number of Configuration set */
|
||||
numConfigSet = gRfalAnalogConfigMgmt.currentAnalogConfigTbl[offset + sizeof(rfalAnalogConfigId)];
|
||||
|
||||
/* Pass Configuration Register-Mask-Value sets */
|
||||
configSize = (sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum) + (uint16_t)(numConfigSet * sizeof(rfalAnalogConfigRegAddrMaskVal)));
|
||||
ST_MEMCPY( (uint8_t*) config
|
||||
, &gRfalAnalogConfigMgmt.currentAnalogConfigTbl[offset]
|
||||
, configSize
|
||||
);
|
||||
*configOffset = offset + configSize;
|
||||
|
||||
/* Check if it is the last Analog Configuration in the Table.*/
|
||||
*more = (uint8_t)((*configOffset >= gRfalAnalogConfigMgmt.configTblSize) ? RFAL_ANALOG_CONFIG_UPDATE_LAST
|
||||
: RFAL_ANALOG_CONFIG_UPDATE_MORE);
|
||||
|
||||
return ERR_NONE;
|
||||
} /* rfalAnalogConfigListRead() */
|
||||
|
||||
|
||||
ReturnCode rfalSetAnalogConfig( rfalAnalogConfigId configId )
|
||||
{
|
||||
rfalAnalogConfigOffset configOffset = 0;
|
||||
rfalAnalogConfigNum numConfigSet;
|
||||
const rfalAnalogConfigRegAddrMaskVal *configTbl;
|
||||
ReturnCode retCode = ERR_NONE;
|
||||
rfalAnalogConfigNum i;
|
||||
|
||||
if (true != gRfalAnalogConfigMgmt.ready)
|
||||
{
|
||||
return ERR_REQUEST;
|
||||
}
|
||||
|
||||
/* Search LUT for the specific Configuration ID. */
|
||||
while(true)
|
||||
{
|
||||
numConfigSet = rfalAnalogConfigSearch(configId, &configOffset);
|
||||
if( RFAL_ANALOG_CONFIG_LUT_NOT_FOUND == numConfigSet )
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
configTbl = (rfalAnalogConfigRegAddrMaskVal *)( (uint32_t)gRfalAnalogConfigMgmt.currentAnalogConfigTbl + (uint32_t)configOffset);
|
||||
/* Increment the offset to the next index to search from. */
|
||||
configOffset += (uint16_t)(numConfigSet * sizeof(rfalAnalogConfigRegAddrMaskVal));
|
||||
|
||||
if ((gRfalAnalogConfigMgmt.configTblSize + 1U) < configOffset)
|
||||
{ /* Error check make sure that the we do not access outside the configuration Table Size */
|
||||
return ERR_NOMEM;
|
||||
}
|
||||
|
||||
for ( i = 0; i < numConfigSet; i++)
|
||||
{
|
||||
if( (GETU16(configTbl[i].addr) & RFAL_TEST_REG) != 0U )
|
||||
{
|
||||
EXIT_ON_ERR(retCode, rfalChipChangeTestRegBits( (GETU16(configTbl[i].addr) & ~RFAL_TEST_REG), configTbl[i].mask, configTbl[i].val) );
|
||||
}
|
||||
else
|
||||
{
|
||||
EXIT_ON_ERR(retCode, rfalChipChangeRegBits( GETU16(configTbl[i].addr), configTbl[i].mask, configTbl[i].val) );
|
||||
}
|
||||
}
|
||||
|
||||
} /* while(found Analog Config Id) */
|
||||
|
||||
return retCode;
|
||||
|
||||
} /* rfalSetAnalogConfig() */
|
||||
|
||||
|
||||
uint16_t rfalAnalogConfigGenModeID( rfalMode md, rfalBitRate br, uint16_t dir )
|
||||
{
|
||||
uint16_t id;
|
||||
|
||||
/* Assign Poll/Listen Mode */
|
||||
id = ((md >= RFAL_MODE_LISTEN_NFCA) ? RFAL_ANALOG_CONFIG_LISTEN : RFAL_ANALOG_CONFIG_POLL);
|
||||
|
||||
/* Assign Technology */
|
||||
switch( md )
|
||||
{
|
||||
case RFAL_MODE_POLL_NFCA:
|
||||
case RFAL_MODE_POLL_NFCA_T1T:
|
||||
case RFAL_MODE_LISTEN_NFCA:
|
||||
id |= RFAL_ANALOG_CONFIG_TECH_NFCA;
|
||||
break;
|
||||
|
||||
case RFAL_MODE_POLL_NFCB:
|
||||
case RFAL_MODE_POLL_B_PRIME:
|
||||
case RFAL_MODE_POLL_B_CTS:
|
||||
case RFAL_MODE_LISTEN_NFCB:
|
||||
id |= RFAL_ANALOG_CONFIG_TECH_NFCB;
|
||||
break;
|
||||
|
||||
case RFAL_MODE_POLL_NFCF:
|
||||
case RFAL_MODE_LISTEN_NFCF:
|
||||
id |= RFAL_ANALOG_CONFIG_TECH_NFCF;
|
||||
break;
|
||||
|
||||
case RFAL_MODE_POLL_NFCV:
|
||||
case RFAL_MODE_POLL_PICOPASS:
|
||||
id |= RFAL_ANALOG_CONFIG_TECH_NFCV;
|
||||
break;
|
||||
|
||||
case RFAL_MODE_POLL_ACTIVE_P2P:
|
||||
case RFAL_MODE_LISTEN_ACTIVE_P2P:
|
||||
id |= RFAL_ANALOG_CONFIG_TECH_AP2P;
|
||||
break;
|
||||
|
||||
default:
|
||||
id = RFAL_ANALOG_CONFIG_TECH_CHIP;
|
||||
break;
|
||||
}
|
||||
|
||||
/* Assign Bitrate */
|
||||
id |= (((((uint16_t)(br) >= (uint16_t)RFAL_BR_52p97) ? (uint16_t)(br) : ((uint16_t)(br)+1U)) << RFAL_ANALOG_CONFIG_BITRATE_SHIFT) & RFAL_ANALOG_CONFIG_BITRATE_MASK);
|
||||
|
||||
/* Assign Direction */
|
||||
id |= ((dir<<RFAL_ANALOG_CONFIG_DIRECTION_SHIFT) & RFAL_ANALOG_CONFIG_DIRECTION_MASK);
|
||||
|
||||
return id;
|
||||
|
||||
} /* rfalAnalogConfigGenModeID() */
|
||||
|
||||
/*
|
||||
******************************************************************************
|
||||
* LOCAL FUNCTIONS
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
/*!
|
||||
*****************************************************************************
|
||||
* \brief Update the link to Analog Configuration LUT
|
||||
*
|
||||
* Update the link to the Analog Configuration LUT for the subsequent search
|
||||
* of Analog Settings.
|
||||
*
|
||||
* \param[in] analogConfigTbl: reference to the start of the new Analog Configuration Table
|
||||
*
|
||||
*****************************************************************************
|
||||
*/
|
||||
#if RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG
|
||||
static void rfalAnalogConfigPtrUpdate( const uint8_t* analogConfigTbl )
|
||||
{
|
||||
|
||||
gRfalAnalogConfigMgmt.currentAnalogConfigTbl = analogConfigTbl;
|
||||
gRfalAnalogConfigMgmt.ready = true;
|
||||
|
||||
} /* rfalAnalogConfigPtrUpdate() */
|
||||
#endif /* RFAL_FEATURE_DYNAMIC_ANALOG_CONFIG */
|
||||
|
||||
|
||||
/*!
|
||||
*****************************************************************************
|
||||
* \brief Search the Analog Configuration LUT for a specific Configuration ID.
|
||||
*
|
||||
* Search the Analog Configuration LUT for the Configuration ID.
|
||||
*
|
||||
* \param[in] configId: Configuration ID to search for.
|
||||
* \param[in] configOffset: Configuration Offset in Table
|
||||
*
|
||||
* \return number of Configuration Sets
|
||||
* \return #RFAL_ANALOG_CONFIG_LUT_NOT_FOUND in case Configuration ID is not found.
|
||||
*****************************************************************************
|
||||
*/
|
||||
static rfalAnalogConfigNum rfalAnalogConfigSearch( rfalAnalogConfigId configId, uint16_t *configOffset )
|
||||
{
|
||||
rfalAnalogConfigId foundConfigId;
|
||||
rfalAnalogConfigId configIdMaskVal;
|
||||
const uint8_t *configTbl;
|
||||
const uint8_t *currentConfigTbl;
|
||||
uint16_t i;
|
||||
|
||||
currentConfigTbl = gRfalAnalogConfigMgmt.currentAnalogConfigTbl;
|
||||
configIdMaskVal = ((RFAL_ANALOG_CONFIG_POLL_LISTEN_MODE_MASK | RFAL_ANALOG_CONFIG_BITRATE_MASK)
|
||||
|((RFAL_ANALOG_CONFIG_TECH_CHIP == RFAL_ANALOG_CONFIG_ID_GET_TECH(configId)) ? (RFAL_ANALOG_CONFIG_TECH_MASK | RFAL_ANALOG_CONFIG_CHIP_SPECIFIC_MASK) : configId)
|
||||
|((RFAL_ANALOG_CONFIG_NO_DIRECTION == RFAL_ANALOG_CONFIG_ID_GET_DIRECTION(configId)) ? RFAL_ANALOG_CONFIG_DIRECTION_MASK : configId)
|
||||
);
|
||||
|
||||
|
||||
/* When specific ConfigIDs are to be used, override search mask */
|
||||
if( (RFAL_ANALOG_CONFIG_ID_GET_DIRECTION(configId) == RFAL_ANALOG_CONFIG_DPO) )
|
||||
{
|
||||
configIdMaskVal = (RFAL_ANALOG_CONFIG_POLL_LISTEN_MODE_MASK | RFAL_ANALOG_CONFIG_TECH_MASK | RFAL_ANALOG_CONFIG_BITRATE_MASK | RFAL_ANALOG_CONFIG_DIRECTION_MASK);
|
||||
}
|
||||
|
||||
|
||||
i = *configOffset;
|
||||
while (i < gRfalAnalogConfigMgmt.configTblSize)
|
||||
{
|
||||
configTbl = ¤tConfigTbl[i];
|
||||
foundConfigId = GETU16(configTbl);
|
||||
if (configId == (foundConfigId & configIdMaskVal))
|
||||
{
|
||||
*configOffset = (uint16_t)(i + sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum));
|
||||
return configTbl[sizeof(rfalAnalogConfigId)];
|
||||
}
|
||||
|
||||
/* If Config Id does not match, increment to next Configuration Id */
|
||||
i += (uint16_t)( sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum)
|
||||
+ (configTbl[sizeof(rfalAnalogConfigId)] * sizeof(rfalAnalogConfigRegAddrMaskVal) )
|
||||
);
|
||||
} /* for */
|
||||
|
||||
return RFAL_ANALOG_CONFIG_LUT_NOT_FOUND;
|
||||
} /* rfalAnalogConfigSearch() */
|
Reference in New Issue
Block a user