Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_ChibiOS: never write bytes that have not been erased on H7 

Be more careful about flash failure conditions on H7
This commit is contained in:
Andy Piper 2021-01-25 21:11:10 +00:00 committed by Andrew Tridgell
parent 78735a946e
commit 2823fa7245
1 changed files with 29 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

40
libraries/AP_HAL_ChibiOS/hwdef/common/flash.c
View File

@ -422,6 +422,19 @@ bool stm32_flash_erasepage(uint32_t page)
#if defined(STM32H7)
// Check that the flash line is erased as writing to an un-erased line causes flash corruption
static bool stm32h7_check_all_ones(uint32_t addr, uint32_t words)
{
for (uint32_t i = 0; i < words; i++) {
// check that the byte was erased
if (getreg32(addr) != 0xFFFFFFFF) {
return false;
}
addr += 4;
}
return true;
}
/*
the H7 needs special handling, and only writes 32 bytes at a time
*/
@ -438,12 +451,12 @@ static bool stm32h7_flash_write32(uint32_t addr, const void *buf)
SR = &FLASH->SR2;
}
stm32_flash_wait_idle();
*CCR = ~0;
*CR |= FLASH_CR_PG;
const uint32_t *v = (const uint32_t *)buf;
uint8_t i;
for (i=0; i<8; i++) {
for (uint8_t i=0; i<8; i++) {
while (*SR & (FLASH_SR_BSY|FLASH_SR_QW)) ;
putreg32(*v, addr);
v++;
@ -465,36 +478,41 @@ static bool stm32_flash_write_h7(uint32_t addr, const void *buf, uint32_t count)
return false;
}
// check for erasure
if (!stm32h7_check_all_ones(addr, count >> 2)) {
return false;
}
#if STM32_FLASH_DISABLE_ISR
syssts_t sts = chSysGetStatusAndLockX();
#endif
stm32_flash_unlock();
bool success = true;
while (count >= 32) {
if (memcmp((void*)addr, b, 32) != 0 &&
!stm32h7_flash_write32(addr, b)) {
if (!stm32h7_flash_write32(addr, b)) {
success = false;
goto failed;
}
// check contents
if (memcmp((void *)addr, b, 32) != 0) {
if (memcmp((void*)addr, b, 32) != 0) {
success = false;
goto failed;
}
addr += 32;
count -= 32;
b += 32;
}
stm32_flash_lock();
#if STM32_FLASH_DISABLE_ISR
chSysRestoreStatusX(sts);
#endif
return true;
failed:
stm32_flash_lock();
#if STM32_FLASH_DISABLE_ISR
chSysRestoreStatusX(sts);
#endif
return false;
return success;
}
#endif // STM32H7