aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_HAL_ChibiOS: add flash ecc corrupt method

Browse Source
This commit is contained in:
bugobliterator 2024-06-26 18:25:26 +10:00 committed by Andrew Tridgell
parent ceea189fa3
commit d466618b11
2 changed files with 62 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

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

@ -452,6 +452,65 @@ bool stm32_flash_ispageerased(uint32_t page)
static uint32_t last_erase_ms;
#endif
#if defined(STM32H7)
/*
corrupt a flash to trigger ECC fault
*/
void stm32_flash_corrupt(uint32_t addr)
{
stm32_flash_unlock();
volatile uint32_t *CR = &FLASH->CR1;
volatile uint32_t *CCR = &FLASH->CCR1;
volatile uint32_t *SR = &FLASH->SR1;
#if STM32_FLASH_NBANKS > 1
if (addr - STM32_FLASH_BASE >= STM32_FLASH_FIXED_PAGE_PER_BANK * STM32_FLASH_FIXED_PAGE_SIZE * 1024) {
CR = &FLASH->CR2;
CCR = &FLASH->CCR2;
SR = &FLASH->SR2;
}
#endif
stm32_flash_wait_idle();
*CCR = ~0;
*CR |= FLASH_CR_PG;
for (uint32_t i=0; i<2; i++) {
while (*SR & (FLASH_SR_BSY|FLASH_SR_QW)) ;
putreg32(0xAAAA5555, addr);
if (*SR & FLASH_SR_INCERR) {
// clear the error
*SR &= ~FLASH_SR_INCERR;
}
addr += 4;
}
*CR |= FLASH_CR_FW; // force write
stm32_flash_wait_idle();
for (uint32_t i=0; i<2; i++) {
while (*SR & (FLASH_SR_BSY|FLASH_SR_QW)) ;
putreg32(0x5555AAAA, addr);
if (*SR & FLASH_SR_INCERR) {
// clear the error
*SR &= ~FLASH_SR_INCERR;
}
addr += 4;
}
*CR |= FLASH_CR_FW; // force write
stm32_flash_wait_idle();
__DSB();
stm32_flash_wait_idle();
*CCR = ~0;
*CR &= ~FLASH_CR_PG;
stm32_flash_lock();
}
#endif
/*
erase a page
*/

3
libraries/AP_HAL_ChibiOS/hwdef/common/flash.h
View File

@ -30,6 +30,9 @@ bool stm32_flash_ispageerased(uint32_t page);
void stm32_flash_protect_flash(bool bootloader, bool protect);
void stm32_flash_unprotect_flash(void);
void stm32_flash_set_NRST_MODE(uint8_t nrst_mode);
#if defined(STM32H7)
void stm32_flash_corrupt(uint32_t addr);
#endif
#ifndef HAL_BOOTLOADER_BUILD
bool stm32_flash_recent_erase(void);
#endif