File content as of revision 1:b96176a4ccb8:

/*
  ______                              _
 / _____)             _              | |
( (____  _____ ____ _| |_ _____  ____| |__
 \____ \| ___ |    (_   _) ___ |/ ___)  _ \
 _____) ) ____| | | || |_| ____( (___| | | |
(______/|_____)_|_|_| \__)_____)\____)_| |_|
    (C)2016 Semtech

Description: EEPROM routines

Maintainer: Gregory Cristian & Gilbert Menth
*/

#include "mbed.h"
#include "string.h"
#include "Eeprom.h"
#include "Menu.h"
#include "DemoApplication.h"
#include "sx126x.h"
#if defined( TARGET_NUCLEO_L476RG )
#include "stm32l4xx_hal_flash.h"
#elif defined( TARGET_NUCLEO_L152RE )
#include "stm32l1xx_hal_flash.h"
#else
#error "Please define include file"
#endif



#include "DisplayDriver.h"


/*!
 * \brief Define address of Emulated EEPROM (in fact region of Flash)
 */
#if defined( TARGET_NUCLEO_L476RG )
#define DATA_EEPROM_BASE    ( ( uint32_t )0x0807F800U )
#define DATA_EEPROM_END     ( ( uint32_t )DATA_EEPROM_BASE + 2048 )
#elif defined( TARGET_NUCLEO_L152RE )
#define DATA_EEPROM_BASE    ( ( uint32_t )0x08080000U ) 
#define DATA_EEPROM_END     ( ( uint32_t )0x080807FFU )
#else
#error "Please define EEPROM base address and size for your board "
#endif


/*!
 * \brief CRC of EEPROM buffer and its valid status
 */
typedef struct
{
    uint16_t Value;
    bool Valid;
}MemTestStruct_t;

/*!
 * \brief Local copy of Eeprom.
 */
Eeprom_t Eeprom;


// Check CRC of local copy of Eeprom (Buffer). This update Valid & Value
static MemTestStruct_t EepromDataCheckSum( void );
uint8_t EepromMcuWriteBuffer( uint16_t addr, uint8_t *buffer, uint16_t size );

void EepromInit( uint8_t deviceConnected, uint8_t matchingFreq )
{
    MemTestStruct_t memTestStruct;

    EepromMcuReadBuffer( 0, Eeprom.Buffer, EEPROM_BUFFER_SIZE );
    EepromLoadGeneralSettings( );

    memTestStruct = EepromDataCheckSum( );
    if( !( memTestStruct.Valid ) || ( Eeprom.EepromData.DemoSettings.LastDeviceConnected != deviceConnected ) )
    {
#ifdef ADV_DEBUG
        printf("EepromDataCheckSum failed\n\r");
#endif
        EepromSetDefaultSettings( deviceConnected, matchingFreq );
    }
    EepromLoadSettings( ( RadioPacketTypes_t ) Eeprom.EepromData.DemoSettings.ModulationType );
}

