diff options
author | Paul Fertser <fercerpav@gmail.com> | 2015-01-23 12:40:58 +0300 |
---|---|---|
committer | Spencer Oliver <spen@spen-soft.co.uk> | 2015-02-04 22:02:28 +0000 |
commit | f34098953a18eb4b63fc16e190d416b0148e84a7 (patch) | |
tree | 8e961dea068e6869340d6f66f39df6be4f3a2d0e /src/flash/nor | |
parent | cd72808889e426d15c07949c8fcea50dc40fe393 (diff) |
flash/nor/stm32l: unify waiting for busy flag functions
Change-Id: I5e6daff8232bb4807dd13a1951fbf335529661d4
Signed-off-by: Paul Fertser <fercerpav@gmail.com>
Reviewed-on: http://openocd.zylin.com/2491
Tested-by: jenkins
Reviewed-by: Spencer Oliver <spen@spen-soft.co.uk>
Diffstat (limited to 'src/flash/nor')
-rw-r--r-- | src/flash/nor/stm32lx.c | 50 |
1 files changed, 11 insertions, 39 deletions
diff --git a/src/flash/nor/stm32lx.c b/src/flash/nor/stm32lx.c index 13db7b92..6858d5af 100644 --- a/src/flash/nor/stm32lx.c +++ b/src/flash/nor/stm32lx.c @@ -104,7 +104,7 @@ static int stm32lx_enable_write_half_page(struct flash_bank *bank); static int stm32lx_erase_sector(struct flash_bank *bank, int sector); static int stm32lx_wait_until_bsy_clear(struct flash_bank *bank); static int stm32lx_mass_erase(struct flash_bank *bank); -static int stm32lx_wait_status_busy(struct flash_bank *bank, int timeout); +static int stm32lx_wait_until_bsy_clear_timeout(struct flash_bank *bank, int timeout); struct stm32lx_rev { uint16_t rev; @@ -1105,38 +1105,7 @@ static inline int stm32lx_get_flash_status(struct flash_bank *bank, uint32_t *st static int stm32lx_wait_until_bsy_clear(struct flash_bank *bank) { - struct target *target = bank->target; - struct stm32lx_flash_bank *stm32lx_info = bank->driver_priv; - uint32_t status; - int retval = ERROR_OK; - int timeout = 100; - - /* wait for busy to clear */ - for (;;) { - retval = target_read_u32(target, stm32lx_info->flash_base + FLASH_SR, &status); - if (retval != ERROR_OK) - return retval; - - if ((status & FLASH_SR__BSY) == 0) - break; - if (timeout-- <= 0) { - LOG_ERROR("timed out waiting for flash"); - return ERROR_FAIL; - } - alive_sleep(1); - } - - if (status & FLASH_SR__WRPERR) { - LOG_ERROR("access denied / write protected"); - retval = ERROR_FAIL; - } - - if (status & FLASH_SR__PGAERR) { - LOG_ERROR("invalid program address"); - retval = ERROR_FAIL; - } - - return retval; + return stm32lx_wait_until_bsy_clear_timeout(bank, 100); } static int stm32lx_unlock_options_bytes(struct flash_bank *bank) @@ -1182,17 +1151,15 @@ static int stm32lx_unlock_options_bytes(struct flash_bank *bank) return ERROR_OK; } -static int stm32lx_wait_status_busy(struct flash_bank *bank, int timeout) +static int stm32lx_wait_until_bsy_clear_timeout(struct flash_bank *bank, int timeout) { struct target *target = bank->target; + struct stm32lx_flash_bank *stm32lx_info = bank->driver_priv; uint32_t status; - int retval = ERROR_OK; - struct stm32lx_flash_bank *stm32lx_info = bank->driver_priv; /* wait for busy to clear */ for (;;) { - retval = stm32lx_get_flash_status(bank, &status); if (retval != ERROR_OK) return retval; @@ -1209,7 +1176,12 @@ static int stm32lx_wait_status_busy(struct flash_bank *bank, int timeout) } if (status & FLASH_SR__WRPERR) { - LOG_ERROR("stm32lx device protected"); + LOG_ERROR("access denied / write protected"); + retval = ERROR_FAIL; + } + + if (status & FLASH_SR__PGAERR) { + LOG_ERROR("invalid program address"); retval = ERROR_FAIL; } @@ -1279,7 +1251,7 @@ static int stm32lx_mass_erase(struct flash_bank *bank) if (retval != ERROR_OK) return retval; - retval = stm32lx_wait_status_busy(bank, 30000); + retval = stm32lx_wait_until_bsy_clear_timeout(bank, 30000); if (retval != ERROR_OK) return retval; |