imi415
/
openocd
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

AT91SAM4L: Fix bug when writing to flash at a non-zero offset, add debug 

output for flash page writes

The offset wasn't being considered in the "full page" write codepath, so any
writes at an offset were actually written out starting from page 0.

Change-Id: I5e70a1f35f144b3edd1ce6d9df9af9b5da6cf194
Signed-off-by: Angus Gratton <gus@projectgus.com>
Reviewed-on: http://openocd.zylin.com/1965
Tested-by: jenkins
Reviewed-by: Andrey Yurovsky <yurovsky@gmail.com>
Reviewed-by: Paul Fertser <fercerpav@gmail.com>
This commit is contained in:
Angus Gratton 2014-02-12 22:32:47 +11:00 committed by Paul Fertser
parent fb897cc805
commit 6f62e2428e
1 changed files with 8 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

10
src/flash/nor/at91sam4l.c
View File

@ -499,6 +499,8 @@ static int sam4l_write_page(struct sam4l_info *chip, struct target *target,
{
int res;
LOG_DEBUG("sam4l_write_page address=%08" PRIx32, address);
/* Clear the page buffer before we write to it */
res = sam4l_flash_command(target, SAM4L_FCMD_CPB, -1);
if (res != ERROR_OK) {
@ -535,6 +537,8 @@ static int sam4l_write_page_partial(struct sam4l_info *chip,
if (!pg)
return ERROR_FAIL;
LOG_DEBUG("sam4l_write_page_partial address=%08" PRIx32 " nb=%08" PRIx32, address, nb);
assert(page_offset + nb < chip->page_size);
assert((address % chip->page_size) == 0);
@ -563,6 +567,8 @@ static int sam4l_write(struct flash_bank *bank, const uint8_t *buffer,
uint32_t nb = 0;
struct sam4l_info *chip = (struct sam4l_info *)bank->driver_priv;
LOG_DEBUG("sam4l_write offset=%08" PRIx32 " count=%08" PRIx32, offset, count);
if (bank->target->state != TARGET_HALTED) {
LOG_ERROR("Target not halted");
@ -605,14 +611,14 @@ static int sam4l_write(struct flash_bank *bank, const uint8_t *buffer,
for (int i = 0; i < np; i++) {
if (count >= chip->page_size) {
res = sam4l_write_page(chip, bank->target,
bank->base + (i * chip->page_size),
bank->base + offset,
buffer + (i * chip->page_size));
/* Advance one page */
offset += chip->page_size;
count -= chip->page_size;
} else {
res = sam4l_write_page_partial(chip, bank,
bank->base + (i * chip->page_size),
bank->base + offset,
buffer + (i * chip->page_size), 0, count);
/* We're done after this. */
offset += count;