int flash_erase(flash_info_t * info, int s_first, int s_last)
{
int i = s_first;
volatile CFG_FLASH_WORD_SIZE *ROM =
(volatile CFG_FLASH_WORD_SIZE *) (info->start[0]);
int timeout;
printf("First %#x last %#x\n", s_first, s_last);
for (i = s_first; i <= s_last; i++) {
CFG_FLASH_WORD_SIZE state, prev_state, rd_data;
volatile CFG_FLASH_WORD_SIZE *addr_ptr =
(volatile CFG_FLASH_WORD_SIZE *) (info->start[i]);
// Program data [byte] - 6 step sequence
ROM[CFG_FLASH_ADDR0] = FLASH_Setup_Code1;
ROM[CFG_FLASH_ADDR1] = FLASH_Setup_Code2;
ROM[CFG_FLASH_ADDR0] = FLASH_Setup_Erase;
ROM[CFG_FLASH_ADDR0] = FLASH_Setup_Code1;
ROM[CFG_FLASH_ADDR1] = FLASH_Setup_Code2;
*addr_ptr = FLASH_Block_Erase;
printf("\b\b\b\b\b %3d\%",(( ((i-s_first) + 1) * 100) / ((s_last-s_first) + 1 )) );
#if 1
// Wait for erase completion.
timeout = 10000000;
while (timeout) {
state = *addr_ptr;
if (FLASHWORD(0xffff) == state) {
break;
}
timeout--;
}
#else
// Wait for completion (bit 6 stops toggling)
timeout = 5000000;
prev_state = *addr_ptr & FLASH_Busy;
while (timeout) {
rd_data = *addr_ptr;
state = rd_data & FLASH_Busy;
if ((prev_state == state) && (rd_data == FLASHWORD(0xffff))) {
break;
}
timeout--;
prev_state = state;
}
#endif
if (!timeout){
printf("Error erasing flash...\n");
return -1;
}
}
printf("\n");
return 0;
}
int
flash_program_buf(volatile flash_t *addr, flash_t *data, int len,
unsigned long block_mask, int buffer_size)
{
volatile flash_t *ROM;
volatile flash_t *BA;
flash_t stat = 0;
int timeout = 50000;
int cache_on;
#ifdef FLASH_Write_Buffer
int i, wc;
#endif
HAL_DCACHE_IS_ENABLED(cache_on);
if (cache_on) {
HAL_DCACHE_SYNC();
HAL_DCACHE_DISABLE();
}
// Get base address and map addresses to virtual addresses
ROM = FLASH_P2V( CYGNUM_FLASH_BASE_MASK & (unsigned int)addr );
BA = FLASH_P2V( block_mask & (unsigned int)addr );
addr = FLASH_P2V(addr);
// Clear any error conditions
ROM[0] = FLASH_Clear_Status;
#ifdef FLASH_Write_Buffer
// Write any big chunks first
while (len >= buffer_size) {
wc = buffer_size;
if (wc > len) wc = len;
len -= wc;
// convert 'wc' in bytes to 'wc' in 'flash_t'
wc = wc / sizeof(flash_t); // Word count
*BA = FLASH_Write_Buffer;
timeout = 5000000;
while(((stat = ROM[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
if (--timeout == 0) {
goto bad;
}
*BA = FLASH_Write_Buffer;
}
*BA = FLASHWORD(wc-1); // Count is 0..N-1
for (i = 0; i < wc; i++) {
#ifdef CYGHWR_FLASH_WRITE_ELEM
CYGHWR_FLASH_WRITE_ELEM(addr+i, data+i);
#else
*(addr+i) = *(data+i);
#endif
}
*BA = FLASH_Confirm;
ROM[0] = FLASH_Read_Status;
timeout = 5000000;
while(((stat = ROM[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
if (--timeout == 0) {
goto bad;
}
}
// Jump out if there was an error
if (stat & FLASH_ErrorMask) {
goto bad;
}
// And verify the data - also increments the pointers.
*BA = FLASH_Reset;
for (i = 0; i < wc; i++) {
if ( *addr++ != *data++ ) {
stat = FLASH_ErrorNotVerified;
goto bad;
}
}
}
#endif
while (len > 0) {
ROM[0] = FLASH_Program;
#ifdef CYGHWR_FLASH_WRITE_ELEM
CYGHWR_FLASH_WRITE_ELEM(addr, data);
#else
*addr = *data;
#endif
timeout = 5000000;
while(((stat = ROM[0]) & FLASH_Status_Ready) != FLASH_Status_Ready) {
if (--timeout == 0) {
goto bad;
}
}
if (stat & FLASH_ErrorMask) {
break;
}
ROM[0] = FLASH_Reset;
if (*addr++ != *data++) {
stat = FLASH_ErrorNotVerified;
break;
}
len -= sizeof( flash_t );
}
// Restore ROM to "normal" mode
bad:
ROM[0] = FLASH_Reset;
if (cache_on) {
HAL_DCACHE_ENABLE();
}
return stat;
}
