flash: reduce code duplication in stm32 flash probe
Remove a lot of the repetitive code in stm32f1x flash probe by converting the large if-selector to a switch, moving the common checks outside it and concentrating the failure handling to a single point. Do the same with stm32f2x and stm32lx for consistency. Change-Id: Ic0ecfb1533c49f5d2108cda5fd20c8372d7c71ef Signed-off-by: Andreas Fritiofson <andreas.fritiofson@gmail.com> Reviewed-on: http://openocd.zylin.com/746 Tested-by: jenkins Reviewed-by: Spencer Oliver <spen@spen-soft.co.uk> Reviewed-by: Freddie Chopin <freddie.chopin@gmail.com>
This commit is contained in:
committed by
Freddie Chopin
parent
38e44d1361
commit
9a8edbfa8b
@@ -463,6 +463,7 @@ static int stm32lx_probe(struct flash_bank *bank)
|
||||
struct stm32lx_flash_bank *stm32lx_info = bank->driver_priv;
|
||||
int i;
|
||||
uint16_t flash_size_in_kb;
|
||||
uint16_t max_flash_size_in_kb;
|
||||
uint32_t device_id;
|
||||
|
||||
stm32lx_info->probed = 0;
|
||||
@@ -474,38 +475,30 @@ static int stm32lx_probe(struct flash_bank *bank)
|
||||
|
||||
LOG_DEBUG("device id = 0x%08" PRIx32 "", device_id);
|
||||
|
||||
/* get flash size from target. */
|
||||
retval = target_read_u16(target, F_SIZE, &flash_size_in_kb);
|
||||
if (retval != ERROR_OK) {
|
||||
LOG_WARNING("failed reading flash size, default to max target family");
|
||||
/* failed reading flash size, default to max target family */
|
||||
flash_size_in_kb = 0xffff;
|
||||
}
|
||||
|
||||
/* some variants read 0 for flash size register
|
||||
* use a max flash size as a default */
|
||||
if (flash_size_in_kb == 0)
|
||||
flash_size_in_kb = 0xffff;
|
||||
|
||||
if ((device_id & 0xfff) == 0x416) {
|
||||
/* check for early silicon */
|
||||
if (flash_size_in_kb == 0xffff) {
|
||||
/* number of sectors may be incorrect on early silicon */
|
||||
LOG_WARNING("STM32 flash size failed, probe inaccurate - assuming 128k flash");
|
||||
flash_size_in_kb = 128;
|
||||
}
|
||||
} else if ((device_id & 0xfff) == 0x436) {
|
||||
/* check for early silicon */
|
||||
if (flash_size_in_kb == 0xffff) {
|
||||
/* number of sectors may be incorrect on early silicon */
|
||||
LOG_WARNING("STM32 flash size failed, probe inaccurate - assuming 384k flash");
|
||||
flash_size_in_kb = 384;
|
||||
}
|
||||
} else {
|
||||
/* set max flash size depending on family */
|
||||
switch (device_id & 0xfff) {
|
||||
case 0x416:
|
||||
max_flash_size_in_kb = 128;
|
||||
break;
|
||||
case 0x436:
|
||||
max_flash_size_in_kb = 384;
|
||||
break;
|
||||
default:
|
||||
LOG_WARNING("Cannot identify target as a STM32L family.");
|
||||
return ERROR_FAIL;
|
||||
}
|
||||
|
||||
/* get flash size from target. */
|
||||
retval = target_read_u16(target, F_SIZE, &flash_size_in_kb);
|
||||
|
||||
/* failed reading flash size or flash size invalid (early silicon),
|
||||
* default to max target family */
|
||||
if (retval != ERROR_OK || flash_size_in_kb == 0xffff || flash_size_in_kb == 0) {
|
||||
LOG_WARNING("STM32 flash size failed, probe inaccurate - assuming %dk flash",
|
||||
max_flash_size_in_kb);
|
||||
flash_size_in_kb = max_flash_size_in_kb;
|
||||
}
|
||||
|
||||
/* STM32L - we have 32 sectors, 16 pages per sector -> 512 pages
|
||||
* 16 pages for a protection area */
|
||||
|
||||
|
||||
Reference in New Issue
Block a user