|
|
@ -78,8 +78,7 @@ static uint16_t EE_VerifyPageFullyErased(uint32_t Address); |
|
|
|
* @retval - Flash error code: on write Flash error |
|
|
|
* - FLASH_COMPLETE: on success |
|
|
|
*/ |
|
|
|
uint16_t EE_Initialise(void) |
|
|
|
{ |
|
|
|
uint16_t EE_Initialise(void) { |
|
|
|
uint16_t PageStatus0 = 6, PageStatus1 = 6; |
|
|
|
uint16_t VarIdx = 0; |
|
|
|
uint16_t EepromStatus = 0, ReadStatus = 0; |
|
|
@ -100,209 +99,141 @@ uint16_t EE_Initialise(void) |
|
|
|
pEraseInit.VoltageRange = VOLTAGE_RANGE; |
|
|
|
|
|
|
|
/* Check for invalid header states and repair if necessary */ |
|
|
|
switch (PageStatus0) |
|
|
|
{ |
|
|
|
switch (PageStatus0) { |
|
|
|
case ERASED: |
|
|
|
if (PageStatus1 == VALID_PAGE) /* Page0 erased, Page1 valid */ |
|
|
|
{ |
|
|
|
if (PageStatus1 == VALID_PAGE) { /* Page0 erased, Page1 valid */ |
|
|
|
/* Erase Page0 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
if (FlashStatus != HAL_OK) { |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
else if (PageStatus1 == RECEIVE_DATA) /* Page0 erased, Page1 receive */ |
|
|
|
{ |
|
|
|
else if (PageStatus1 == RECEIVE_DATA) { /* Page0 erased, Page1 receive */ |
|
|
|
/* Erase Page0 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
/* Mark Page1 as valid */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE1_BASE_ADDRESS, VALID_PAGE); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
else /* First EEPROM access (Page0&1 are erased) or invalid state -> format EEPROM */ |
|
|
|
{ |
|
|
|
else { /* First EEPROM access (Page0&1 are erased) or invalid state -> format EEPROM */ |
|
|
|
/* Erase both Page0 and Page1 and set Page0 as valid page */ |
|
|
|
FlashStatus = EE_Format(); |
|
|
|
/* If erase/program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
break; |
|
|
|
|
|
|
|
case RECEIVE_DATA: |
|
|
|
if (PageStatus1 == VALID_PAGE) /* Page0 receive, Page1 valid */ |
|
|
|
{ |
|
|
|
if (PageStatus1 == VALID_PAGE) { /* Page0 receive, Page1 valid */ |
|
|
|
/* Transfer data from Page1 to Page0 */ |
|
|
|
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) |
|
|
|
{ |
|
|
|
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { |
|
|
|
if (( *(__IO uint16_t*)(PAGE0_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx]) |
|
|
|
{ |
|
|
|
x = VarIdx; |
|
|
|
} |
|
|
|
if (VarIdx != x) |
|
|
|
{ |
|
|
|
if (VarIdx != x) { |
|
|
|
/* Read the last variables' updates */ |
|
|
|
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); |
|
|
|
/* In case variable corresponding to the virtual address was found */ |
|
|
|
if (ReadStatus != 0x1) |
|
|
|
{ |
|
|
|
if (ReadStatus != 0x1) { |
|
|
|
/* Transfer the variable to the Page0 */ |
|
|
|
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (EepromStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return EepromStatus; |
|
|
|
} |
|
|
|
if (EepromStatus != HAL_OK) return EepromStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
/* Mark Page0 as valid */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
pEraseInit.Sector = PAGE1_ID; |
|
|
|
pEraseInit.NbSectors = 1; |
|
|
|
pEraseInit.VoltageRange = VOLTAGE_RANGE; |
|
|
|
/* Erase Page1 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
else if (PageStatus1 == ERASED) /* Page0 receive, Page1 erased */ |
|
|
|
{ |
|
|
|
else if (PageStatus1 == ERASED) { /* Page0 receive, Page1 erased */ |
|
|
|
pEraseInit.Sector = PAGE1_ID; |
|
|
|
pEraseInit.NbSectors = 1; |
|
|
|
pEraseInit.VoltageRange = VOLTAGE_RANGE; |
|
|
|
/* Erase Page1 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
/* Mark Page0 as valid */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
else /* Invalid state -> format eeprom */ |
|
|
|
{ |
|
|
|
else { /* Invalid state -> format eeprom */ |
|
|
|
/* Erase both Page0 and Page1 and set Page0 as valid page */ |
|
|
|
FlashStatus = EE_Format(); |
|
|
|
/* If erase/program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
break; |
|
|
|
|
|
|
|
case VALID_PAGE: |
|
|
|
if (PageStatus1 == VALID_PAGE) /* Invalid state -> format eeprom */ |
|
|
|
{ |
|
|
|
if (PageStatus1 == VALID_PAGE) { /* Invalid state -> format eeprom */ |
|
|
|
/* Erase both Page0 and Page1 and set Page0 as valid page */ |
|
|
|
FlashStatus = EE_Format(); |
|
|
|
/* If erase/program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
else if (PageStatus1 == ERASED) /* Page0 valid, Page1 erased */ |
|
|
|
{ |
|
|
|
else if (PageStatus1 == ERASED) { /* Page0 valid, Page1 erased */ |
|
|
|
pEraseInit.Sector = PAGE1_ID; |
|
|
|
pEraseInit.NbSectors = 1; |
|
|
|
pEraseInit.VoltageRange = VOLTAGE_RANGE; |
|
|
|
/* Erase Page1 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
else /* Page0 valid, Page1 receive */ |
|
|
|
{ |
|
|
|
else { /* Page0 valid, Page1 receive */ |
|
|
|
/* Transfer data from Page0 to Page1 */ |
|
|
|
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) |
|
|
|
{ |
|
|
|
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { |
|
|
|
if ((*(__IO uint16_t*)(PAGE1_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx]) |
|
|
|
{ |
|
|
|
x = VarIdx; |
|
|
|
} |
|
|
|
if (VarIdx != x) |
|
|
|
{ |
|
|
|
|
|
|
|
if (VarIdx != x) { |
|
|
|
/* Read the last variables' updates */ |
|
|
|
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); |
|
|
|
/* In case variable corresponding to the virtual address was found */ |
|
|
|
if (ReadStatus != 0x1) |
|
|
|
{ |
|
|
|
if (ReadStatus != 0x1) { |
|
|
|
/* Transfer the variable to the Page1 */ |
|
|
|
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (EepromStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return EepromStatus; |
|
|
|
} |
|
|
|
if (EepromStatus != HAL_OK) return EepromStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
/* Mark Page1 as valid */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE1_BASE_ADDRESS, VALID_PAGE); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
pEraseInit.Sector = PAGE0_ID; |
|
|
|
pEraseInit.NbSectors = 1; |
|
|
|
pEraseInit.VoltageRange = VOLTAGE_RANGE; |
|
|
|
/* Erase Page0 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
break; |
|
|
@ -311,10 +242,7 @@ uint16_t EE_Initialise(void) |
|
|
|
/* Erase both Page0 and Page1 and set Page0 as valid page */ |
|
|
|
FlashStatus = EE_Format(); |
|
|
|
/* If erase/program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
break; |
|
|
|
} |
|
|
|
|
|
|
@ -331,30 +259,22 @@ uint16_t EE_Initialise(void) |
|
|
|
* - 0: if Page not erased |
|
|
|
* - 1: if Page erased |
|
|
|
*/ |
|
|
|
uint16_t EE_VerifyPageFullyErased(uint32_t Address) |
|
|
|
{ |
|
|
|
uint16_t EE_VerifyPageFullyErased(uint32_t Address) { |
|
|
|
uint32_t ReadStatus = 1; |
|
|
|
uint16_t AddressValue = 0x5555; |
|
|
|
|
|
|
|
/* Check each active page address starting from end */ |
|
|
|
while (Address <= PAGE0_END_ADDRESS) |
|
|
|
{ |
|
|
|
while (Address <= PAGE0_END_ADDRESS) { |
|
|
|
/* Get the current location content to be compared with virtual address */ |
|
|
|
AddressValue = (*(__IO uint16_t*)Address); |
|
|
|
|
|
|
|
/* Compare the read address with the virtual address */ |
|
|
|
if (AddressValue != ERASED) |
|
|
|
{ |
|
|
|
|
|
|
|
if (AddressValue != ERASED) { |
|
|
|
/* In case variable value is read, reset ReadStatus flag */ |
|
|
|
ReadStatus = 0; |
|
|
|
|
|
|
|
break; |
|
|
|
} |
|
|
|
/* Next address location */ |
|
|
|
Address = Address + 4; |
|
|
|
Address += 4; |
|
|
|
} |
|
|
|
|
|
|
|
/* Return ReadStatus value: (0: Page not erased, 1: Sector erased) */ |
|
|
|
return ReadStatus; |
|
|
|
} |
|
|
@ -369,8 +289,7 @@ uint16_t EE_VerifyPageFullyErased(uint32_t Address) |
|
|
|
* - 1: if the variable was not found |
|
|
|
* - NO_VALID_PAGE: if no valid page was found. |
|
|
|
*/ |
|
|
|
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data) |
|
|
|
{ |
|
|
|
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data) { |
|
|
|
uint16_t ValidPage = PAGE0; |
|
|
|
uint16_t AddressValue = 0x5555, ReadStatus = 1; |
|
|
|
uint32_t Address = EEPROM_START_ADDRESS, PageStartAddress = EEPROM_START_ADDRESS; |
|
|
@ -379,10 +298,7 @@ uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data) |
|
|
|
ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE); |
|
|
|
|
|
|
|
/* Check if there is no valid page */ |
|
|
|
if (ValidPage == NO_VALID_PAGE) |
|
|
|
{ |
|
|
|
return NO_VALID_PAGE; |
|
|
|
} |
|
|
|
if (ValidPage == NO_VALID_PAGE) return NO_VALID_PAGE; |
|
|
|
|
|
|
|
/* Get the valid Page start Address */ |
|
|
|
PageStartAddress = (uint32_t)(EEPROM_START_ADDRESS + (uint32_t)(ValidPage * PAGE_SIZE)); |
|
|
@ -391,29 +307,21 @@ uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data) |
|
|
|
Address = (uint32_t)((EEPROM_START_ADDRESS - 2) + (uint32_t)((1 + ValidPage) * PAGE_SIZE)); |
|
|
|
|
|
|
|
/* Check each active page address starting from end */ |
|
|
|
while (Address > (PageStartAddress + 2)) |
|
|
|
{ |
|
|
|
while (Address > (PageStartAddress + 2)) { |
|
|
|
/* Get the current location content to be compared with virtual address */ |
|
|
|
AddressValue = (*(__IO uint16_t*)Address); |
|
|
|
|
|
|
|
/* Compare the read address with the virtual address */ |
|
|
|
if (AddressValue == VirtAddress) |
|
|
|
{ |
|
|
|
if (AddressValue == VirtAddress) { |
|
|
|
/* Get content of Address-2 which is variable value */ |
|
|
|
*Data = (*(__IO uint16_t*)(Address - 2)); |
|
|
|
|
|
|
|
/* In case variable value is read, reset ReadStatus flag */ |
|
|
|
ReadStatus = 0; |
|
|
|
|
|
|
|
break; |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
/* Next address location */ |
|
|
|
Address = Address - 4; |
|
|
|
} |
|
|
|
else /* Next address location */ |
|
|
|
Address -= 4; |
|
|
|
} |
|
|
|
|
|
|
|
/* Return ReadStatus value: (0: variable exist, 1: variable doesn't exist) */ |
|
|
|
return ReadStatus; |
|
|
|
} |
|
|
@ -428,19 +336,13 @@ uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data) |
|
|
|
* - NO_VALID_PAGE: if no valid page was found |
|
|
|
* - Flash error code: on write Flash error |
|
|
|
*/ |
|
|
|
uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data) |
|
|
|
{ |
|
|
|
uint16_t Status = 0; |
|
|
|
|
|
|
|
uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data) { |
|
|
|
/* Write the variable virtual address and value in the EEPROM */ |
|
|
|
Status = EE_VerifyPageFullWriteVariable(VirtAddress, Data); |
|
|
|
uint16_t Status = EE_VerifyPageFullWriteVariable(VirtAddress, Data); |
|
|
|
|
|
|
|
/* In case the EEPROM active page is full */ |
|
|
|
if (Status == PAGE_FULL) |
|
|
|
{ |
|
|
|
/* Perform Page transfer */ |
|
|
|
if (Status == PAGE_FULL) /* Perform Page transfer */ |
|
|
|
Status = EE_PageTransfer(VirtAddress, Data); |
|
|
|
} |
|
|
|
|
|
|
|
/* Return last operation status */ |
|
|
|
return Status; |
|
|
@ -452,8 +354,7 @@ uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data) |
|
|
|
* @retval Status of the last operation (Flash write or erase) done during |
|
|
|
* EEPROM formating |
|
|
|
*/ |
|
|
|
static HAL_StatusTypeDef EE_Format(void) |
|
|
|
{ |
|
|
|
static HAL_StatusTypeDef EE_Format(void) { |
|
|
|
HAL_StatusTypeDef FlashStatus = HAL_OK; |
|
|
|
uint32_t SectorError = 0; |
|
|
|
FLASH_EraseInitTypeDef pEraseInit; |
|
|
@ -463,33 +364,22 @@ static HAL_StatusTypeDef EE_Format(void) |
|
|
|
pEraseInit.NbSectors = 1; |
|
|
|
pEraseInit.VoltageRange = VOLTAGE_RANGE; |
|
|
|
/* Erase Page0 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
/* Set Page0 as valid page: Write VALID_PAGE at Page0 base address */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
|
|
|
|
pEraseInit.Sector = PAGE1_ID; |
|
|
|
/* Erase Page1 */ |
|
|
|
if(!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) |
|
|
|
{ |
|
|
|
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
} |
|
|
|
|
|
|
|
return HAL_OK; |
|
|
@ -504,8 +394,7 @@ static HAL_StatusTypeDef EE_Format(void) |
|
|
|
* @retval Valid page number (PAGE or PAGE1) or NO_VALID_PAGE in case |
|
|
|
* of no valid page was found |
|
|
|
*/ |
|
|
|
static uint16_t EE_FindValidPage(uint8_t Operation) |
|
|
|
{ |
|
|
|
static uint16_t EE_FindValidPage(uint8_t Operation) { |
|
|
|
uint16_t PageStatus0 = 6, PageStatus1 = 6; |
|
|
|
|
|
|
|
/* Get Page0 actual status */ |
|
|
@ -515,51 +404,28 @@ static uint16_t EE_FindValidPage(uint8_t Operation) |
|
|
|
PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS); |
|
|
|
|
|
|
|
/* Write or read operation */ |
|
|
|
switch (Operation) |
|
|
|
{ |
|
|
|
switch (Operation) { |
|
|
|
case WRITE_IN_VALID_PAGE: /* ---- Write operation ---- */ |
|
|
|
if (PageStatus1 == VALID_PAGE) |
|
|
|
{ |
|
|
|
if (PageStatus1 == VALID_PAGE) { |
|
|
|
/* Page0 receiving data */ |
|
|
|
if (PageStatus0 == RECEIVE_DATA) |
|
|
|
{ |
|
|
|
return PAGE0; /* Page0 valid */ |
|
|
|
if (PageStatus0 == RECEIVE_DATA) return PAGE0; /* Page0 valid */ |
|
|
|
else return PAGE1; /* Page1 valid */ |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
return PAGE1; /* Page1 valid */ |
|
|
|
} |
|
|
|
} |
|
|
|
else if (PageStatus0 == VALID_PAGE) |
|
|
|
{ |
|
|
|
else if (PageStatus0 == VALID_PAGE) { |
|
|
|
/* Page1 receiving data */ |
|
|
|
if (PageStatus1 == RECEIVE_DATA) |
|
|
|
{ |
|
|
|
return PAGE1; /* Page1 valid */ |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
return PAGE0; /* Page0 valid */ |
|
|
|
} |
|
|
|
if (PageStatus1 == RECEIVE_DATA) return PAGE1; /* Page1 valid */ |
|
|
|
else return PAGE0; /* Page0 valid */ |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
return NO_VALID_PAGE; /* No valid Page */ |
|
|
|
} |
|
|
|
|
|
|
|
case READ_FROM_VALID_PAGE: /* ---- Read operation ---- */ |
|
|
|
if (PageStatus0 == VALID_PAGE) |
|
|
|
{ |
|
|
|
return PAGE0; /* Page0 valid */ |
|
|
|
} |
|
|
|
else if (PageStatus1 == VALID_PAGE) |
|
|
|
{ |
|
|
|
return PAGE1; /* Page1 valid */ |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
return NO_VALID_PAGE ; /* No valid Page */ |
|
|
|
} |
|
|
|
return NO_VALID_PAGE; /* No valid Page */ |
|
|
|
|
|
|
|
default: |
|
|
|
return PAGE0; /* Page0 valid */ |
|
|
@ -576,8 +442,7 @@ static uint16_t EE_FindValidPage(uint8_t Operation) |
|
|
|
* - NO_VALID_PAGE: if no valid page was found |
|
|
|
* - Flash error code: on write Flash error |
|
|
|
*/ |
|
|
|
static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Data) |
|
|
|
{ |
|
|
|
static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Data) { |
|
|
|
HAL_StatusTypeDef FlashStatus = HAL_OK; |
|
|
|
uint16_t ValidPage = PAGE0; |
|
|
|
uint32_t Address = EEPROM_START_ADDRESS, PageEndAddress = EEPROM_START_ADDRESS+PAGE_SIZE; |
|
|
@ -586,10 +451,7 @@ static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Da |
|
|
|
ValidPage = EE_FindValidPage(WRITE_IN_VALID_PAGE); |
|
|
|
|
|
|
|
/* Check if there is no valid page */ |
|
|
|
if (ValidPage == NO_VALID_PAGE) |
|
|
|
{ |
|
|
|
return NO_VALID_PAGE; |
|
|
|
} |
|
|
|
if (ValidPage == NO_VALID_PAGE) return NO_VALID_PAGE; |
|
|
|
|
|
|
|
/* Get the valid Page start Address */ |
|
|
|
Address = (uint32_t)(EEPROM_START_ADDRESS + (uint32_t)(ValidPage * PAGE_SIZE)); |
|
|
@ -598,28 +460,20 @@ static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Da |
|
|
|
PageEndAddress = (uint32_t)((EEPROM_START_ADDRESS - 1) + (uint32_t)((ValidPage + 1) * PAGE_SIZE)); |
|
|
|
|
|
|
|
/* Check each active page address starting from begining */ |
|
|
|
while (Address < PageEndAddress) |
|
|
|
{ |
|
|
|
while (Address < PageEndAddress) { |
|
|
|
/* Verify if Address and Address+2 contents are 0xFFFFFFFF */ |
|
|
|
if ((*(__IO uint32_t*)Address) == 0xFFFFFFFF) |
|
|
|
{ |
|
|
|
if ((*(__IO uint32_t*)Address) == 0xFFFFFFFF) { |
|
|
|
/* Set variable data */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address, Data); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
/* Set variable virtual address */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address + 2, VirtAddress); |
|
|
|
/* Return program operation status */ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
/* Next address location */ |
|
|
|
Address = Address + 4; |
|
|
|
} |
|
|
|
else /* Next address location */ |
|
|
|
Address += 4; |
|
|
|
} |
|
|
|
|
|
|
|
/* Return PAGE_FULL in case the valid page is full */ |
|
|
@ -637,8 +491,7 @@ static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Da |
|
|
|
* - NO_VALID_PAGE: if no valid page was found |
|
|
|
* - Flash error code: on write Flash error |
|
|
|
*/ |
|
|
|
static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) |
|
|
|
{ |
|
|
|
static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) { |
|
|
|
HAL_StatusTypeDef FlashStatus = HAL_OK; |
|
|
|
uint32_t NewPageAddress = EEPROM_START_ADDRESS; |
|
|
|
uint16_t OldPageId=0; |
|
|
@ -650,60 +503,42 @@ static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) |
|
|
|
/* Get active Page for read operation */ |
|
|
|
ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE); |
|
|
|
|
|
|
|
if (ValidPage == PAGE1) /* Page1 valid */ |
|
|
|
{ |
|
|
|
if (ValidPage == PAGE1) { /* Page1 valid */ |
|
|
|
/* New page address where variable will be moved to */ |
|
|
|
NewPageAddress = PAGE0_BASE_ADDRESS; |
|
|
|
|
|
|
|
/* Old page ID where variable will be taken from */ |
|
|
|
OldPageId = PAGE1_ID; |
|
|
|
} |
|
|
|
else if (ValidPage == PAGE0) /* Page0 valid */ |
|
|
|
{ |
|
|
|
else if (ValidPage == PAGE0) { /* Page0 valid */ |
|
|
|
/* New page address where variable will be moved to */ |
|
|
|
NewPageAddress = PAGE1_BASE_ADDRESS; |
|
|
|
|
|
|
|
/* Old page ID where variable will be taken from */ |
|
|
|
OldPageId = PAGE0_ID; |
|
|
|
} |
|
|
|
else |
|
|
|
{ |
|
|
|
return NO_VALID_PAGE; /* No valid Page */ |
|
|
|
} |
|
|
|
|
|
|
|
/* Set the new Page status to RECEIVE_DATA status */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, RECEIVE_DATA); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
|
|
|
|
/* Write the variable passed as parameter in the new active page */ |
|
|
|
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddress, Data); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (EepromStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return EepromStatus; |
|
|
|
} |
|
|
|
if (EepromStatus != HAL_OK) return EepromStatus; |
|
|
|
|
|
|
|
/* Transfer process: transfer variables from old to the new active page */ |
|
|
|
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) |
|
|
|
{ |
|
|
|
if (VirtAddVarTab[VarIdx] != VirtAddress) /* Check each variable except the one passed as parameter */ |
|
|
|
{ |
|
|
|
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { |
|
|
|
if (VirtAddVarTab[VarIdx] != VirtAddress) { /* Check each variable except the one passed as parameter */ |
|
|
|
/* Read the other last variable updates */ |
|
|
|
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); |
|
|
|
/* In case variable corresponding to the virtual address was found */ |
|
|
|
if (ReadStatus != 0x1) |
|
|
|
{ |
|
|
|
if (ReadStatus != 0x1) { |
|
|
|
/* Transfer the variable to the new active page */ |
|
|
|
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (EepromStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return EepromStatus; |
|
|
|
} |
|
|
|
if (EepromStatus != HAL_OK) return EepromStatus; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
@ -716,18 +551,12 @@ static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) |
|
|
|
/* Erase the old Page: Set old Page status to ERASED status */ |
|
|
|
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); |
|
|
|
/* If erase operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
|
|
|
|
/* Set new Page status to VALID_PAGE status */ |
|
|
|
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, VALID_PAGE); |
|
|
|
/* If program operation was failed, a Flash error code is returned */ |
|
|
|
if (FlashStatus != HAL_OK) |
|
|
|
{ |
|
|
|
return FlashStatus; |
|
|
|
} |
|
|
|
if (FlashStatus != HAL_OK) return FlashStatus; |
|
|
|
|
|
|
|
/* Return last operation flash status */ |
|
|
|
return FlashStatus; |
|
|
|