microlab
/
scube
1
1
Fork 0
Code Issues Pull Requests Releases Activity

Tweak STM32F4/7 eeprom emulation (#14563)

Browse Source
2.0.x
Scott Lahteine 6 years ago committed by GitHub
parent 056efaba91
commit f990ebfb09
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
7 changed files with 225 additions and 323 deletions
Show Stats Download Patch File Download Diff File

192
Marlin/src/HAL/HAL_STM32F4/EEPROM_Emul/eeprom_emul.cpp
Unescape Escape View File

@ -8,8 +8,8 @@
****************************************************************************** ******************************************************************************
* @attention * @attention
* *
* <h2><center>&copy; Copyright © 2016 STMicroelectronics International N.V. * Copyright © 2016 STMicroelectronics International N.V.
* All rights reserved.</center></h2> * All rights reserved.
* *
* Redistribution and use in source and binary forms, with or without * Redistribution and use in source and binary forms, with or without
* modification, are permitted, provided that the following conditions are met: * modification, are permitted, provided that the following conditions are met:
@ -47,14 +47,11 @@
/** @addtogroup EEPROM_Emulation /** @addtogroup EEPROM_Emulation
* @{ * @{
*/ */
#if defined(STM32GENERIC) && (defined(STM32F4)) #if defined(STM32GENERIC) && defined(STM32F4)
/* Includes ------------------------------------------------------------------*/ /* Includes ------------------------------------------------------------------*/
#include "eeprom_emul.h" #include "eeprom_emul.h"
/* Private typedef -----------------------------------------------------------*/
/* Private define ------------------------------------------------------------*/
/* Private macro -------------------------------------------------------------*/
/* Private variables ---------------------------------------------------------*/ /* Private variables ---------------------------------------------------------*/
/* Global variable used to store variable value in read sequence */ /* Global variable used to store variable value in read sequence */
@ -79,76 +76,66 @@ static uint16_t EE_VerifyPageFullyErased(uint32_t Address);
* - FLASH_COMPLETE: on success * - FLASH_COMPLETE: on success
*/ */
uint16_t EE_Initialize(void) { uint16_t EE_Initialize(void) {
uint16_t PageStatus0 = 6, PageStatus1 = 6; /* Get Page0 and Page1 status */
uint16_t VarIdx = 0; uint16_t PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS),
uint16_t EepromStatus = 0, ReadStatus = 0;
int16_t x = -1;
HAL_StatusTypeDef FlashStatus;
uint32_t SectorError = 0;
FLASH_EraseInitTypeDef pEraseInit;
/* Get Page0 status */
PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS);
/* Get Page1 status */
PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS); PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS);
FLASH_EraseInitTypeDef pEraseInit;
pEraseInit.TypeErase = TYPEERASE_SECTORS; pEraseInit.TypeErase = TYPEERASE_SECTORS;
pEraseInit.Sector = PAGE0_ID; pEraseInit.Sector = PAGE0_ID;
pEraseInit.NbSectors = 1; pEraseInit.NbSectors = 1;
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Check for invalid header states and repair if necessary */ /* Check for invalid header states and repair if necessary */
uint32_t SectorError;
switch (PageStatus0) { switch (PageStatus0) {
case ERASED: case ERASED:
if (PageStatus1 == VALID_PAGE) { /* Page0 erased, Page1 valid */ if (PageStatus1 == VALID_PAGE) { /* Page0 erased, Page1 valid */
/* Erase Page0 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, simply return the result */
/* If erase operation was failed, a Flash error code is returned */ return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
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 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); HAL_StatusTypeDef fStat = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* If erase operation was failed, a Flash error code is returned */
if (FlashStatus != HAL_OK) return FlashStatus; if (fStat != HAL_OK) return fStat;
} }
/* Mark Page1 as valid */ /* Mark Page1 as valid */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE1_BASE_ADDRESS, VALID_PAGE); /* As the last operation, simply return the result */
/* If program operation was failed, a Flash error code is returned */ return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE1_BASE_ADDRESS, VALID_PAGE);
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 */ /* Erase both Page0 and Page1 and set Page0 as valid page */
FlashStatus = EE_Format(); /* As the last operation, simply return the result */
/* If erase/program operation was failed, a Flash error code is returned */ return EE_Format();
if (FlashStatus != HAL_OK) return FlashStatus;
} }
break; break;
case RECEIVE_DATA: 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 */ /* Transfer data from Page1 to Page0 */
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { int16_t x = -1;
for (uint16_t VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) {
if (( *(__IO uint16_t*)(PAGE0_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx]) if (( *(__IO uint16_t*)(PAGE0_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx])
x = VarIdx; x = VarIdx;
if (VarIdx != x) { if (VarIdx != x) {
/* Read the last variables' updates */ /* Read the last variables' updates */
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); uint16_t ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar);
/* In case variable corresponding to the virtual address was found */ /* In case variable corresponding to the virtual address was found */
if (ReadStatus != 0x1) { if (ReadStatus != 0x1) {
/* Transfer the variable to the Page0 */ /* Transfer the variable to the Page0 */
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); uint16_t EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Mark Page0 as valid */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); HAL_StatusTypeDef FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE);
/* If program operation was failed, a Flash error code is returned */ /* 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.Sector = PAGE1_ID;
@ -156,9 +143,8 @@ uint16_t EE_Initialize(void) {
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase Page1 */ /* Erase Page1 */
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, simply return the result */
/* If erase operation was failed, a Flash error code is returned */ return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
if (FlashStatus != HAL_OK) return FlashStatus;
} }
} }
else if (PageStatus1 == ERASED) { /* Page0 receive, Page1 erased */ else if (PageStatus1 == ERASED) { /* Page0 receive, Page1 erased */
@ -167,20 +153,18 @@ uint16_t EE_Initialize(void) {
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase Page1 */ /* Erase Page1 */
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); HAL_StatusTypeDef fStat = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* If erase operation was failed, a Flash error code is returned */
if (FlashStatus != HAL_OK) return FlashStatus; if (fStat != HAL_OK) return fStat;
} }
/* Mark Page0 as valid */ /* Mark Page0 as valid */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); /* As the last operation, simply return the result */
/* If program operation was failed, a Flash error code is returned */ return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE);
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 */ /* Erase both Page0 and Page1 and set Page0 as valid page */
FlashStatus = EE_Format(); /* As the last operation, simply return the result */
/* If erase/program operation was failed, a Flash error code is returned */ return EE_Format();
if (FlashStatus != HAL_OK) return FlashStatus;
} }
break; break;
@ -204,17 +188,18 @@ uint16_t EE_Initialize(void) {
} }
else { /* Page0 valid, Page1 receive */ else { /* Page0 valid, Page1 receive */
/* Transfer data from Page0 to Page1 */ /* Transfer data from Page0 to Page1 */
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { int16_t x = -1;
for (uint16_t VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) {
if ((*(__IO uint16_t*)(PAGE1_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx]) if ((*(__IO uint16_t*)(PAGE1_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx])
x = VarIdx; x = VarIdx;
if (VarIdx != x) { if (VarIdx != x) {
/* Read the last variables' updates */ /* Read the last variables' updates */
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); uint16_t ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar);
/* In case variable corresponding to the virtual address was found */ /* In case variable corresponding to the virtual address was found */
if (ReadStatus != 0x1) { if (ReadStatus != 0x1) {
/* Transfer the variable to the Page1 */ /* Transfer the variable to the Page1 */
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); uint16_t EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar);
/* If program operation was failed, a Flash error code is returned */ /* If program operation was failed, a Flash error code is returned */
if (EepromStatus != HAL_OK) return EepromStatus; if (EepromStatus != HAL_OK) return EepromStatus;
} }
@ -229,19 +214,16 @@ uint16_t EE_Initialize(void) {
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase Page0 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, simply return the result */
/* If erase operation was failed, a Flash error code is returned */ return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
if (FlashStatus != HAL_OK) return FlashStatus;
} }
} }
break; break;
default: /* Any other state -> format eeprom */ default: /* Any other state -> format eeprom */
/* Erase both Page0 and Page1 and set Page0 as valid page */ /* Erase both Page0 and Page1 and set Page0 as valid page */
FlashStatus = EE_Format(); /* As the last operation, simply return the result */
/* If erase/program operation was failed, a Flash error code is returned */ return EE_Format();
if (FlashStatus != HAL_OK) return FlashStatus;
break;
} }
return HAL_OK; return HAL_OK;
@ -259,11 +241,10 @@ uint16_t EE_Initialize(void) {
*/ */
uint16_t EE_VerifyPageFullyErased(uint32_t Address) { uint16_t EE_VerifyPageFullyErased(uint32_t Address) {
uint32_t ReadStatus = 1; uint32_t ReadStatus = 1;
uint16_t AddressValue = 0x5555;
/* Check each active page address starting from end */ /* 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 */ /* Get the current location content to be compared with virtual address */
AddressValue = (*(__IO uint16_t*)Address); uint16_t AddressValue = (*(__IO uint16_t*)Address);
/* Compare the read address with the virtual address */ /* Compare the read address with the virtual address */
if (AddressValue != ERASED) { if (AddressValue != ERASED) {
/* In case variable value is read, reset ReadStatus flag */ /* In case variable value is read, reset ReadStatus flag */
@ -288,26 +269,22 @@ uint16_t EE_VerifyPageFullyErased(uint32_t Address) {
* - NO_VALID_PAGE: if no valid page was 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 ReadStatus = 1;
uint16_t AddressValue = 0x5555, ReadStatus = 1;
uint32_t Address = EEPROM_START_ADDRESS, PageStartAddress = EEPROM_START_ADDRESS;
/* Get active Page for read operation */ /* Get active Page for read operation */
ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE); uint16_t ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE);
/* Check if there is no 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 */ /* Get the valid Page start and end Addresses */
PageStartAddress = (uint32_t)(EEPROM_START_ADDRESS + (uint32_t)(ValidPage * PAGE_SIZE)); uint32_t PageStartAddress = uint32_t(EEPROM_START_ADDRESS) + uint32_t(ValidPage * (PAGE_SIZE)),
Address = PageStartAddress + PAGE_SIZE - 2;
/* Get the valid Page end Address */
Address = (uint32_t)((EEPROM_START_ADDRESS - 2) + (uint32_t)((1 + ValidPage) * PAGE_SIZE));
/* Check each active page address starting from end */ /* 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 */ /* Get the current location content to be compared with virtual address */
AddressValue = (*(__IO uint16_t*)Address); uint16_t AddressValue = (*(__IO uint16_t*)Address);
/* Compare the read address with the virtual address */ /* Compare the read address with the virtual address */
if (AddressValue == VirtAddress) { if (AddressValue == VirtAddress) {
@ -353,16 +330,17 @@ uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data) {
* EEPROM formating * 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; FLASH_EraseInitTypeDef pEraseInit;
pEraseInit.TypeErase = FLASH_TYPEERASE_SECTORS; pEraseInit.TypeErase = FLASH_TYPEERASE_SECTORS;
pEraseInit.Sector = PAGE0_ID; pEraseInit.Sector = PAGE0_ID;
pEraseInit.NbSectors = 1; pEraseInit.NbSectors = 1;
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
HAL_StatusTypeDef FlashStatus; // = HAL_OK
/* Erase Page0 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
uint32_t SectorError;
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* If erase operation was failed, a Flash error code is returned */
if (FlashStatus != HAL_OK) return FlashStatus; if (FlashStatus != HAL_OK) return FlashStatus;
@ -375,9 +353,9 @@ static HAL_StatusTypeDef EE_Format(void) {
pEraseInit.Sector = PAGE1_ID; pEraseInit.Sector = PAGE1_ID;
/* Erase Page1 */ /* Erase Page1 */
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, just return the result code */
/* If erase operation was failed, a Flash error code is returned */ uint32_t SectorError;
if (FlashStatus != HAL_OK) return FlashStatus; return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
} }
return HAL_OK; return HAL_OK;
@ -393,12 +371,8 @@ static HAL_StatusTypeDef EE_Format(void) {
* of no valid page was found * 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 and Page1 actual status */
uint16_t PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS),
/* Get Page0 actual status */
PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS);
/* Get Page1 actual status */
PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS); PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS);
/* Write or read operation */ /* Write or read operation */
@ -406,13 +380,11 @@ static uint16_t EE_FindValidPage(uint8_t Operation) {
case WRITE_IN_VALID_PAGE: /* ---- Write operation ---- */ case WRITE_IN_VALID_PAGE: /* ---- Write operation ---- */
if (PageStatus1 == VALID_PAGE) { if (PageStatus1 == VALID_PAGE) {
/* Page0 receiving data */ /* Page0 receiving data */
if (PageStatus0 == RECEIVE_DATA) return PAGE0; /* Page0 valid */ return (PageStatus0 == RECEIVE_DATA) ? PAGE0 : PAGE1;
else return PAGE1; /* Page1 valid */
} }
else if (PageStatus0 == VALID_PAGE) { else if (PageStatus0 == VALID_PAGE) {
/* Page1 receiving data */ /* Page1 receiving data */
if (PageStatus1 == RECEIVE_DATA) return PAGE1; /* Page1 valid */ return (PageStatus1 == RECEIVE_DATA) ? PAGE1 : PAGE0;
else return PAGE0; /* Page0 valid */
} }
else else
return NO_VALID_PAGE; /* No valid Page */ return NO_VALID_PAGE; /* No valid Page */
@ -441,34 +413,26 @@ static uint16_t EE_FindValidPage(uint8_t Operation) {
* - Flash error code: on write Flash error * - 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;
/* Get valid Page for write operation */ /* Get valid Page for write operation */
ValidPage = EE_FindValidPage(WRITE_IN_VALID_PAGE); uint16_t ValidPage = EE_FindValidPage(WRITE_IN_VALID_PAGE);
/* Check if there is no 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 */ /* Get the valid Page start and end Addresses */
Address = (uint32_t)(EEPROM_START_ADDRESS + (uint32_t)(ValidPage * PAGE_SIZE)); uint32_t Address = uint32_t(EEPROM_START_ADDRESS) + uint32_t(ValidPage * (PAGE_SIZE)),
PageEndAddress = Address + PAGE_SIZE - 1;
/* Get the valid Page end Address */
PageEndAddress = (uint32_t)((EEPROM_START_ADDRESS - 1) + (uint32_t)((ValidPage + 1) * PAGE_SIZE));
/* Check each active page address starting from begining */ /* Check each active page address starting from begining */
while (Address < PageEndAddress) { while (Address < PageEndAddress) {
/* Verify if Address and Address+2 contents are 0xFFFFFFFF */ /* Verify if Address and Address+2 contents are 0xFFFFFFFF */
if ((*(__IO uint32_t*)Address) == 0xFFFFFFFF) { if ((*(__IO uint32_t*)Address) == 0xFFFFFFFF) {
/* Set variable data */ /* Set variable data */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address, Data); HAL_StatusTypeDef FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address, Data);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Set variable virtual address, return status */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address + 2, VirtAddress); return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address + 2, VirtAddress);
/* Return program operation status */
return FlashStatus;
} }
else /* Next address location */ else /* Next address location */
Address += 4; Address += 4;
@ -490,16 +454,10 @@ static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Da
* - Flash error code: on write Flash error * - 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;
uint16_t ValidPage = PAGE0, VarIdx = 0;
uint16_t EepromStatus = 0, ReadStatus = 0;
uint32_t SectorError = 0;
FLASH_EraseInitTypeDef pEraseInit;
/* Get active Page for read operation */ /* Get active Page for read operation */
ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE); uint16_t ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE);
uint32_t NewPageAddress = EEPROM_START_ADDRESS;
uint16_t OldPageId = 0;
if (ValidPage == PAGE1) { /* Page1 valid */ if (ValidPage == PAGE1) { /* Page1 valid */
/* New page address where variable will be moved to */ /* New page address where variable will be moved to */
@ -517,20 +475,20 @@ static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) {
return NO_VALID_PAGE; /* No valid Page */ return NO_VALID_PAGE; /* No valid Page */
/* Set the new Page status to RECEIVE_DATA status */ /* Set the new Page status to RECEIVE_DATA status */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, RECEIVE_DATA); HAL_StatusTypeDef FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, RECEIVE_DATA);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Write the variable passed as parameter in the new active page */
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddress, Data); uint16_t EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddress, Data);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Transfer process: transfer variables from old to the new active page */
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { for (uint16_t VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) {
if (VirtAddVarTab[VarIdx] != VirtAddress) { /* Check each variable except the one passed as parameter */ if (VirtAddVarTab[VarIdx] != VirtAddress) { /* Check each variable except the one passed as parameter */
/* Read the other last variable updates */ /* Read the other last variable updates */
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); uint16_t ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar);
/* In case variable corresponding to the virtual address was found */ /* In case variable corresponding to the virtual address was found */
if (ReadStatus != 0x1) { if (ReadStatus != 0x1) {
/* Transfer the variable to the new active page */ /* Transfer the variable to the new active page */
@ -541,26 +499,24 @@ static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) {
} }
} }
FLASH_EraseInitTypeDef pEraseInit;
pEraseInit.TypeErase = TYPEERASE_SECTORS; pEraseInit.TypeErase = TYPEERASE_SECTORS;
pEraseInit.Sector = OldPageId; pEraseInit.Sector = OldPageId;
pEraseInit.NbSectors = 1; pEraseInit.NbSectors = 1;
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase the old Page: Set old Page status to ERASED status */ /* Erase the old Page: Set old Page status to ERASED status */
uint32_t SectorError;
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* 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 */ /* Set new Page status to VALID_PAGE status */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, VALID_PAGE); /* As the last operation, just return the result code */
/* If program operation was failed, a Flash error code is returned */ return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, VALID_PAGE);
if (FlashStatus != HAL_OK) return FlashStatus;
/* Return last operation flash status */
return FlashStatus;
} }
#endif // STM32F4 || STM32F4xx #endif // STM32GENERIC && STM32F4
/** /**
* @} * @}

44
Marlin/src/HAL/HAL_STM32F4/EEPROM_Emul/eeprom_emul.h
Unescape Escape View File

@ -53,55 +53,53 @@
/* Exported constants --------------------------------------------------------*/ /* Exported constants --------------------------------------------------------*/
/* EEPROM emulation firmware error codes */ /* EEPROM emulation firmware error codes */
#define EE_OK (uint32_t)HAL_OK #define EE_OK uint32_t(HAL_OK)
#define EE_ERROR (uint32_t)HAL_ERROR #define EE_ERROR uint32_t(HAL_ERROR)
#define EE_BUSY (uint32_t)HAL_BUSY #define EE_BUSY uint32_t(HAL_BUSY)
#define EE_TIMEOUT (uint32_t)HAL_TIMEOUT #define EE_TIMEOUT uint32_t(HAL_TIMEOUT)
/* Define the size of the sectors to be used */ /* Define the size of the sectors to be used */
#define PAGE_SIZE (uint32_t)0x4000 /* Page size = 16KByte */ #define PAGE_SIZE uint32_t(0x4000) /* Page size = 16KByte */
/* Device voltage range supposed to be [2.7V to 3.6V], the operation will /* Device voltage range supposed to be [2.7V to 3.6V], the operation will
be done by word */ be done by word */
#define VOLTAGE_RANGE (uint8_t)VOLTAGE_RANGE_3 #define VOLTAGE_RANGE uint8_t(VOLTAGE_RANGE_3)
/* EEPROM start address in Flash */ /* EEPROM start address in Flash */
#define EEPROM_START_ADDRESS ((uint32_t)0x08078000) /* EEPROM emulation start address: #define EEPROM_START_ADDRESS uint32_t(0x08078000) /* EEPROM emulation start address:
after 480KByte of used Flash memory */ after 480KByte of used Flash memory */
/* Pages 0 and 1 base and end addresses */ /* Pages 0 and 1 base and end addresses */
#define PAGE0_BASE_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + 0x0000)) #define PAGE0_BASE_ADDRESS uint32_t(EEPROM_START_ADDRESS + 0x0000)
#define PAGE0_END_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + PAGE_SIZE - 1)) #define PAGE0_END_ADDRESS uint32_t(EEPROM_START_ADDRESS + PAGE_SIZE - 1)
#define PAGE0_ID FLASH_SECTOR_1 #define PAGE0_ID FLASH_SECTOR_1
#define PAGE1_BASE_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + 0x4000)) #define PAGE1_BASE_ADDRESS uint32_t(EEPROM_START_ADDRESS + 0x4000)
#define PAGE1_END_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + 2 * (PAGE_SIZE) - 1)) #define PAGE1_END_ADDRESS uint32_t(EEPROM_START_ADDRESS + 2 * (PAGE_SIZE) - 1)
#define PAGE1_ID FLASH_SECTOR_2 #define PAGE1_ID FLASH_SECTOR_2
/* Used Flash pages for EEPROM emulation */ /* Used Flash pages for EEPROM emulation */
#define PAGE0 ((uint16_t)0x0000) #define PAGE0 uint16_t(0x0000)
#define PAGE1 ((uint16_t)0x0001) /* Page nb between PAGE0_BASE_ADDRESS & PAGE1_BASE_ADDRESS*/ #define PAGE1 uint16_t(0x0001) /* Page nb between PAGE0_BASE_ADDRESS & PAGE1_BASE_ADDRESS*/
/* No valid page define */ /* No valid page define */
#define NO_VALID_PAGE ((uint16_t)0x00AB) #define NO_VALID_PAGE uint16_t(0x00AB)
/* Page status definitions */ /* Page status definitions */
#define ERASED ((uint16_t)0xFFFF) /* Page is empty */ #define ERASED uint16_t(0xFFFF) /* Page is empty */
#define RECEIVE_DATA ((uint16_t)0xEEEE) /* Page is marked to receive data */ #define RECEIVE_DATA uint16_t(0xEEEE) /* Page is marked to receive data */
#define VALID_PAGE ((uint16_t)0x0000) /* Page containing valid data */ #define VALID_PAGE uint16_t(0x0000) /* Page containing valid data */
/* Valid pages in read and write defines */ /* Valid pages in read and write defines */
#define READ_FROM_VALID_PAGE ((uint8_t)0x00) #define READ_FROM_VALID_PAGE uint8_t(0x00)
#define WRITE_IN_VALID_PAGE ((uint8_t)0x01) #define WRITE_IN_VALID_PAGE uint8_t(0x01)
/* Page full define */ /* Page full define */
#define PAGE_FULL ((uint8_t)0x80) #define PAGE_FULL uint8_t(0x80)
/* Variables' number */ /* Variables' number */
#define NB_OF_VAR ((uint16_t)4096) #define NB_OF_VAR uint16_t(4096)
/* Exported types ------------------------------------------------------------*/
/* Exported macro ------------------------------------------------------------*/
/* Exported functions ------------------------------------------------------- */ /* Exported functions ------------------------------------------------------- */
uint16_t EE_Initialize(void); uint16_t EE_Initialize(void);
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data); uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data);

