Author: Raúl Sánchez Siles <rsanchezs@infoglobal.es>

[fw/openocd] / src / flash / cfi.c

diff --git a/src/flash/cfi.c b/src/flash/cfi.c
index dca9bef556e1869dc4b4bc7615fe70ba009e7d3a..6e8b96e5cf46854c848cc68082268b48bd096fe9 100644 (file)
--- a/src/flash/cfi.c
+++ b/src/flash/cfi.c
@@ -114,9 +114,11 @@ static __inline__ u32 flash_address(flash_bank_t *bank, int sector, u32 offset)
 {
        cfi_flash_bank_t *cfi_info = bank->driver_priv;
 
+       if(cfi_info->x16_as_x8) offset*=2;
+
        /* while the sector list isn't built, only accesses to sector 0 work */
        if (sector == 0)
-               return bank->base + (offset * bank->bus_width << cfi_info->x16_as_x8 );
+               return bank->base + offset * bank->bus_width;
        else
        {
                if (!bank->sectors)
@@ -124,7 +126,7 @@ static __inline__ u32 flash_address(flash_bank_t *bank, int sector, u32 offset)
                        LOG_ERROR("BUG: sector list not yet built");
                        exit(-1);
                }
-               return bank->base + bank->sectors[sector].offset + (offset * bank->bus_width << cfi_info->x16_as_x8 );
+               return bank->base + bank->sectors[sector].offset + offset * bank->bus_width;
        }
 
 }