void EepromSaveSettings( EepromDataSet_t dataSet)
{
    MemTestStruct_t memTestStruct;

    switch( dataSet )
    {
        case RADIO_LORA_PARAMS:
            Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor = ( RadioLoRaSpreadingFactors_t ) Eeprom.EepromData.DemoSettings.ModulationParam1;
            Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth       = ( RadioLoRaBandwidths_t )       Eeprom.EepromData.DemoSettings.ModulationParam2;
            Eeprom.EepromData.ModulationParams.Params.LoRa.CodingRate      = ( RadioLoRaCodingRates_t )      Eeprom.EepromData.DemoSettings.ModulationParam3;

            Eeprom.EepromData.PacketParams.Params.LoRa.PreambleLength      =                                 Eeprom.EepromData.DemoSettings.PacketParam1;
            Eeprom.EepromData.PacketParams.Params.LoRa.HeaderType          = ( RadioLoRaPacketLengthsMode_t )Eeprom.EepromData.DemoSettings.PacketParam2;
            Eeprom.EepromData.PacketParams.Params.LoRa.PayloadLength       =                                 Eeprom.EepromData.DemoSettings.PacketParam3;
            Eeprom.EepromData.PacketParams.Params.LoRa.CrcMode             = ( RadioLoRaCrcModes_t )         Eeprom.EepromData.DemoSettings.PacketParam4;
            Eeprom.EepromData.PacketParams.Params.LoRa.InvertIQ            = ( RadioLoRaIQModes_t )          Eeprom.EepromData.DemoSettings.PacketParam5;

            memcpy( Eeprom.Buffer + MOD_LORA_SPREADF_EEPROM_ADDR,      &( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor ), 1 );
            memcpy( Eeprom.Buffer + MOD_LORA_BW_EEPROM_ADDR,           &( Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth ),       1 );
            memcpy( Eeprom.Buffer + MOD_LORA_CODERATE_EEPROM_ADDR,     &( Eeprom.EepromData.ModulationParams.Params.LoRa.CodingRate ),      1 );
            memcpy( Eeprom.Buffer + PAK_LORA_PREAMBLE_LEN_EEPROM_ADDR, &( Eeprom.EepromData.PacketParams.Params.LoRa.PreambleLength ),      1 );
            memcpy( Eeprom.Buffer + PAK_LORA_HEADERTYPE_EEPROM_ADDR,   &( Eeprom.EepromData.PacketParams.Params.LoRa.HeaderType ),          1 );
            memcpy( Eeprom.Buffer + PAK_LORA_PL_LEN_EEPROM_ADDR,       &( Eeprom.EepromData.PacketParams.Params.LoRa.PayloadLength ),       1 );
            memcpy( Eeprom.Buffer + PAK_LORA_CRC_MODE_EEPROM_ADDR,     &( Eeprom.EepromData.PacketParams.Params.LoRa.CrcMode ),             1 );
            memcpy( Eeprom.Buffer + PAK_LORA_IQ_INV_EEPROM_ADDR,       &( Eeprom.EepromData.PacketParams.Params.LoRa.InvertIQ ),            1 );
#ifdef ADV_DEBUG
            printf("Saved RADIO_LoRa_PARAMS\n\r");
#endif
            break;

        case RADIO_GFSK_PARAMS:
            Eeprom.EepromData.ModulationParams.Params.Gfsk.BitRate           =                             Eeprom.EepromData.DemoSettings.ModulationParam1;
            Eeprom.EepromData.ModulationParams.Params.Gfsk.Fdev              =                             Eeprom.EepromData.DemoSettings.ModulationParam2;
            Eeprom.EepromData.ModulationParams.Params.Gfsk.ModulationShaping = ( RadioModShapings_t )      Eeprom.EepromData.DemoSettings.ModulationParam3;
            Eeprom.EepromData.ModulationParams.Params.Gfsk.Bandwidth         = ( RadioRxBandwidth_t )      Eeprom.EepromData.DemoSettings.ModulationParam4;
            Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleLength        =                             Eeprom.EepromData.DemoSettings.PacketParam1;
            Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleMinDetect     = ( RadioPreambleDetection_t )Eeprom.EepromData.DemoSettings.PacketParam2;
            Eeprom.EepromData.PacketParams.Params.Gfsk.SyncWordLength        =                             Eeprom.EepromData.DemoSettings.PacketParam3;
            Eeprom.EepromData.PacketParams.Params.Gfsk.AddrComp              = ( RadioAddressComp_t )      Eeprom.EepromData.DemoSettings.PacketParam4;
            Eeprom.EepromData.PacketParams.Params.Gfsk.HeaderType            = ( RadioPacketLengthModes_t )Eeprom.EepromData.DemoSettings.PacketParam5;
            Eeprom.EepromData.PacketParams.Params.Gfsk.PayloadLength         =                             Eeprom.EepromData.DemoSettings.PacketParam6;

            Eeprom.EepromData.PacketParams.Params.Gfsk.CrcLength             = ( RadioCrcTypes_t )         Eeprom.EepromData.DemoSettings.PacketParam7;
            Eeprom.EepromData.PacketParams.Params.Gfsk.DcFree                = ( RadioDcFree_t )           Eeprom.EepromData.DemoSettings.PacketParam8;

            memcpy( Eeprom.Buffer + MOD_GFSK_BR_EEPROM_ADDR,           &( Eeprom.EepromData.ModulationParams.Params.Gfsk.BitRate ),           4 );
            memcpy( Eeprom.Buffer + MOD_GFSK_FDEV_EEPROM_ADDR,         &( Eeprom.EepromData.ModulationParams.Params.Gfsk.Fdev ),              4 );
            memcpy( Eeprom.Buffer + MOD_GFSK_MOD_SHAPE_EEPROM_ADDR,    &( Eeprom.EepromData.ModulationParams.Params.Gfsk.ModulationShaping ), 1 );
            memcpy( Eeprom.Buffer + MOD_GFSK_BW_EEPROM_ADDR,           &( Eeprom.EepromData.ModulationParams.Params.Gfsk.Bandwidth ),         1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_PREAMBLE_LEN_EEPROM_ADDR, &( Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleLength ),        1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_PR_MIN_DET_EEPROM_ADDR,   &( Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleMinDetect ),     1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_SYNC_LEN_EEPROM_ADDR,     &( Eeprom.EepromData.PacketParams.Params.Gfsk.SyncWordLength ),        1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_HEADERTYPE_EEPROM_ADDR,   &( Eeprom.EepromData.PacketParams.Params.Gfsk.HeaderType ),            1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_PL_LEN_EEPROM_ADDR,       &( Eeprom.EepromData.PacketParams.Params.Gfsk.PayloadLength ),         1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_ADDR_COMP_EEPROM_ADDR,    &( Eeprom.EepromData.PacketParams.Params.Gfsk.AddrComp ),              1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_CRC_LEN_EEPROM_ADDR,      &( Eeprom.EepromData.PacketParams.Params.Gfsk.CrcLength ),             1 );
            memcpy( Eeprom.Buffer + PAK_GFSK_DC_FREE_EEPROM_ADDR,      &( Eeprom.EepromData.PacketParams.Params.Gfsk.DcFree ),                1 );
            
#ifdef ADV_DEBUG
            printf("Saved RADIO_GFSK_PARAMS\n\r");
#endif
            break;

        case DEMO_SETTINGS:
            memcpy( Eeprom.Buffer + APP_ENTITY_EEPROM_ADDR,           &( Eeprom.EepromData.DemoSettings.Entity ),           1 );
            memcpy( Eeprom.Buffer + APP_RADIO_BOOSTED_RX_EEPROM_ADDR, &( Eeprom.EepromData.DemoSettings.BoostedRx ),        1 );
            memcpy( Eeprom.Buffer + APP_FREQ_EEPROM_ADDR,             &( Eeprom.EepromData.DemoSettings.Frequency ),        4 );
            memcpy( Eeprom.Buffer + APP_TXPWR_EEPROM_ADDR,            &( Eeprom.EepromData.DemoSettings.TxPower ),          1 );
            memcpy( Eeprom.Buffer + APP_MOD_TYPE_EEPROM_ADDR,         &( Eeprom.EepromData.DemoSettings.ModulationType ),   1 );
            memcpy( Eeprom.Buffer + APP_PER_NPAK_MAX_EEPROM_ADDR,     &( Eeprom.EepromData.DemoSettings.MaxNumPacket ),     4 );
            memcpy( Eeprom.Buffer + APP_RADIO_POWER_MODE_EEPROM_ADDR, &( Eeprom.EepromData.DemoSettings.RadioPowerMode ),   1 );
            memcpy( Eeprom.Buffer + MOD_PKET_TYPE_EEPROM_ADDR,        &( Eeprom.EepromData.DemoSettings.ModulationType ),  1 );
            memcpy( Eeprom.Buffer + PAK_PKET_TYPE_EEPROM_ADDR,        &( Eeprom.EepromData.DemoSettings.ModulationType ),  1 );
            memcpy( Eeprom.Buffer + EEPROM_LAST_DEVICE_CONNECTED,     &( Eeprom.EepromData.DemoSettings.LastDeviceConnected ),  1 );

#ifdef ADV_DEBUG
            printf("Saved DEMO_SETTINGS\n\r");
#endif
            break;

        case SCREEN_DATA:
            memcpy( Eeprom.Buffer + SCR_CAL_FLAG_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.ScreenCalibrated ), 1 );
            memcpy( Eeprom.Buffer + SCR_CAL_POSA_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.Calibration.a ),    4 );
            memcpy( Eeprom.Buffer + SCR_CAL_POSB_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.Calibration.b ),    4 );
            memcpy( Eeprom.Buffer + SCR_CAL_POSC_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.Calibration.c ),    4 );
            memcpy( Eeprom.Buffer + SCR_CAL_POSD_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.Calibration.d ),    4 );
            memcpy( Eeprom.Buffer + SCR_CAL_POSE_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.Calibration.e ),    4 );
            memcpy( Eeprom.Buffer + SCR_CAL_POSF_EEPROM_ADDR, &( Eeprom.EepromData.MenuSettings.Calibration.f ),    4 );
            break;

        default:
