Diego Ostuni
Fork of the GitHub
Diff: rfal_analogConfig.cpp
- Revision:
- 0:75fc82583a41
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/rfal_analogConfig.cpp Thu Nov 14 14:34:50 2019 +0000
@@ -0,0 +1,390 @@
+
+/******************************************************************************
+ * @attention
+ *
+ * <h2><center>© COPYRIGHT 2016 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:
+ *
+ * http://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_analogConfigTbl.h"
+#include "rfal_AnalogConfig.h"
+#include "rfal_chip.h"
+#include "st_errno.h"
+#include "platform1.h"
+#include "utils.h"
+
+/*
+ ******************************************************************************
+ * DEFINES
+ ******************************************************************************
+ */
+
+#define RFAL_TEST_REG 0x0080 /*!< 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 {
+ uint8_t *currentAnalogConfigTbl; /*!< Reference to start of current Analog Configuration */
+ uint16_t configTblSize; /*!< Total size of Analog Configuration */
+ uint8_t 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( 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. */
+ gRfalAnalogConfigMgmt.currentAnalogConfigTbl = (uint8_t *)rfalAnalogConfigDefaultSettings;
+ gRfalAnalogConfigMgmt.configTblSize = sizeof(rfalAnalogConfigDefaultSettings);
+ 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 )
+ {
+ 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, 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 = (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], 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 */
+ ST_MEMCPY( tblBuf, gRfalAnalogConfigMgmt.currentAnalogConfigTbl, gRfalAnalogConfigMgmt.configTblSize );
+ *configTblSize = gRfalAnalogConfigMgmt.configTblSize;
+
+ return ERR_NONE;
+}
+
+ReturnCode rfalAnalogConfigListRead( rfalAnalogConfigOffset *configOffset, uint8_t *more, rfalAnalogConfig *config, rfalAnalogConfigNum numConfig )
+{
+ uint8_t configSize;
+ rfalAnalogConfigOffset offset = *configOffset;
+
+ /* 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 */
+ numConfig = gRfalAnalogConfigMgmt.currentAnalogConfigTbl[offset + sizeof(rfalAnalogConfigId)];
+
+ /* Pass Configuration Register-Mask-Value sets */
+ configSize = (sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum) + (numConfig * sizeof(rfalAnalogConfigRegAddrMaskVal)));
+ ST_MEMCPY( config
+ , &gRfalAnalogConfigMgmt.currentAnalogConfigTbl[offset]
+ , configSize
+ );
+ *configOffset = offset + configSize;
+
+ /* Check if it is the last Analog Configuration in the Table.*/
+ *more = (*configOffset >= gRfalAnalogConfigMgmt.configTblSize) ? RFAL_ANALOG_CONFIG_UPDATE_LAST
+ : RFAL_ANALOG_CONFIG_UPDATE_MORE;
+
+ return ERR_NONE;
+} /* rfalAnalogConfigListRead() */
+
+
+ReturnCode rfalSetAnalogConfig( rfalAnalogConfigId configId, SPI* mspiChannel, ST25R3911* mST25, DigitalOut* gpio_cs, InterruptIn* IRQ, DigitalOut* fieldLED_01, DigitalOut* fieldLED_02, DigitalOut* fieldLED_03, DigitalOut* fieldLED_04, DigitalOut* fieldLED_05, DigitalOut* fieldLED_06 )
+{
+ rfalAnalogConfigOffset configOffset = 0;
+ rfalAnalogConfigNum numConfigSet;
+ rfalAnalogConfigRegAddrMaskVal *configTbl;
+ ReturnCode retCode = ERR_NONE;
+ rfalAnalogConfigNum i;
+
+ if (true != gRfalAnalogConfigMgmt.ready)
+ {
+ return ERR_REQUEST;
+ }
+
+ /* Search LUT for the specific Configuration ID. */
+ while (RFAL_ANALOG_CONFIG_LUT_NOT_FOUND != (numConfigSet = rfalAnalogConfigSearch(configId, &configOffset)))
+ {
+ configTbl = (rfalAnalogConfigRegAddrMaskVal *)( (uint32_t)gRfalAnalogConfigMgmt.currentAnalogConfigTbl + (uint32_t)configOffset);
+ /* Increment the offset to the next index to search from. */
+ configOffset += (numConfigSet * sizeof(rfalAnalogConfigRegAddrMaskVal));
+
+ if ((gRfalAnalogConfigMgmt.configTblSize + 1) < 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 )
+ {
+ EXIT_ON_ERR(retCode, rfalChipChangeTestRegBits( (GETU16(configTbl[i].addr) & ~RFAL_TEST_REG), configTbl[i].mask, configTbl[i].val, mspiChannel, mST25, gpio_cs, IRQ, fieldLED_01, fieldLED_02, fieldLED_03, fieldLED_04, fieldLED_05, fieldLED_06 ) );
+ }
+ else
+ {
+ EXIT_ON_ERR(retCode, rfalChipChangeRegBits( GETU16(configTbl[i].addr), configTbl[i].mask, configTbl[i].val, mspiChannel, mST25, gpio_cs, IRQ, fieldLED_01, fieldLED_02, fieldLED_03, fieldLED_04, fieldLED_05, fieldLED_06 ) );
+ }
+ }
+
+ } /* while(found Analog Config Id) */
+
+ return retCode;
+
+} /* rfalSetAnalogConfig() */
+
+/*
+ ******************************************************************************
+ * 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( 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;
+ uint8_t *configTbl;
+ 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 : configId)
+ |(RFAL_ANALOG_CONFIG_NO_DIRECTION == (RFAL_ANALOG_CONFIG_ID_GET_DIRECTION(configId)) ? RFAL_ANALOG_CONFIG_DIRECTION_MASK : configId)
+ );
+
+ for ( i = *configOffset; i < gRfalAnalogConfigMgmt.configTblSize; )
+ {
+ configTbl = ¤tConfigTbl[i];
+ foundConfigId = GETU16(configTbl);
+ if (configId == (foundConfigId & configIdMaskVal))
+ {
+ *configOffset = (i + sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum));
+ return configTbl[sizeof(rfalAnalogConfigId)];
+ }
+
+ /* If Config Id does not match, increment to next Configuration Id */
+ i += ( sizeof(rfalAnalogConfigId) + sizeof(rfalAnalogConfigNum)
+ + (configTbl[sizeof(rfalAnalogConfigId)] * sizeof(rfalAnalogConfigRegAddrMaskVal) )
+ );
+ }
+
+ return RFAL_ANALOG_CONFIG_LUT_NOT_FOUND;
+} /* rfalAnalogConfigSearch() */