27
Marlin/src/HAL/HAL_STM32F4/EmulatedEeprom.cpp
Unescape Escape View File

@ -17,13 +17,13 @@
* *
*/ */
#if defined(STM32GENERIC) && (defined(STM32F4))
/** /**
* Description: functions for I2C connected external EEPROM. * Description: Functions for a Flash emulated EEPROM
* Not platform dependent. * Not platform dependent.
*/ */
#if defined(STM32GENERIC) && defined(STM32F4)
#include "../../inc/MarlinConfig.h" #include "../../inc/MarlinConfig.h"
#if ENABLED(EEPROM_SETTINGS) && NONE(I2C_EEPROM, SPI_EEPROM) #if ENABLED(EEPROM_SETTINGS) && NONE(I2C_EEPROM, SPI_EEPROM)
@ -69,37 +69,34 @@ void eeprom_init() {
} }
void eeprom_write_byte(uint8_t *pos, unsigned char value) { void eeprom_write_byte(uint8_t *pos, unsigned char value) {
uint16_t eeprom_address = (unsigned) pos; uint16_t eeprom_address = unsigned(pos);
eeprom_init(); eeprom_init();
HAL_FLASH_Unlock(); HAL_FLASH_Unlock();
__HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_EOP | FLASH_FLAG_OPERR | FLASH_FLAG_WRPERR |FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR); __HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_EOP | FLASH_FLAG_OPERR | FLASH_FLAG_WRPERR |FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR);
if (EE_WriteVariable(eeprom_address, (uint16_t) value) != EE_OK) if (EE_WriteVariable(eeprom_address, uint16_t(value)) != EE_OK)
for (;;) HAL_Delay(1); // Spin forever until watchdog reset for (;;) HAL_Delay(1); // Spin forever until watchdog reset
HAL_FLASH_Lock(); HAL_FLASH_Lock();
} }
uint8_t eeprom_read_byte(uint8_t *pos) { uint8_t eeprom_read_byte(uint8_t *pos) {
uint16_t data = 0xFF;
uint16_t eeprom_address = (unsigned)pos;
eeprom_init(); eeprom_init();
if (EE_ReadVariable(eeprom_address, &data) != EE_OK) { uint16_t data = 0xFF;
return (unsigned char)data; uint16_t eeprom_address = unsigned(pos);
} (void)EE_ReadVariable(eeprom_address, &data); // Data unchanged on error
return (unsigned char)data;
return uint8_t(data);
} }
void eeprom_read_block(void *__dst, const void *__src, size_t __n) { void eeprom_read_block(void *__dst, const void *__src, size_t __n) {
uint16_t data = 0xFF;
uint16_t eeprom_address = (unsigned) __src;
eeprom_init(); eeprom_init();
uint16_t data = 0xFF;
uint16_t eeprom_address = (unsigned)__src;
for (uint8_t c = 0; c < __n; c++) { for (uint8_t c = 0; c < __n; c++) {
EE_ReadVariable(eeprom_address+c, &data); EE_ReadVariable(eeprom_address+c, &data);
*((uint8_t*)__dst + c) = data; *((uint8_t*)__dst + c) = data;

188
Marlin/src/HAL/HAL_STM32F7/EEPROM_Emul/eeprom_emul.cpp
Unescape Escape View File

@ -8,8 +8,8 @@
****************************************************************************** ******************************************************************************
* @attention * @attention
* *
* <h2><center>&copy; Copyright © 2016 STMicroelectronics International N.V. * Copyright © 2016 STMicroelectronics International N.V.
* All rights reserved.</center></h2> * All rights reserved.
* *
* Redistribution and use in source and binary forms, with or without * Redistribution and use in source and binary forms, with or without
* modification, are permitted, provided that the following conditions are met: * modification, are permitted, provided that the following conditions are met:
@ -52,9 +52,6 @@
/* Includes ------------------------------------------------------------------*/ /* Includes ------------------------------------------------------------------*/
#include "eeprom_emul.h" #include "eeprom_emul.h"
/* Private typedef -----------------------------------------------------------*/
/* Private define ------------------------------------------------------------*/
/* Private macro -------------------------------------------------------------*/
/* Private variables ---------------------------------------------------------*/ /* Private variables ---------------------------------------------------------*/
/* Global variable used to store variable value in read sequence */ /* Global variable used to store variable value in read sequence */
@ -79,76 +76,66 @@ static uint16_t EE_VerifyPageFullyErased(uint32_t Address);
* - FLASH_COMPLETE: on success * - FLASH_COMPLETE: on success
*/ */
uint16_t EE_Initialize(void) { uint16_t EE_Initialize(void) {
uint16_t PageStatus0 = 6, PageStatus1 = 6; /* Get Page0 and Page1 status */
uint16_t VarIdx = 0; uint16_t PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS),
uint16_t EepromStatus = 0, ReadStatus = 0;
int16_t x = -1;
HAL_StatusTypeDef FlashStatus;
uint32_t SectorError = 0;
FLASH_EraseInitTypeDef pEraseInit;
/* Get Page0 status */
PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS);
/* Get Page1 status */
PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS); PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS);
FLASH_EraseInitTypeDef pEraseInit;
pEraseInit.TypeErase = TYPEERASE_SECTORS; pEraseInit.TypeErase = TYPEERASE_SECTORS;
pEraseInit.Sector = PAGE0_ID; pEraseInit.Sector = PAGE0_ID;
pEraseInit.NbSectors = 1; pEraseInit.NbSectors = 1;
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Check for invalid header states and repair if necessary */ /* Check for invalid header states and repair if necessary */
uint32_t SectorError;
switch (PageStatus0) { switch (PageStatus0) {
case ERASED: case ERASED:
if (PageStatus1 == VALID_PAGE) { /* Page0 erased, Page1 valid */ if (PageStatus1 == VALID_PAGE) { /* Page0 erased, Page1 valid */
/* Erase Page0 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, simply return the result */
/* If erase operation was failed, a Flash error code is returned */ return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
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 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); HAL_StatusTypeDef fStat = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* If erase operation was failed, a Flash error code is returned */
if (FlashStatus != HAL_OK) return FlashStatus; if (fStat != HAL_OK) return fStat;
} }
/* Mark Page1 as valid */ /* Mark Page1 as valid */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE1_BASE_ADDRESS, VALID_PAGE); /* As the last operation, simply return the result */
/* If program operation was failed, a Flash error code is returned */ return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE1_BASE_ADDRESS, VALID_PAGE);
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 */ /* Erase both Page0 and Page1 and set Page0 as valid page */
FlashStatus = EE_Format(); /* As the last operation, simply return the result */
/* If erase/program operation was failed, a Flash error code is returned */ return EE_Format();
if (FlashStatus != HAL_OK) return FlashStatus;
} }
break; break;
case RECEIVE_DATA: 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 */ /* Transfer data from Page1 to Page0 */
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { int16_t x = -1;
for (uint16_t VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) {
if (( *(__IO uint16_t*)(PAGE0_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx]) if (( *(__IO uint16_t*)(PAGE0_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx])
x = VarIdx; x = VarIdx;
if (VarIdx != x) { if (VarIdx != x) {
/* Read the last variables' updates */ /* Read the last variables' updates */
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); uint16_t ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar);
/* In case variable corresponding to the virtual address was found */ /* In case variable corresponding to the virtual address was found */
if (ReadStatus != 0x1) { if (ReadStatus != 0x1) {
/* Transfer the variable to the Page0 */ /* Transfer the variable to the Page0 */
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); uint16_t EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Mark Page0 as valid */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); HAL_StatusTypeDef FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE);
/* If program operation was failed, a Flash error code is returned */ /* 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.Sector = PAGE1_ID;
@ -156,9 +143,8 @@ uint16_t EE_Initialize(void) {
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase Page1 */ /* Erase Page1 */
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, simply return the result */
/* If erase operation was failed, a Flash error code is returned */ return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
if (FlashStatus != HAL_OK) return FlashStatus;
} }
} }
else if (PageStatus1 == ERASED) { /* Page0 receive, Page1 erased */ else if (PageStatus1 == ERASED) { /* Page0 receive, Page1 erased */
@ -167,20 +153,18 @@ uint16_t EE_Initialize(void) {
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase Page1 */ /* Erase Page1 */
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); HAL_StatusTypeDef fStat = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* If erase operation was failed, a Flash error code is returned */
if (FlashStatus != HAL_OK) return FlashStatus; if (fStat != HAL_OK) return fStat;
} }
/* Mark Page0 as valid */ /* Mark Page0 as valid */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE); /* As the last operation, simply return the result */
/* If program operation was failed, a Flash error code is returned */ return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, PAGE0_BASE_ADDRESS, VALID_PAGE);
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 */ /* Erase both Page0 and Page1 and set Page0 as valid page */
FlashStatus = EE_Format(); /* As the last operation, simply return the result */
/* If erase/program operation was failed, a Flash error code is returned */ return EE_Format();
if (FlashStatus != HAL_OK) return FlashStatus;
} }
break; break;
@ -204,17 +188,18 @@ uint16_t EE_Initialize(void) {
} }
else { /* Page0 valid, Page1 receive */ else { /* Page0 valid, Page1 receive */
/* Transfer data from Page0 to Page1 */ /* Transfer data from Page0 to Page1 */
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { int16_t x = -1;
for (uint16_t VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) {
if ((*(__IO uint16_t*)(PAGE1_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx]) if ((*(__IO uint16_t*)(PAGE1_BASE_ADDRESS + 6)) == VirtAddVarTab[VarIdx])
x = VarIdx; x = VarIdx;
if (VarIdx != x) { if (VarIdx != x) {
/* Read the last variables' updates */ /* Read the last variables' updates */
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); uint16_t ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar);
/* In case variable corresponding to the virtual address was found */ /* In case variable corresponding to the virtual address was found */
if (ReadStatus != 0x1) { if (ReadStatus != 0x1) {
/* Transfer the variable to the Page1 */ /* Transfer the variable to the Page1 */
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar); uint16_t EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddVarTab[VarIdx], DataVar);
/* If program operation was failed, a Flash error code is returned */ /* If program operation was failed, a Flash error code is returned */
if (EepromStatus != HAL_OK) return EepromStatus; if (EepromStatus != HAL_OK) return EepromStatus;
} }
@ -229,19 +214,16 @@ uint16_t EE_Initialize(void) {
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase Page0 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, simply return the result */
/* If erase operation was failed, a Flash error code is returned */ return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
if (FlashStatus != HAL_OK) return FlashStatus;
} }
} }
break; break;
default: /* Any other state -> format eeprom */ default: /* Any other state -> format eeprom */
/* Erase both Page0 and Page1 and set Page0 as valid page */ /* Erase both Page0 and Page1 and set Page0 as valid page */
FlashStatus = EE_Format(); /* As the last operation, simply return the result */
/* If erase/program operation was failed, a Flash error code is returned */ return EE_Format();
if (FlashStatus != HAL_OK) return FlashStatus;
break;
} }
return HAL_OK; return HAL_OK;
@ -259,11 +241,10 @@ uint16_t EE_Initialize(void) {
*/ */
uint16_t EE_VerifyPageFullyErased(uint32_t Address) { uint16_t EE_VerifyPageFullyErased(uint32_t Address) {
uint32_t ReadStatus = 1; uint32_t ReadStatus = 1;
uint16_t AddressValue = 0x5555;
/* Check each active page address starting from end */ /* 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 */ /* Get the current location content to be compared with virtual address */
AddressValue = (*(__IO uint16_t*)Address); uint16_t AddressValue = (*(__IO uint16_t*)Address);
/* Compare the read address with the virtual address */ /* Compare the read address with the virtual address */
if (AddressValue != ERASED) { if (AddressValue != ERASED) {
/* In case variable value is read, reset ReadStatus flag */ /* In case variable value is read, reset ReadStatus flag */
@ -288,26 +269,22 @@ uint16_t EE_VerifyPageFullyErased(uint32_t Address) {
* - NO_VALID_PAGE: if no valid page was 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 ReadStatus = 1;
uint16_t AddressValue = 0x5555, ReadStatus = 1;
uint32_t Address = EEPROM_START_ADDRESS, PageStartAddress = EEPROM_START_ADDRESS;
/* Get active Page for read operation */ /* Get active Page for read operation */
ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE); uint16_t ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE);
/* Check if there is no 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 */ /* Get the valid Page start and end Addresses */
PageStartAddress = (uint32_t)(EEPROM_START_ADDRESS + (uint32_t)(ValidPage * PAGE_SIZE)); uint32_t PageStartAddress = uint32_t(EEPROM_START_ADDRESS) + uint32_t(ValidPage * (PAGE_SIZE)),
Address = PageStartAddress + PAGE_SIZE - 2;
/* Get the valid Page end Address */
Address = (uint32_t)((EEPROM_START_ADDRESS - 2) + (uint32_t)((1 + ValidPage) * PAGE_SIZE));
/* Check each active page address starting from end */ /* 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 */ /* Get the current location content to be compared with virtual address */
AddressValue = (*(__IO uint16_t*)Address); uint16_t AddressValue = (*(__IO uint16_t*)Address);
/* Compare the read address with the virtual address */ /* Compare the read address with the virtual address */
if (AddressValue == VirtAddress) { if (AddressValue == VirtAddress) {
@ -353,16 +330,17 @@ uint16_t EE_WriteVariable(uint16_t VirtAddress, uint16_t Data) {
* EEPROM formating * 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; FLASH_EraseInitTypeDef pEraseInit;
pEraseInit.TypeErase = FLASH_TYPEERASE_SECTORS; pEraseInit.TypeErase = FLASH_TYPEERASE_SECTORS;
pEraseInit.Sector = PAGE0_ID; pEraseInit.Sector = PAGE0_ID;
pEraseInit.NbSectors = 1; pEraseInit.NbSectors = 1;
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
HAL_StatusTypeDef FlashStatus; // = HAL_OK
/* Erase Page0 */ /* Erase Page0 */
if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE0_BASE_ADDRESS)) {
uint32_t SectorError;
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* If erase operation was failed, a Flash error code is returned */
if (FlashStatus != HAL_OK) return FlashStatus; if (FlashStatus != HAL_OK) return FlashStatus;
@ -375,9 +353,9 @@ static HAL_StatusTypeDef EE_Format(void) {
pEraseInit.Sector = PAGE1_ID; pEraseInit.Sector = PAGE1_ID;
/* Erase Page1 */ /* Erase Page1 */
if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) { if (!EE_VerifyPageFullyErased(PAGE1_BASE_ADDRESS)) {
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); /* As the last operation, just return the result code */
/* If erase operation was failed, a Flash error code is returned */ uint32_t SectorError;
if (FlashStatus != HAL_OK) return FlashStatus; return HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
} }
return HAL_OK; return HAL_OK;
@ -393,12 +371,8 @@ static HAL_StatusTypeDef EE_Format(void) {
* of no valid page was found * 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 and Page1 actual status */
uint16_t PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS),
/* Get Page0 actual status */
PageStatus0 = (*(__IO uint16_t*)PAGE0_BASE_ADDRESS);
/* Get Page1 actual status */
PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS); PageStatus1 = (*(__IO uint16_t*)PAGE1_BASE_ADDRESS);
/* Write or read operation */ /* Write or read operation */
@ -406,13 +380,11 @@ static uint16_t EE_FindValidPage(uint8_t Operation) {
case WRITE_IN_VALID_PAGE: /* ---- Write operation ---- */ case WRITE_IN_VALID_PAGE: /* ---- Write operation ---- */
if (PageStatus1 == VALID_PAGE) { if (PageStatus1 == VALID_PAGE) {
/* Page0 receiving data */ /* Page0 receiving data */
if (PageStatus0 == RECEIVE_DATA) return PAGE0; /* Page0 valid */ return (PageStatus0 == RECEIVE_DATA) ? PAGE0 : PAGE1;
else return PAGE1; /* Page1 valid */
} }
else if (PageStatus0 == VALID_PAGE) { else if (PageStatus0 == VALID_PAGE) {
/* Page1 receiving data */ /* Page1 receiving data */
if (PageStatus1 == RECEIVE_DATA) return PAGE1; /* Page1 valid */ return (PageStatus1 == RECEIVE_DATA) ? PAGE1 : PAGE0;
else return PAGE0; /* Page0 valid */
} }
else else
return NO_VALID_PAGE; /* No valid Page */ return NO_VALID_PAGE; /* No valid Page */
@ -441,34 +413,26 @@ static uint16_t EE_FindValidPage(uint8_t Operation) {
* - Flash error code: on write Flash error * - 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;
/* Get valid Page for write operation */ /* Get valid Page for write operation */
ValidPage = EE_FindValidPage(WRITE_IN_VALID_PAGE); uint16_t ValidPage = EE_FindValidPage(WRITE_IN_VALID_PAGE);
/* Check if there is no 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 */ /* Get the valid Page start and end Addresses */
Address = (uint32_t)(EEPROM_START_ADDRESS + (uint32_t)(ValidPage * PAGE_SIZE)); uint32_t Address = uint32_t(EEPROM_START_ADDRESS) + uint32_t(ValidPage * (PAGE_SIZE)),
PageEndAddress = Address + PAGE_SIZE - 1;
/* Get the valid Page end Address */
PageEndAddress = (uint32_t)((EEPROM_START_ADDRESS - 1) + (uint32_t)((ValidPage + 1) * PAGE_SIZE));
/* Check each active page address starting from begining */ /* Check each active page address starting from begining */
while (Address < PageEndAddress) { while (Address < PageEndAddress) {
/* Verify if Address and Address+2 contents are 0xFFFFFFFF */ /* Verify if Address and Address+2 contents are 0xFFFFFFFF */
if ((*(__IO uint32_t*)Address) == 0xFFFFFFFF) { if ((*(__IO uint32_t*)Address) == 0xFFFFFFFF) {
/* Set variable data */ /* Set variable data */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address, Data); HAL_StatusTypeDef FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address, Data);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Set variable virtual address, return status */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address + 2, VirtAddress); return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, Address + 2, VirtAddress);
/* Return program operation status */
return FlashStatus;
} }
else /* Next address location */ else /* Next address location */
Address += 4; Address += 4;
@ -490,16 +454,10 @@ static uint16_t EE_VerifyPageFullWriteVariable(uint16_t VirtAddress, uint16_t Da
* - Flash error code: on write Flash error * - 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;
uint16_t ValidPage = PAGE0, VarIdx = 0;
uint16_t EepromStatus = 0, ReadStatus = 0;
uint32_t SectorError = 0;
FLASH_EraseInitTypeDef pEraseInit;
/* Get active Page for read operation */ /* Get active Page for read operation */
ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE); uint16_t ValidPage = EE_FindValidPage(READ_FROM_VALID_PAGE);
uint32_t NewPageAddress = EEPROM_START_ADDRESS;
uint16_t OldPageId = 0;
if (ValidPage == PAGE1) { /* Page1 valid */ if (ValidPage == PAGE1) { /* Page1 valid */
/* New page address where variable will be moved to */ /* New page address where variable will be moved to */
@ -517,20 +475,20 @@ static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) {
return NO_VALID_PAGE; /* No valid Page */ return NO_VALID_PAGE; /* No valid Page */
/* Set the new Page status to RECEIVE_DATA status */ /* Set the new Page status to RECEIVE_DATA status */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, RECEIVE_DATA); HAL_StatusTypeDef FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, RECEIVE_DATA);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Write the variable passed as parameter in the new active page */
EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddress, Data); uint16_t EepromStatus = EE_VerifyPageFullWriteVariable(VirtAddress, Data);
/* If program operation was failed, a Flash error code is returned */ /* 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 */ /* Transfer process: transfer variables from old to the new active page */
for (VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) { for (uint16_t VarIdx = 0; VarIdx < NB_OF_VAR; VarIdx++) {
if (VirtAddVarTab[VarIdx] != VirtAddress) { /* Check each variable except the one passed as parameter */ if (VirtAddVarTab[VarIdx] != VirtAddress) { /* Check each variable except the one passed as parameter */
/* Read the other last variable updates */ /* Read the other last variable updates */
ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar); uint16_t ReadStatus = EE_ReadVariable(VirtAddVarTab[VarIdx], &DataVar);
/* In case variable corresponding to the virtual address was found */ /* In case variable corresponding to the virtual address was found */
if (ReadStatus != 0x1) { if (ReadStatus != 0x1) {
/* Transfer the variable to the new active page */ /* Transfer the variable to the new active page */
@ -541,23 +499,21 @@ static uint16_t EE_PageTransfer(uint16_t VirtAddress, uint16_t Data) {
} }
} }
FLASH_EraseInitTypeDef pEraseInit;
pEraseInit.TypeErase = TYPEERASE_SECTORS; pEraseInit.TypeErase = TYPEERASE_SECTORS;
pEraseInit.Sector = OldPageId; pEraseInit.Sector = OldPageId;
pEraseInit.NbSectors = 1; pEraseInit.NbSectors = 1;
pEraseInit.VoltageRange = VOLTAGE_RANGE; pEraseInit.VoltageRange = VOLTAGE_RANGE;
/* Erase the old Page: Set old Page status to ERASED status */ /* Erase the old Page: Set old Page status to ERASED status */
uint32_t SectorError;
FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError); FlashStatus = HAL_FLASHEx_Erase(&pEraseInit, &SectorError);
/* If erase operation was failed, a Flash error code is returned */ /* 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 */ /* Set new Page status to VALID_PAGE status */
FlashStatus = HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, VALID_PAGE); /* As the last operation, just return the result code */
/* If program operation was failed, a Flash error code is returned */ return HAL_FLASH_Program(TYPEPROGRAM_HALFWORD, NewPageAddress, VALID_PAGE);
if (FlashStatus != HAL_OK) return FlashStatus;
/* Return last operation flash status */
return FlashStatus;
} }
#endif // STM32F7 #endif // STM32F7

44
Marlin/src/HAL/HAL_STM32F7/EEPROM_Emul/eeprom_emul.h
Unescape Escape View File

@ -53,56 +53,54 @@
/* Exported constants --------------------------------------------------------*/ /* Exported constants --------------------------------------------------------*/
/* EEPROM emulation firmware error codes */ /* EEPROM emulation firmware error codes */
#define EE_OK (uint32_t)HAL_OK #define EE_OK uint32_t(HAL_OK)
#define EE_ERROR (uint32_t)HAL_ERROR #define EE_ERROR uint32_t(HAL_ERROR)
#define EE_BUSY (uint32_t)HAL_BUSY #define EE_BUSY uint32_t(HAL_BUSY)
#define EE_TIMEOUT (uint32_t)HAL_TIMEOUT #define EE_TIMEOUT uint32_t(HAL_TIMEOUT)
/* Define the size of the sectors to be used */ /* Define the size of the sectors to be used */
#define PAGE_SIZE (uint32_t)0x4000 /* Page size = 16KByte */ #define PAGE_SIZE uint32_t(0x4000) /* Page size = 16KByte */
/* Device voltage range supposed to be [2.7V to 3.6V], the operation will /* Device voltage range supposed to be [2.7V to 3.6V], the operation will
be done by word */ be done by word */
#define VOLTAGE_RANGE (uint8_t)VOLTAGE_RANGE_3 #define VOLTAGE_RANGE uint8_t(VOLTAGE_RANGE_3)
/* EEPROM start address in Flash */ /* EEPROM start address in Flash */
#define EEPROM_START_ADDRESS ((uint32_t)0x08100000) /* EEPROM emulation start address: #define EEPROM_START_ADDRESS uint32_t(0x08100000) /* EEPROM emulation start address:
from sector2 : after 16KByte of used from sector2 : after 16KByte of used
Flash memory */ Flash memory */
/* Pages 0 and 1 base and end addresses */ /* Pages 0 and 1 base and end addresses */
#define PAGE0_BASE_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + 0x0000)) #define PAGE0_BASE_ADDRESS uint32_t(EEPROM_START_ADDRESS + 0x0000)
#define PAGE0_END_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + (PAGE_SIZE - 1))) #define PAGE0_END_ADDRESS uint32_t(EEPROM_START_ADDRESS + PAGE_SIZE - 1)
#define PAGE0_ID FLASH_SECTOR_1 #define PAGE0_ID FLASH_SECTOR_1
#define PAGE1_BASE_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + 0x4000)) #define PAGE1_BASE_ADDRESS uint32_t(EEPROM_START_ADDRESS + 0x4000)
#define PAGE1_END_ADDRESS ((uint32_t)(EEPROM_START_ADDRESS + (2 * PAGE_SIZE - 1))) #define PAGE1_END_ADDRESS uint32_t(EEPROM_START_ADDRESS + 2 * (PAGE_SIZE) - 1)
#define PAGE1_ID FLASH_SECTOR_2 #define PAGE1_ID FLASH_SECTOR_2
/* Used Flash pages for EEPROM emulation */ /* Used Flash pages for EEPROM emulation */
#define PAGE0 ((uint16_t)0x0000) #define PAGE0 uint16_t(0x0000)
#define PAGE1 ((uint16_t)0x0001) /* Page nb between PAGE0_BASE_ADDRESS & PAGE1_BASE_ADDRESS*/ #define PAGE1 uint16_t(0x0001) /* Page nb between PAGE0_BASE_ADDRESS & PAGE1_BASE_ADDRESS*/
/* No valid page define */ /* No valid page define */
#define NO_VALID_PAGE ((uint16_t)0x00AB) #define NO_VALID_PAGE uint16_t(0x00AB)
/* Page status definitions */ /* Page status definitions */
#define ERASED ((uint16_t)0xFFFF) /* Page is empty */ #define ERASED uint16_t(0xFFFF) /* Page is empty */
#define RECEIVE_DATA ((uint16_t)0xEEEE) /* Page is marked to receive data */ #define RECEIVE_DATA uint16_t(0xEEEE) /* Page is marked to receive data */
#define VALID_PAGE ((uint16_t)0x0000) /* Page containing valid data */ #define VALID_PAGE uint16_t(0x0000) /* Page containing valid data */
/* Valid pages in read and write defines */ /* Valid pages in read and write defines */
#define READ_FROM_VALID_PAGE ((uint8_t)0x00) #define READ_FROM_VALID_PAGE uint8_t(0x00)
#define WRITE_IN_VALID_PAGE ((uint8_t)0x01) #define WRITE_IN_VALID_PAGE uint8_t(0x01)
/* Page full define */ /* Page full define */
#define PAGE_FULL ((uint8_t)0x80) #define PAGE_FULL uint8_t(0x80)
/* Variables' number */ /* Variables' number */
#define NB_OF_VAR ((uint16_t)4096) #define NB_OF_VAR uint16_t(4096)
/* Exported types ------------------------------------------------------------*/
/* Exported macro ------------------------------------------------------------*/
/* Exported functions ------------------------------------------------------- */ /* Exported functions ------------------------------------------------------- */
uint16_t EE_Initialize(void); uint16_t EE_Initialize(void);
uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data); uint16_t EE_ReadVariable(uint16_t VirtAddress, uint16_t* Data);