#ifdef ADV_DEBUG
            printf("data not saved\n\r");
#endif
            break;
    }

    memTestStruct = EepromDataCheckSum( );
    memcpy( Eeprom.Buffer + EEPROM_CRC_EEPROM_ADDR, &( memTestStruct.Value ), 2 );

    EepromMcuWriteBuffer( 0, Eeprom.Buffer, EEPROM_BUFFER_SIZE );
}

void EepromLoadGeneralSettings( void )
{
    printf("Load General Settings\n\r");
    memcpy( &( Eeprom.EepromData.MenuSettings.ScreenCalibrated ), Eeprom.Buffer + SCR_CAL_FLAG_EEPROM_ADDR, 1 );
    memcpy( &( Eeprom.EepromData.MenuSettings.Calibration.a ),    Eeprom.Buffer + SCR_CAL_POSA_EEPROM_ADDR, 4 );
    memcpy( &( Eeprom.EepromData.MenuSettings.Calibration.b ),    Eeprom.Buffer + SCR_CAL_POSB_EEPROM_ADDR, 4 );
    memcpy( &( Eeprom.EepromData.MenuSettings.Calibration.c ),    Eeprom.Buffer + SCR_CAL_POSC_EEPROM_ADDR, 4 );
    memcpy( &( Eeprom.EepromData.MenuSettings.Calibration.d ),    Eeprom.Buffer + SCR_CAL_POSD_EEPROM_ADDR, 4 );
    memcpy( &( Eeprom.EepromData.MenuSettings.Calibration.e ),    Eeprom.Buffer + SCR_CAL_POSE_EEPROM_ADDR, 4 );
    memcpy( &( Eeprom.EepromData.MenuSettings.Calibration.f ),    Eeprom.Buffer + SCR_CAL_POSF_EEPROM_ADDR, 4 );

    memcpy( &( Eeprom.EepromData.DemoSettings.Entity ),         Eeprom.Buffer + APP_ENTITY_EEPROM_ADDR,           1 );
    memcpy( &( Eeprom.EepromData.DemoSettings.BoostedRx ),      Eeprom.Buffer + APP_RADIO_BOOSTED_RX_EEPROM_ADDR, 1 ); 
    memcpy( &( Eeprom.EepromData.DemoSettings.Frequency ),      Eeprom.Buffer + APP_FREQ_EEPROM_ADDR,             4 );
    memcpy( &( Eeprom.EepromData.DemoSettings.RadioPowerMode ), Eeprom.Buffer + APP_RADIO_POWER_MODE_EEPROM_ADDR, 1 );
    memcpy( &( Eeprom.EepromData.DemoSettings.TxPower ),        Eeprom.Buffer + APP_TXPWR_EEPROM_ADDR,            1 );
    memcpy( &( Eeprom.EepromData.DemoSettings.ModulationType ), Eeprom.Buffer + APP_MOD_TYPE_EEPROM_ADDR,         1 );
    memcpy( &( Eeprom.EepromData.DemoSettings.MaxNumPacket ),   Eeprom.Buffer + APP_PER_NPAK_MAX_EEPROM_ADDR,     4 );
    memcpy( &( Eeprom.EepromData.DemoSettings.LastDeviceConnected ), Eeprom.Buffer + EEPROM_LAST_DEVICE_CONNECTED,         1 );

    memcpy( &( Eeprom.EepromData.ModulationParams.PacketType ),                    Eeprom.Buffer + MOD_PKET_TYPE_EEPROM_ADDR,      1 );

    memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.BitRate ),           Eeprom.Buffer + MOD_GFSK_BR_EEPROM_ADDR,        4 );
    memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.Fdev ),              Eeprom.Buffer + MOD_GFSK_FDEV_EEPROM_ADDR,      4 );
    memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.ModulationShaping ), Eeprom.Buffer + MOD_GFSK_MOD_SHAPE_EEPROM_ADDR, 1 );
    memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.Bandwidth ),         Eeprom.Buffer + MOD_GFSK_BW_EEPROM_ADDR,        1 );

    memcpy( &( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor ),   Eeprom.Buffer + MOD_LORA_SPREADF_EEPROM_ADDR,   1 );
    memcpy( &( Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth ),         Eeprom.Buffer + MOD_LORA_BW_EEPROM_ADDR,        1 );
    memcpy( &( Eeprom.EepromData.ModulationParams.Params.LoRa.CodingRate ),        Eeprom.Buffer + MOD_LORA_CODERATE_EEPROM_ADDR,  1 );

    memcpy( &( Eeprom.EepromData.PacketParams.PacketType ),                    Eeprom.Buffer + PAK_PKET_TYPE_EEPROM_ADDR,         1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleLength ),    Eeprom.Buffer + PAK_GFSK_PREAMBLE_LEN_EEPROM_ADDR, 1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleMinDetect ), Eeprom.Buffer + PAK_GFSK_PR_MIN_DET_EEPROM_ADDR,   1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.SyncWordLength ),    Eeprom.Buffer + PAK_GFSK_SYNC_LEN_EEPROM_ADDR,     1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.HeaderType ),        Eeprom.Buffer + PAK_GFSK_HEADERTYPE_EEPROM_ADDR,   1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.PayloadLength ),     Eeprom.Buffer + PAK_GFSK_PL_LEN_EEPROM_ADDR,       1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.AddrComp ),          Eeprom.Buffer + PAK_GFSK_ADDR_COMP_EEPROM_ADDR,    1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.CrcLength ),         Eeprom.Buffer + PAK_GFSK_CRC_LEN_EEPROM_ADDR,      1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.DcFree ),            Eeprom.Buffer + PAK_GFSK_DC_FREE_EEPROM_ADDR,      1 );

    memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.PreambleLength ),    Eeprom.Buffer + PAK_LORA_PREAMBLE_LEN_EEPROM_ADDR, 1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.HeaderType ),        Eeprom.Buffer + PAK_LORA_HEADERTYPE_EEPROM_ADDR,   1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.PayloadLength ),     Eeprom.Buffer + PAK_LORA_PL_LEN_EEPROM_ADDR,       1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.CrcMode ),           Eeprom.Buffer + PAK_LORA_CRC_MODE_EEPROM_ADDR,     1 );
    memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.InvertIQ ),          Eeprom.Buffer + PAK_LORA_IQ_INV_EEPROM_ADDR,       1 );
}

