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; }