- str9 driver remove the duplicate target_free_working_area and reformat spaces to tabs.

- lpc2000 driver reorder function so as to not require goto, plus refornat spaces to tabs.


git-svn-id: svn://svn.berlios.de/openocd/trunk@699 b42882b7-edfa-0310-969c-e2dbd0fdcd60
This commit is contained in:
ntfreak 2008-06-03 19:36:42 +00:00
parent 3727a2103a
commit a37e3836e2
2 changed files with 28 additions and 33 deletions

View File

@ -480,26 +480,16 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
int status_code; int status_code;
int i; int i;
working_area_t *download_area; working_area_t *download_area;
int retval = ERROR_OK; int retval = ERROR_OK;
if (bank->target->state != TARGET_HALTED) if (bank->target->state != TARGET_HALTED)
{ {
return ERROR_TARGET_NOT_HALTED; return ERROR_TARGET_NOT_HALTED;
} }
/* allocate a working area */
if (target_alloc_working_area(target, lpc2000_info->cmd51_max_buffer, &download_area) != ERROR_OK)
{
LOG_ERROR("no working area specified, can't write LPC2000 internal flash");
return ERROR_FLASH_OPERATION_FAILED;
}
if (offset + count > bank->size) if (offset + count > bank->size)
{ return ERROR_FLASH_DST_OUT_OF_BANK;
retval = ERROR_FLASH_DST_OUT_OF_BANK;
goto cleanup_working_area;
}
if (lpc2000_info->cmd51_can_256b) if (lpc2000_info->cmd51_can_256b)
dst_min_alignment = 256; dst_min_alignment = 256;
else else
@ -508,8 +498,7 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
if (offset % dst_min_alignment) if (offset % dst_min_alignment)
{ {
LOG_WARNING("offset 0x%x breaks required alignment 0x%x", offset, dst_min_alignment); LOG_WARNING("offset 0x%x breaks required alignment 0x%x", offset, dst_min_alignment);
retval = ERROR_FLASH_DST_BREAKS_ALIGNMENT; return ERROR_FLASH_DST_BREAKS_ALIGNMENT;
goto cleanup_working_area;
} }
for (i = 0; i < bank->num_sectors; i++) for (i = 0; i < bank->num_sectors; i++)
@ -538,6 +527,13 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
buf_set_u32(buffer + 0x14, 0, 32, checksum); buf_set_u32(buffer + 0x14, 0, 32, checksum);
} }
/* allocate a working area */
if (target_alloc_working_area(target, lpc2000_info->cmd51_max_buffer, &download_area) != ERROR_OK)
{
LOG_ERROR("no working area specified, can't write LPC2000 internal flash");
return ERROR_FLASH_OPERATION_FAILED;
}
while (bytes_remaining > 0) while (bytes_remaining > 0)
{ {
u32 thisrun_bytes; u32 thisrun_bytes;
@ -558,7 +554,7 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
{ {
case ERROR_FLASH_OPERATION_FAILED: case ERROR_FLASH_OPERATION_FAILED:
retval = ERROR_FLASH_OPERATION_FAILED; retval = ERROR_FLASH_OPERATION_FAILED;
break; break;
case LPC2000_CMD_SUCCESS: case LPC2000_CMD_SUCCESS:
break; break;
case LPC2000_INVALID_SECTOR: case LPC2000_INVALID_SECTOR:
@ -567,18 +563,19 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
default: default:
LOG_WARNING("lpc2000 prepare sectors returned %i", status_code); LOG_WARNING("lpc2000 prepare sectors returned %i", status_code);
retval = ERROR_FLASH_OPERATION_FAILED; retval = ERROR_FLASH_OPERATION_FAILED;
break; break;
} }
/* Exit if error occured */ /* Exit if error occured */
if (retval != ERROR_OK) if (retval != ERROR_OK)
goto cleanup_working_area; break;
if (bytes_remaining >= thisrun_bytes) if (bytes_remaining >= thisrun_bytes)
{ {
if (retval = target_write_buffer(bank->target, download_area->address, thisrun_bytes, buffer + bytes_written) != ERROR_OK) if ((retval = target_write_buffer(bank->target, download_area->address, thisrun_bytes, buffer + bytes_written)) != ERROR_OK)
{ {
goto cleanup_working_area; retval = ERROR_FLASH_OPERATION_FAILED;
break;
} }
} }
else else
@ -604,7 +601,7 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
{ {
case ERROR_FLASH_OPERATION_FAILED: case ERROR_FLASH_OPERATION_FAILED:
retval = ERROR_FLASH_OPERATION_FAILED; retval = ERROR_FLASH_OPERATION_FAILED;
break; break;
case LPC2000_CMD_SUCCESS: case LPC2000_CMD_SUCCESS:
break; break;
case LPC2000_INVALID_SECTOR: case LPC2000_INVALID_SECTOR:
@ -613,21 +610,20 @@ int lpc2000_write(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 count)
default: default:
LOG_WARNING("lpc2000 returned %i", status_code); LOG_WARNING("lpc2000 returned %i", status_code);
retval = ERROR_FLASH_OPERATION_FAILED; retval = ERROR_FLASH_OPERATION_FAILED;
break; break;
} }
/* Exit if error occured */ /* Exit if error occured */
if (retval != ERROR_OK) if (retval != ERROR_OK)
goto cleanup_working_area; break;
if (bytes_remaining > thisrun_bytes) if (bytes_remaining > thisrun_bytes)
bytes_remaining -= thisrun_bytes; bytes_remaining -= thisrun_bytes;
else else
bytes_remaining = 0; bytes_remaining = 0;
bytes_written += thisrun_bytes; bytes_written += thisrun_bytes;
} }
cleanup_working_area:
target_free_working_area(target, download_area); target_free_working_area(target, download_area);
return retval; return retval;

View File

@ -397,16 +397,15 @@ int str9x_write_block(struct flash_bank_s *bank, u8 *buffer, u32 offset, u32 cou
if ((retval = target->type->run_algorithm(target, 0, NULL, 4, reg_params, str9x_info->write_algorithm->address, str9x_info->write_algorithm->address + (18 * 4), 10000, &armv4_5_info)) != ERROR_OK) if ((retval = target->type->run_algorithm(target, 0, NULL, 4, reg_params, str9x_info->write_algorithm->address, str9x_info->write_algorithm->address + (18 * 4), 10000, &armv4_5_info)) != ERROR_OK)
{ {
target_free_working_area(target, source);
target_free_working_area(target, str9x_info->write_algorithm);
LOG_ERROR("error executing str9x flash write algorithm"); LOG_ERROR("error executing str9x flash write algorithm");
retval = ERROR_FLASH_OPERATION_FAILED;
break; break;
} }
if (buf_get_u32(reg_params[3].value, 0, 32) != 0x80) if (buf_get_u32(reg_params[3].value, 0, 32) != 0x80)
{ {
retval = ERROR_FLASH_OPERATION_FAILED; retval = ERROR_FLASH_OPERATION_FAILED;
break; break;
} }
buffer += thisrun_count * 2; buffer += thisrun_count * 2;