void EepromLoadSettings( RadioPacketTypes_t modulation )
{
    if( modulation == PACKET_TYPE_LORA )
    {
        printf("Load Settings PACKET_TYPE_LORA\n\r");
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor ), Eeprom.Buffer + MOD_LORA_SPREADF_EEPROM_ADDR,      1 );
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth ),       Eeprom.Buffer + MOD_LORA_BW_EEPROM_ADDR,           1 );
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.LoRa.CodingRate ),      Eeprom.Buffer + MOD_LORA_CODERATE_EEPROM_ADDR,     1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.PreambleLength ),      Eeprom.Buffer + PAK_LORA_PREAMBLE_LEN_EEPROM_ADDR, 1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.HeaderType ),          Eeprom.Buffer + PAK_LORA_HEADERTYPE_EEPROM_ADDR,   1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.PayloadLength ),       Eeprom.Buffer + PAK_LORA_PL_LEN_EEPROM_ADDR,       1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.CrcMode ),             Eeprom.Buffer + PAK_LORA_CRC_MODE_EEPROM_ADDR,     1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.LoRa.InvertIQ ),            Eeprom.Buffer + PAK_LORA_IQ_INV_EEPROM_ADDR,       1 );

        Eeprom.EepromData.ModulationParams.PacketType   = PACKET_TYPE_LORA;
        Eeprom.EepromData.PacketParams.PacketType       = PACKET_TYPE_LORA;
        Eeprom.EepromData.DemoSettings.ModulationParam1 = Eeprom.EepromData.ModulationParams.Params.LoRa.SpreadingFactor;
        Eeprom.EepromData.DemoSettings.ModulationParam2 = Eeprom.EepromData.ModulationParams.Params.LoRa.Bandwidth;
        Eeprom.EepromData.DemoSettings.ModulationParam3 = Eeprom.EepromData.ModulationParams.Params.LoRa.CodingRate;

        Eeprom.EepromData.DemoSettings.PacketParam1 = Eeprom.EepromData.PacketParams.Params.LoRa.PreambleLength;
        Eeprom.EepromData.DemoSettings.PacketParam2 = Eeprom.EepromData.PacketParams.Params.LoRa.HeaderType;
        Eeprom.EepromData.DemoSettings.PacketParam3 = Eeprom.EepromData.PacketParams.Params.LoRa.PayloadLength;
        Eeprom.EepromData.DemoSettings.PacketParam4 = Eeprom.EepromData.PacketParams.Params.LoRa.CrcMode;
        Eeprom.EepromData.DemoSettings.PacketParam5 = Eeprom.EepromData.PacketParams.Params.LoRa.InvertIQ;
        Eeprom.EepromData.DemoSettings.PacketParam6 = 0x00;
        Eeprom.EepromData.DemoSettings.PacketParam7 = 0x00;
    }
    else// if( modulation == PACKET_TYPE_GFSK )
    {
        printf("Load Settings PACKET_TYPE_GFSK\n\r");
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.BitRate ),           Eeprom.Buffer + MOD_GFSK_BR_EEPROM_ADDR,           4 );
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.Fdev ),              Eeprom.Buffer + MOD_GFSK_FDEV_EEPROM_ADDR,         4 );
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.ModulationShaping ), Eeprom.Buffer + MOD_GFSK_MOD_SHAPE_EEPROM_ADDR,    1 );
        memcpy( &( Eeprom.EepromData.ModulationParams.Params.Gfsk.Bandwidth ),         Eeprom.Buffer + MOD_GFSK_BW_EEPROM_ADDR,           1 );
        
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleLength ),        Eeprom.Buffer + PAK_GFSK_PREAMBLE_LEN_EEPROM_ADDR, 1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleMinDetect ),     Eeprom.Buffer + PAK_GFSK_PR_MIN_DET_EEPROM_ADDR,   1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.SyncWordLength ),        Eeprom.Buffer + PAK_GFSK_SYNC_LEN_EEPROM_ADDR,     1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.HeaderType ),            Eeprom.Buffer + PAK_GFSK_HEADERTYPE_EEPROM_ADDR,   1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.PayloadLength ),         Eeprom.Buffer + PAK_GFSK_PL_LEN_EEPROM_ADDR,       1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.AddrComp ),              Eeprom.Buffer + PAK_GFSK_ADDR_COMP_EEPROM_ADDR,    1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.CrcLength ),             Eeprom.Buffer + PAK_GFSK_CRC_LEN_EEPROM_ADDR,      1 );
        memcpy( &( Eeprom.EepromData.PacketParams.Params.Gfsk.DcFree ),                Eeprom.Buffer + PAK_GFSK_DC_FREE_EEPROM_ADDR,      1 );

        Eeprom.EepromData.ModulationParams.PacketType   = PACKET_TYPE_GFSK;
        Eeprom.EepromData.PacketParams.PacketType       = PACKET_TYPE_GFSK;
        Eeprom.EepromData.DemoSettings.ModulationParam1 = Eeprom.EepromData.ModulationParams.Params.Gfsk.BitRate;
        Eeprom.EepromData.DemoSettings.ModulationParam2 = Eeprom.EepromData.ModulationParams.Params.Gfsk.Fdev;
        Eeprom.EepromData.DemoSettings.ModulationParam3 = Eeprom.EepromData.ModulationParams.Params.Gfsk.ModulationShaping;
        Eeprom.EepromData.DemoSettings.ModulationParam4 = Eeprom.EepromData.ModulationParams.Params.Gfsk.Bandwidth;

        Eeprom.EepromData.DemoSettings.PacketParam1 = Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleLength;
        Eeprom.EepromData.DemoSettings.PacketParam2 = Eeprom.EepromData.PacketParams.Params.Gfsk.PreambleMinDetect;
        Eeprom.EepromData.DemoSettings.PacketParam3 = Eeprom.EepromData.PacketParams.Params.Gfsk.SyncWordLength;
        Eeprom.EepromData.DemoSettings.PacketParam4 = Eeprom.EepromData.PacketParams.Params.Gfsk.AddrComp;
        Eeprom.EepromData.DemoSettings.PacketParam5 = Eeprom.EepromData.PacketParams.Params.Gfsk.HeaderType;
        Eeprom.EepromData.DemoSettings.PacketParam6 = Eeprom.EepromData.PacketParams.Params.Gfsk.PayloadLength;

        Eeprom.EepromData.DemoSettings.PacketParam7 = Eeprom.EepromData.PacketParams.Params.Gfsk.CrcLength;
        Eeprom.EepromData.DemoSettings.PacketParam8 = Eeprom.EepromData.PacketParams.Params.Gfsk.DcFree;
    }

    Eeprom.EepromData.DemoSettings.ModulationType = modulation;
}