20
Marlin/src/HAL/HAL_STM32F7/EmulatedEeprom.cpp
Unescape Escape View File

@ -20,7 +20,7 @@
#ifdef STM32F7 #ifdef STM32F7
/** /**
* Description: functions for I2C connected external EEPROM. * Description: Functions for a Flash emulated EEPROM
* Not platform dependent. * Not platform dependent.
*/ */
@ -67,34 +67,32 @@ void eeprom_init() {
} }
void eeprom_write_byte(uint8_t *pos, unsigned char value) { void eeprom_write_byte(uint8_t *pos, unsigned char value) {
uint16_t eeprom_address = (unsigned) pos; uint16_t eeprom_address = unsigned(pos);
eeprom_init(); eeprom_init();
HAL_FLASH_Unlock(); HAL_FLASH_Unlock();
__HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_EOP | FLASH_FLAG_OPERR | FLASH_FLAG_WRPERR |FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR); __HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_EOP | FLASH_FLAG_OPERR | FLASH_FLAG_WRPERR |FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR | FLASH_FLAG_PGSERR);
if (EE_WriteVariable(eeprom_address, (uint16_t) value) != EE_OK) if (EE_WriteVariable(eeprom_address, uint16_t(value)) != EE_OK)
for (;;) HAL_Delay(1); // Spin forever until watchdog reset for (;;) HAL_Delay(1); // Spin forever until watchdog reset
HAL_FLASH_Lock(); HAL_FLASH_Lock();
} }
uint8_t eeprom_read_byte(uint8_t *pos) { uint8_t eeprom_read_byte(uint8_t *pos) {
uint16_t data = 0xFF;
uint16_t eeprom_address = (unsigned)pos;
eeprom_init(); eeprom_init();
if (EE_ReadVariable(eeprom_address, &data) != EE_OK) { uint16_t data = 0xFF;
return (unsigned char)data; uint16_t eeprom_address = unsigned(pos);
} (void)EE_ReadVariable(eeprom_address, &data); // Data unchanged on error
return (unsigned char)data;
return uint8_t(data);
} }
void eeprom_read_block(void *__dst, const void *__src, size_t __n) { void eeprom_read_block(void *__dst, const void *__src, size_t __n) {
uint16_t data = 0xFF; uint16_t data = 0xFF;
uint16_t eeprom_address = (unsigned) __src; uint16_t eeprom_address = unsigned(__src);
eeprom_init(); eeprom_init();

3
Marlin/src/HAL/shared/I2cEeprom.cpp
Unescape Escape View File

@ -95,7 +95,6 @@ void eeprom_update_block(const void *pos, void* eeprom_address, size_t n) {
} }
} }
uint8_t eeprom_read_byte(uint8_t *pos) { uint8_t eeprom_read_byte(uint8_t *pos) {
unsigned eeprom_address = (unsigned)pos; unsigned eeprom_address = (unsigned)pos;
@ -109,7 +108,7 @@ uint8_t eeprom_read_byte(uint8_t *pos) {
return Wire.available() ? Wire.read() : 0xFF; return Wire.available() ? Wire.read() : 0xFF;
} }
// maybe let's not read more than 30 or 32 bytes at a time! // Don't read more than 30..32 bytes at a time!
void eeprom_read_block(void* pos, const void* eeprom_address, size_t n) { void eeprom_read_block(void* pos, const void* eeprom_address, size_t n) {
eeprom_init(); eeprom_init();

Write Preview
Loading…
Cancel
Save