diff options
| -rw-r--r-- | src/stm/ao_eeprom_stm.c | 24 |
1 files changed, 18 insertions, 6 deletions
diff --git a/src/stm/ao_eeprom_stm.c b/src/stm/ao_eeprom_stm.c index 1e51b417..5a75a97d 100644 --- a/src/stm/ao_eeprom_stm.c +++ b/src/stm/ao_eeprom_stm.c @@ -83,18 +83,29 @@ ao_intflash_lock(void) } static void +ao_intflash_wait(void) +{ + /* Wait for the flash unit to go idle */ + while (stm_flash.sr & (1 << STM_FLASH_SR_BSY)) + ; +} + +static void ao_intflash_write32(uint16_t pos, uint32_t w) { - uint32_t *addr; + volatile uint32_t *addr; addr = (uint32_t *) (stm_eeprom + pos); - /* Write a word to a valid address in the data EEPROM */ - *addr = w; + /* Erase previous word */ + *addr = 0; + ao_intflash_wait(); - /* Wait for the flash unit to go idle */ - while (stm_flash.sr & (1 << STM_FLASH_SR_BSY)) - ; + if (w) { + /* Write a word to a valid address in the data EEPROM */ + *addr = w; + ao_intflash_wait(); + } } static void @@ -182,6 +193,7 @@ ao_storage_setup(void) void ao_storage_device_info(void) __reentrant { + uint8_t i; printf ("Using internal flash\n"); } |