void EepromSetDefaultSettings( uint8_t deviceConnected, uint8_t matchingFreq )
{
    Eeprom.EepromData.MenuSettings.ScreenCalibrated = false;

    printf("Set Default Settings\n\r");
    EepromSaveSettings( SCREEN_DATA );

    Eeprom.EepromData.DemoSettings.ModulationType = PACKET_TYPE_LORA;
    Eeprom.EepromData.ModulationParams.PacketType = PACKET_TYPE_LORA;
    Eeprom.EepromData.PacketParams.PacketType     = PACKET_TYPE_LORA;

    Eeprom.EepromData.DemoSettings.ModulationParam1 = LORA_SF7;
    Eeprom.EepromData.DemoSettings.ModulationParam2 = LORA_BW_500;
    Eeprom.EepromData.DemoSettings.ModulationParam3 = LORA_CR_4_5;
    Eeprom.EepromData.DemoSettings.ModulationParam4 = 0x00;

    Eeprom.EepromData.DemoSettings.PacketParam1 = 8;        // PreambleLength
    Eeprom.EepromData.DemoSettings.PacketParam2 = LORA_PACKET_VARIABLE_LENGTH;
    Eeprom.EepromData.DemoSettings.PacketParam3 = 16;       // PayloadLength
    Eeprom.EepromData.DemoSettings.PacketParam4 = LORA_CRC_ON;
    Eeprom.EepromData.DemoSettings.PacketParam5 = LORA_IQ_NORMAL;

    EepromSaveSettings( RADIO_LORA_PARAMS );

    Eeprom.EepromData.DemoSettings.ModulationType = PACKET_TYPE_GFSK;
    Eeprom.EepromData.ModulationParams.PacketType = PACKET_TYPE_GFSK;
    Eeprom.EepromData.PacketParams.PacketType     = PACKET_TYPE_GFSK;

    Eeprom.EepromData.DemoSettings.ModulationParam1 = 19200;
    Eeprom.EepromData.DemoSettings.ModulationParam2 = 5000;
    Eeprom.EepromData.DemoSettings.ModulationParam3 = MOD_SHAPING_G_BT_1;
    Eeprom.EepromData.DemoSettings.ModulationParam4 = RX_BW_39000;

    Eeprom.EepromData.DemoSettings.PacketParam1 = 40;
    Eeprom.EepromData.DemoSettings.PacketParam2 = RADIO_PREAMBLE_DETECTOR_08_BITS;
    Eeprom.EepromData.DemoSettings.PacketParam3 = 4;
    Eeprom.EepromData.DemoSettings.PacketParam4 = RADIO_ADDRESSCOMP_FILT_OFF;
    Eeprom.EepromData.DemoSettings.PacketParam5 = RADIO_PACKET_VARIABLE_LENGTH;
    Eeprom.EepromData.DemoSettings.PacketParam6 = 16;           // PayloadLength
    Eeprom.EepromData.DemoSettings.PacketParam7 = RADIO_CRC_2_BYTES_CCIT;
    Eeprom.EepromData.DemoSettings.PacketParam8 = RADIO_DC_FREE_OFF;

    EepromSaveSettings( RADIO_GFSK_PARAMS );

    Eeprom.EepromData.DemoSettings.Entity         = SLAVE;
    Eeprom.EepromData.DemoSettings.BoostedRx      = true;
    if( deviceConnected == SX1261 )
    {
        Eeprom.EepromData.DemoSettings.LastDeviceConnected = deviceConnected;
        Eeprom.EepromData.DemoSettings.RadioPowerMode = USE_DCDC;
        Eeprom.EepromData.DemoSettings.TxPower        = SX1261_POWER_TX_MAX;
    }
    else
    {
        Eeprom.EepromData.DemoSettings.LastDeviceConnected = deviceConnected;
        Eeprom.EepromData.DemoSettings.RadioPowerMode = USE_LDO;
        Eeprom.EepromData.DemoSettings.TxPower        = SX1262_POWER_TX_MAX;
    }
    
    if( matchingFreq == 1 )
    {
        Eeprom.EepromData.DemoSettings.Frequency      = DEMO_CENTRAL_FREQ_PRESET1; // 868 MHz
    }
    else 
    {
        Eeprom.EepromData.DemoSettings.Frequency      = DEMO_CENTRAL_FREQ_PRESET2; // 915 MHz
    }

    Eeprom.EepromData.DemoSettings.MaxNumPacket   = 0x00;
    Eeprom.EepromData.DemoSettings.ModulationType = PACKET_TYPE_LORA;

    EepromSaveSettings( DEMO_SETTINGS );
}

/*!
 * \brief Erase a page of Flash. Here used to Erase EEPROM region.
 *
 * \param [in]  page          address of page to erase
 * \param [in]  banks         address of banks to erase
 */
void FlashPageErase( uint32_t page, uint32_t banks )
{
    // Check the parameters
    assert_param( IS_FLASH_PAGE( page ) );
    assert_param( IS_FLASH_BANK_EXCLUSIVE( banks ) );

    if( ( banks & FLASH_BANK_1 ) != RESET )
    {
        CLEAR_BIT( FLASH->CR, FLASH_CR_BKER );
    }
    else
    {
        SET_BIT( FLASH->CR, FLASH_CR_BKER );
    }

    // Proceed to erase the page
    MODIFY_REG( FLASH->CR, FLASH_CR_PNB, ( page << 3 ) );
    SET_BIT( FLASH->CR, FLASH_CR_PER );
    SET_BIT( FLASH->CR, FLASH_CR_STRT );
}

/*!
 * \brief Write Eeprom to emulated EEPROM (in fact in Flash " higher address).
 *
 * \param [in]  addr          address of data (EEPROM offset not to be include)
 * \param [in]  buffer        buffer to use for copy
 * \param [in]  size          size of data to copy
 *
 * \retval      status        Status of operation (SUCCESS, ..)
 */
uint8_t EepromMcuWriteBuffer( uint16_t addr, uint8_t *buffer, uint16_t size )
{
    uint64_t *flash = ( uint64_t* )buffer;
    
    // assert_param( addr >= DATA_EEPROM_BASE );
    assert_param( buffer != NULL );
    assert_param( size < ( DATA_EEPROM_END - DATA_EEPROM_BASE ) );

    HAL_FLASH_Unlock( );
    
    FlashPageErase( 255, 1 );
    
    WRITE_REG( FLASH->CR, 0x40000000 );

    for( uint32_t i = 0; i < size; i++ )
    {
        HAL_FLASH_Program( FLASH_TYPEPROGRAM_DOUBLEWORD, DATA_EEPROM_BASE + \
                           ( 8 * i ), flash[i] );
    }

    HAL_FLASH_Lock( );

    return SUCCESS;
}

uint8_t EepromMcuReadBuffer( uint16_t addr, uint8_t *buffer, uint16_t size )
{
    assert_param( buffer != NULL );

    // assert_param( addr >= DATA_EEPROM_BASE );
    assert_param( buffer != NULL );
    assert_param( size < ( DATA_EEPROM_END - DATA_EEPROM_BASE ) );

    memcpy( buffer, ( uint8_t* )DATA_EEPROM_BASE, size );
    return SUCCESS;
}

static MemTestStruct_t EepromDataCheckSum( void )
{
    MemTestStruct_t memTestStruct;
    uint8_t x;
    uint8_t i;
    uint16_t crcBuf;
    memTestStruct.Value = 0xFFFF;

    for( i = 0; i < EEPROM_BUFFER_SIZE - sizeof( uint16_t ); i++ )
    {
        x = memTestStruct.Value >> 8 ^ Eeprom.Buffer[i];
        x ^= x >> 4;
        memTestStruct.Value = ( memTestStruct.Value << 8 ) ^ \
                              ( ( uint16_t )( x << 12 ) ) ^ \
                              ( ( uint16_t )( x << 5 ) ) ^ \
                              ( ( uint16_t )x );
    }
    memcpy( &crcBuf, Eeprom.Buffer + EEPROM_CRC_EEPROM_ADDR, 2 );
    memTestStruct.Valid = ( crcBuf == memTestStruct.Value );

    return memTestStruct;
}

void EepromEraseCheckSum( void )
{
    memset( Eeprom.Buffer, 0, sizeof( Eeprom.Buffer ) );
    EepromMcuWriteBuffer( 0, Eeprom.Buffer, EEPROM_BUFFER_SIZE );
}