|
|
|
@ -24,13 +24,13 @@ |
|
|
|
|
|
|
|
|
|
#include <common.h> |
|
|
|
|
|
|
|
|
|
ulong myflush(void); |
|
|
|
|
ulong myflush (void); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define FLASH_BANK_SIZE PHYS_FLASH_SIZE |
|
|
|
|
#define MAIN_SECT_SIZE 0x10000 /* 64 KB */ |
|
|
|
|
#define MAIN_SECT_SIZE 0x10000 /* 64 KB */ |
|
|
|
|
|
|
|
|
|
flash_info_t flash_info[CFG_MAX_FLASH_BANKS]; |
|
|
|
|
flash_info_t flash_info[CFG_MAX_FLASH_BANKS]; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define CMD_READ_ARRAY 0x000000F0 |
|
|
|
@ -47,7 +47,7 @@ flash_info_t flash_info[CFG_MAX_FLASH_BANKS]; |
|
|
|
|
#define BIT_ERASE_DONE 0x00000080 |
|
|
|
|
#define BIT_RDY_MASK 0x00000080 |
|
|
|
|
#define BIT_PROGRAM_ERROR 0x00000020 |
|
|
|
|
#define BIT_TIMEOUT 0x80000000 /* our flag */ |
|
|
|
|
#define BIT_TIMEOUT 0x80000000 /* our flag */ |
|
|
|
|
|
|
|
|
|
#define READY 1 |
|
|
|
|
#define ERR 2 |
|
|
|
@ -56,391 +56,378 @@ flash_info_t flash_info[CFG_MAX_FLASH_BANKS]; |
|
|
|
|
/*-----------------------------------------------------------------------
|
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
ulong flash_init(void) |
|
|
|
|
ulong flash_init (void) |
|
|
|
|
{ |
|
|
|
|
int i, j; |
|
|
|
|
ulong size = 0; |
|
|
|
|
int i, j; |
|
|
|
|
ulong size = 0; |
|
|
|
|
|
|
|
|
|
for (i = 0; i < CFG_MAX_FLASH_BANKS; i++) |
|
|
|
|
{ |
|
|
|
|
ulong flashbase = 0; |
|
|
|
|
flash_info[i].flash_id = |
|
|
|
|
for (i = 0; i < CFG_MAX_FLASH_BANKS; i++) { |
|
|
|
|
ulong flashbase = 0; |
|
|
|
|
|
|
|
|
|
flash_info[i].flash_id = |
|
|
|
|
#if defined(CONFIG_AMD_LV400) |
|
|
|
|
(AMD_MANUFACT & FLASH_VENDMASK) | |
|
|
|
|
(AMD_ID_LV400B & FLASH_TYPEMASK); |
|
|
|
|
(AMD_MANUFACT & FLASH_VENDMASK) | |
|
|
|
|
(AMD_ID_LV400B & FLASH_TYPEMASK); |
|
|
|
|
#elif defined(CONFIG_AMD_LV800) |
|
|
|
|
(AMD_MANUFACT & FLASH_VENDMASK) | |
|
|
|
|
(AMD_ID_LV800B & FLASH_TYPEMASK); |
|
|
|
|
(AMD_MANUFACT & FLASH_VENDMASK) | |
|
|
|
|
(AMD_ID_LV800B & FLASH_TYPEMASK); |
|
|
|
|
#else |
|
|
|
|
#error "Unknown flash configured" |
|
|
|
|
#endif |
|
|
|
|
flash_info[i].size = FLASH_BANK_SIZE; |
|
|
|
|
flash_info[i].sector_count = CFG_MAX_FLASH_SECT; |
|
|
|
|
memset(flash_info[i].protect, 0, CFG_MAX_FLASH_SECT); |
|
|
|
|
if (i == 0) |
|
|
|
|
flashbase = PHYS_FLASH_1; |
|
|
|
|
else |
|
|
|
|
panic("configured too many flash banks!\n"); |
|
|
|
|
for (j = 0; j < flash_info[i].sector_count; j++) |
|
|
|
|
{ |
|
|
|
|
if (j <= 3) |
|
|
|
|
{ |
|
|
|
|
/* 1st one is 16 KB */ |
|
|
|
|
if (j == 0) |
|
|
|
|
{ |
|
|
|
|
flash_info[i].start[j] = flashbase + 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* 2nd and 3rd are both 8 KB */ |
|
|
|
|
if ((j == 1) || (j == 2)) |
|
|
|
|
{ |
|
|
|
|
flash_info[i].start[j] = flashbase + 0x4000 + (j-1)*0x2000; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* 4th 32 KB */ |
|
|
|
|
if (j == 3) |
|
|
|
|
{ |
|
|
|
|
flash_info[i].start[j] = flashbase + 0x8000; |
|
|
|
|
flash_info[i].size = FLASH_BANK_SIZE; |
|
|
|
|
flash_info[i].sector_count = CFG_MAX_FLASH_SECT; |
|
|
|
|
memset (flash_info[i].protect, 0, CFG_MAX_FLASH_SECT); |
|
|
|
|
if (i == 0) |
|
|
|
|
flashbase = PHYS_FLASH_1; |
|
|
|
|
else |
|
|
|
|
panic ("configured too many flash banks!\n"); |
|
|
|
|
for (j = 0; j < flash_info[i].sector_count; j++) { |
|
|
|
|
if (j <= 3) { |
|
|
|
|
/* 1st one is 16 KB */ |
|
|
|
|
if (j == 0) { |
|
|
|
|
flash_info[i].start[j] = |
|
|
|
|
flashbase + 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* 2nd and 3rd are both 8 KB */ |
|
|
|
|
if ((j == 1) || (j == 2)) { |
|
|
|
|
flash_info[i].start[j] = |
|
|
|
|
flashbase + 0x4000 + (j - |
|
|
|
|
1) * |
|
|
|
|
0x2000; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* 4th 32 KB */ |
|
|
|
|
if (j == 3) { |
|
|
|
|
flash_info[i].start[j] = |
|
|
|
|
flashbase + 0x8000; |
|
|
|
|
} |
|
|
|
|
} else { |
|
|
|
|
flash_info[i].start[j] = |
|
|
|
|
flashbase + (j - 3) * MAIN_SECT_SIZE; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
else |
|
|
|
|
{ |
|
|
|
|
flash_info[i].start[j] = flashbase + (j - 3)*MAIN_SECT_SIZE; |
|
|
|
|
} |
|
|
|
|
size += flash_info[i].size; |
|
|
|
|
} |
|
|
|
|
size += flash_info[i].size; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
flash_protect(FLAG_PROTECT_SET, |
|
|
|
|
CFG_FLASH_BASE, |
|
|
|
|
CFG_FLASH_BASE + monitor_flash_len - 1, |
|
|
|
|
&flash_info[0]); |
|
|
|
|
flash_protect (FLAG_PROTECT_SET, |
|
|
|
|
CFG_FLASH_BASE, |
|
|
|
|
CFG_FLASH_BASE + monitor_flash_len - 1, |
|
|
|
|
&flash_info[0]); |
|
|
|
|
|
|
|
|
|
flash_protect(FLAG_PROTECT_SET, |
|
|
|
|
CFG_ENV_ADDR, |
|
|
|
|
CFG_ENV_ADDR + CFG_ENV_SIZE - 1, |
|
|
|
|
&flash_info[0]); |
|
|
|
|
flash_protect (FLAG_PROTECT_SET, |
|
|
|
|
CFG_ENV_ADDR, |
|
|
|
|
CFG_ENV_ADDR + CFG_ENV_SIZE - 1, &flash_info[0]); |
|
|
|
|
|
|
|
|
|
return size; |
|
|
|
|
return size; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------
|
|
|
|
|
*/ |
|
|
|
|
void flash_print_info (flash_info_t *info) |
|
|
|
|
void flash_print_info (flash_info_t * info) |
|
|
|
|
{ |
|
|
|
|
int i; |
|
|
|
|
|
|
|
|
|
switch (info->flash_id & FLASH_VENDMASK) |
|
|
|
|
{ |
|
|
|
|
case (AMD_MANUFACT & FLASH_VENDMASK): |
|
|
|
|
printf("AMD: "); |
|
|
|
|
break; |
|
|
|
|
default: |
|
|
|
|
printf("Unknown Vendor "); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
switch (info->flash_id & FLASH_TYPEMASK) |
|
|
|
|
{ |
|
|
|
|
case (AMD_ID_LV400B & FLASH_TYPEMASK): |
|
|
|
|
printf("1x Amd29LV400BB (4Mbit)\n"); |
|
|
|
|
break; |
|
|
|
|
case (AMD_ID_LV800B & FLASH_TYPEMASK): |
|
|
|
|
printf("1x Amd29LV800BB (8Mbit)\n"); |
|
|
|
|
break; |
|
|
|
|
default: |
|
|
|
|
printf("Unknown Chip Type\n"); |
|
|
|
|
goto Done; |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
printf(" Size: %ld MB in %d Sectors\n", |
|
|
|
|
info->size >> 20, info->sector_count); |
|
|
|
|
|
|
|
|
|
printf(" Sector Start Addresses:"); |
|
|
|
|
for (i = 0; i < info->sector_count; i++) |
|
|
|
|
{ |
|
|
|
|
if ((i % 5) == 0) |
|
|
|
|
{ |
|
|
|
|
printf ("\n "); |
|
|
|
|
int i; |
|
|
|
|
|
|
|
|
|
switch (info->flash_id & FLASH_VENDMASK) { |
|
|
|
|
case (AMD_MANUFACT & FLASH_VENDMASK): |
|
|
|
|
printf ("AMD: "); |
|
|
|
|
break; |
|
|
|
|
default: |
|
|
|
|
printf ("Unknown Vendor "); |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
printf (" %08lX%s", info->start[i], |
|
|
|
|
info->protect[i] ? " (RO)" : " "); |
|
|
|
|
} |
|
|
|
|
printf ("\n"); |
|
|
|
|
|
|
|
|
|
Done: |
|
|
|
|
switch (info->flash_id & FLASH_TYPEMASK) { |
|
|
|
|
case (AMD_ID_LV400B & FLASH_TYPEMASK): |
|
|
|
|
printf ("1x Amd29LV400BB (4Mbit)\n"); |
|
|
|
|
break; |
|
|
|
|
case (AMD_ID_LV800B & FLASH_TYPEMASK): |
|
|
|
|
printf ("1x Amd29LV800BB (8Mbit)\n"); |
|
|
|
|
break; |
|
|
|
|
default: |
|
|
|
|
printf ("Unknown Chip Type\n"); |
|
|
|
|
goto Done; |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
printf (" Size: %ld MB in %d Sectors\n", |
|
|
|
|
info->size >> 20, info->sector_count); |
|
|
|
|
|
|
|
|
|
printf (" Sector Start Addresses:"); |
|
|
|
|
for (i = 0; i < info->sector_count; i++) { |
|
|
|
|
if ((i % 5) == 0) { |
|
|
|
|
printf ("\n "); |
|
|
|
|
} |
|
|
|
|
printf (" %08lX%s", info->start[i], |
|
|
|
|
info->protect[i] ? " (RO)" : " "); |
|
|
|
|
} |
|
|
|
|
printf ("\n"); |
|
|
|
|
|
|
|
|
|
Done:; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------
|
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
int flash_erase (flash_info_t *info, int s_first, int s_last) |
|
|
|
|
int flash_erase (flash_info_t * info, int s_first, int s_last) |
|
|
|
|
{ |
|
|
|
|
ushort result; |
|
|
|
|
int iflag, cflag, prot, sect; |
|
|
|
|
int rc = ERR_OK; |
|
|
|
|
int chip; |
|
|
|
|
|
|
|
|
|
/* first look for protection bits */ |
|
|
|
|
ushort result; |
|
|
|
|
int iflag, cflag, prot, sect; |
|
|
|
|
int rc = ERR_OK; |
|
|
|
|
int chip; |
|
|
|
|
|
|
|
|
|
if (info->flash_id == FLASH_UNKNOWN) |
|
|
|
|
return ERR_UNKNOWN_FLASH_TYPE; |
|
|
|
|
/* first look for protection bits */ |
|
|
|
|
|
|
|
|
|
if ((s_first < 0) || (s_first > s_last)) { |
|
|
|
|
return ERR_INVAL; |
|
|
|
|
} |
|
|
|
|
if (info->flash_id == FLASH_UNKNOWN) |
|
|
|
|
return ERR_UNKNOWN_FLASH_TYPE; |
|
|
|
|
|
|
|
|
|
if ((info->flash_id & FLASH_VENDMASK) != |
|
|
|
|
(AMD_MANUFACT & FLASH_VENDMASK)) { |
|
|
|
|
return ERR_UNKNOWN_FLASH_VENDOR; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
prot = 0; |
|
|
|
|
for (sect=s_first; sect<=s_last; ++sect) { |
|
|
|
|
if (info->protect[sect]) { |
|
|
|
|
prot++; |
|
|
|
|
if ((s_first < 0) || (s_first > s_last)) { |
|
|
|
|
return ERR_INVAL; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
if (prot) |
|
|
|
|
return ERR_PROTECTED; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Disable interrupts which might cause a timeout |
|
|
|
|
* here. Remember that our exception vectors are |
|
|
|
|
* at address 0 in the flash, and we don't want a |
|
|
|
|
* (ticker) exception to happen while the flash |
|
|
|
|
* chip is in programming mode. |
|
|
|
|
*/ |
|
|
|
|
cflag = icache_status(); |
|
|
|
|
icache_disable(); |
|
|
|
|
iflag = disable_interrupts(); |
|
|
|
|
|
|
|
|
|
/* Start erase on unprotected sectors */ |
|
|
|
|
for (sect = s_first; sect<=s_last && !ctrlc(); sect++) |
|
|
|
|
{ |
|
|
|
|
printf("Erasing sector %2d ... ", sect); |
|
|
|
|
|
|
|
|
|
/* arm simple, non interrupt dependent timer */ |
|
|
|
|
reset_timer_masked(); |
|
|
|
|
|
|
|
|
|
if (info->protect[sect] == 0) |
|
|
|
|
{ /* not protected */ |
|
|
|
|
vu_short *addr = (vu_short *)(info->start[sect]); |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK1; |
|
|
|
|
MEM_FLASH_ADDR2 = CMD_UNLOCK2; |
|
|
|
|
MEM_FLASH_ADDR1 = CMD_ERASE_SETUP; |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK1; |
|
|
|
|
MEM_FLASH_ADDR2 = CMD_UNLOCK2; |
|
|
|
|
*addr = CMD_ERASE_CONFIRM; |
|
|
|
|
|
|
|
|
|
/* wait until flash is ready */ |
|
|
|
|
chip = 0; |
|
|
|
|
|
|
|
|
|
do |
|
|
|
|
{ |
|
|
|
|
result = *addr; |
|
|
|
|
if ((info->flash_id & FLASH_VENDMASK) != |
|
|
|
|
(AMD_MANUFACT & FLASH_VENDMASK)) { |
|
|
|
|
return ERR_UNKNOWN_FLASH_VENDOR; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/* check timeout */ |
|
|
|
|
if (get_timer_masked() > CFG_FLASH_ERASE_TOUT) |
|
|
|
|
{ |
|
|
|
|
MEM_FLASH_ADDR1 = CMD_READ_ARRAY; |
|
|
|
|
chip = TMO; |
|
|
|
|
break; |
|
|
|
|
prot = 0; |
|
|
|
|
for (sect = s_first; sect <= s_last; ++sect) { |
|
|
|
|
if (info->protect[sect]) { |
|
|
|
|
prot++; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (!chip && (result & 0xFFFF) & BIT_ERASE_DONE) |
|
|
|
|
chip = READY; |
|
|
|
|
|
|
|
|
|
if (!chip && (result & 0xFFFF) & BIT_PROGRAM_ERROR) |
|
|
|
|
chip = ERR; |
|
|
|
|
|
|
|
|
|
} while (!chip); |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_READ_ARRAY; |
|
|
|
|
|
|
|
|
|
if (chip == ERR) |
|
|
|
|
{ |
|
|
|
|
rc = ERR_PROG_ERROR; |
|
|
|
|
goto outahere; |
|
|
|
|
} |
|
|
|
|
if (chip == TMO) |
|
|
|
|
{ |
|
|
|
|
rc = ERR_TIMOUT; |
|
|
|
|
goto outahere; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
printf("ok.\n"); |
|
|
|
|
} |
|
|
|
|
else /* it was protected */ |
|
|
|
|
{ |
|
|
|
|
printf("protected!\n"); |
|
|
|
|
if (prot) |
|
|
|
|
return ERR_PROTECTED; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Disable interrupts which might cause a timeout |
|
|
|
|
* here. Remember that our exception vectors are |
|
|
|
|
* at address 0 in the flash, and we don't want a |
|
|
|
|
* (ticker) exception to happen while the flash |
|
|
|
|
* chip is in programming mode. |
|
|
|
|
*/ |
|
|
|
|
cflag = icache_status (); |
|
|
|
|
icache_disable (); |
|
|
|
|
iflag = disable_interrupts (); |
|
|
|
|
|
|
|
|
|
/* Start erase on unprotected sectors */ |
|
|
|
|
for (sect = s_first; sect <= s_last && !ctrlc (); sect++) { |
|
|
|
|
printf ("Erasing sector %2d ... ", sect); |
|
|
|
|
|
|
|
|
|
/* arm simple, non interrupt dependent timer */ |
|
|
|
|
reset_timer_masked (); |
|
|
|
|
|
|
|
|
|
if (info->protect[sect] == 0) { /* not protected */ |
|
|
|
|
vu_short *addr = (vu_short *) (info->start[sect]); |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK1; |
|
|
|
|
MEM_FLASH_ADDR2 = CMD_UNLOCK2; |
|
|
|
|
MEM_FLASH_ADDR1 = CMD_ERASE_SETUP; |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK1; |
|
|
|
|
MEM_FLASH_ADDR2 = CMD_UNLOCK2; |
|
|
|
|
*addr = CMD_ERASE_CONFIRM; |
|
|
|
|
|
|
|
|
|
/* wait until flash is ready */ |
|
|
|
|
chip = 0; |
|
|
|
|
|
|
|
|
|
do { |
|
|
|
|
result = *addr; |
|
|
|
|
|
|
|
|
|
/* check timeout */ |
|
|
|
|
if (get_timer_masked () > |
|
|
|
|
CFG_FLASH_ERASE_TOUT) { |
|
|
|
|
MEM_FLASH_ADDR1 = CMD_READ_ARRAY; |
|
|
|
|
chip = TMO; |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (!chip |
|
|
|
|
&& (result & 0xFFFF) & BIT_ERASE_DONE) |
|
|
|
|
chip = READY; |
|
|
|
|
|
|
|
|
|
if (!chip |
|
|
|
|
&& (result & 0xFFFF) & BIT_PROGRAM_ERROR) |
|
|
|
|
chip = ERR; |
|
|
|
|
|
|
|
|
|
} while (!chip); |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_READ_ARRAY; |
|
|
|
|
|
|
|
|
|
if (chip == ERR) { |
|
|
|
|
rc = ERR_PROG_ERROR; |
|
|
|
|
goto outahere; |
|
|
|
|
} |
|
|
|
|
if (chip == TMO) { |
|
|
|
|
rc = ERR_TIMOUT; |
|
|
|
|
goto outahere; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
printf ("ok.\n"); |
|
|
|
|
} else { /* it was protected */ |
|
|
|
|
|
|
|
|
|
printf ("protected!\n"); |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (ctrlc()) |
|
|
|
|
printf("User Interrupt!\n"); |
|
|
|
|
if (ctrlc ()) |
|
|
|
|
printf ("User Interrupt!\n"); |
|
|
|
|
|
|
|
|
|
outahere: |
|
|
|
|
/* allow flash to settle - wait 10 ms */ |
|
|
|
|
udelay_masked(10000); |
|
|
|
|
outahere: |
|
|
|
|
/* allow flash to settle - wait 10 ms */ |
|
|
|
|
udelay_masked (10000); |
|
|
|
|
|
|
|
|
|
if (iflag) |
|
|
|
|
enable_interrupts(); |
|
|
|
|
if (iflag) |
|
|
|
|
enable_interrupts (); |
|
|
|
|
|
|
|
|
|
if (cflag) |
|
|
|
|
icache_enable(); |
|
|
|
|
if (cflag) |
|
|
|
|
icache_enable (); |
|
|
|
|
|
|
|
|
|
return rc; |
|
|
|
|
return rc; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------
|
|
|
|
|
* Copy memory to flash |
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
volatile static int write_hword (flash_info_t *info, ulong dest, ushort data) |
|
|
|
|
volatile static int write_hword (flash_info_t * info, ulong dest, ushort data) |
|
|
|
|
{ |
|
|
|
|
vu_short *addr = (vu_short *)dest; |
|
|
|
|
ushort result; |
|
|
|
|
int rc = ERR_OK; |
|
|
|
|
int cflag, iflag; |
|
|
|
|
int chip; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Check if Flash is (sufficiently) erased |
|
|
|
|
*/ |
|
|
|
|
result = *addr; |
|
|
|
|
if ((result & data) != data) |
|
|
|
|
return ERR_NOT_ERASED; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Disable interrupts which might cause a timeout |
|
|
|
|
* here. Remember that our exception vectors are |
|
|
|
|
* at address 0 in the flash, and we don't want a |
|
|
|
|
* (ticker) exception to happen while the flash |
|
|
|
|
* chip is in programming mode. |
|
|
|
|
*/ |
|
|
|
|
cflag = icache_status(); |
|
|
|
|
icache_disable(); |
|
|
|
|
iflag = disable_interrupts(); |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK1; |
|
|
|
|
MEM_FLASH_ADDR2 = CMD_UNLOCK2; |
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK_BYPASS; |
|
|
|
|
*addr = CMD_PROGRAM; |
|
|
|
|
*addr = data; |
|
|
|
|
|
|
|
|
|
/* arm simple, non interrupt dependent timer */ |
|
|
|
|
reset_timer_masked(); |
|
|
|
|
|
|
|
|
|
/* wait until flash is ready */ |
|
|
|
|
chip = 0; |
|
|
|
|
do |
|
|
|
|
{ |
|
|
|
|
vu_short *addr = (vu_short *) dest; |
|
|
|
|
ushort result; |
|
|
|
|
int rc = ERR_OK; |
|
|
|
|
int cflag, iflag; |
|
|
|
|
int chip; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Check if Flash is (sufficiently) erased |
|
|
|
|
*/ |
|
|
|
|
result = *addr; |
|
|
|
|
if ((result & data) != data) |
|
|
|
|
return ERR_NOT_ERASED; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Disable interrupts which might cause a timeout |
|
|
|
|
* here. Remember that our exception vectors are |
|
|
|
|
* at address 0 in the flash, and we don't want a |
|
|
|
|
* (ticker) exception to happen while the flash |
|
|
|
|
* chip is in programming mode. |
|
|
|
|
*/ |
|
|
|
|
cflag = icache_status (); |
|
|
|
|
icache_disable (); |
|
|
|
|
iflag = disable_interrupts (); |
|
|
|
|
|
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK1; |
|
|
|
|
MEM_FLASH_ADDR2 = CMD_UNLOCK2; |
|
|
|
|
MEM_FLASH_ADDR1 = CMD_UNLOCK_BYPASS; |
|
|
|
|
*addr = CMD_PROGRAM; |
|
|
|
|
*addr = data; |
|
|
|
|
|
|
|
|
|
/* check timeout */ |
|
|
|
|
if (get_timer_masked() > CFG_FLASH_ERASE_TOUT) |
|
|
|
|
{ |
|
|
|
|
chip = ERR | TMO; |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
if (!chip && ((result & 0x80) == (data & 0x80))) |
|
|
|
|
chip = READY; |
|
|
|
|
/* arm simple, non interrupt dependent timer */ |
|
|
|
|
reset_timer_masked (); |
|
|
|
|
|
|
|
|
|
if (!chip && ((result & 0xFFFF) & BIT_PROGRAM_ERROR)) |
|
|
|
|
{ |
|
|
|
|
/* wait until flash is ready */ |
|
|
|
|
chip = 0; |
|
|
|
|
do { |
|
|
|
|
result = *addr; |
|
|
|
|
|
|
|
|
|
if ((result & 0x80) == (data & 0x80)) |
|
|
|
|
/* check timeout */ |
|
|
|
|
if (get_timer_masked () > CFG_FLASH_ERASE_TOUT) { |
|
|
|
|
chip = ERR | TMO; |
|
|
|
|
break; |
|
|
|
|
} |
|
|
|
|
if (!chip && ((result & 0x80) == (data & 0x80))) |
|
|
|
|
chip = READY; |
|
|
|
|
else |
|
|
|
|
chip = ERR; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
} while (!chip); |
|
|
|
|
if (!chip && ((result & 0xFFFF) & BIT_PROGRAM_ERROR)) { |
|
|
|
|
result = *addr; |
|
|
|
|
|
|
|
|
|
if ((result & 0x80) == (data & 0x80)) |
|
|
|
|
chip = READY; |
|
|
|
|
else |
|
|
|
|
chip = ERR; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
} while (!chip); |
|
|
|
|
|
|
|
|
|
*addr = CMD_READ_ARRAY; |
|
|
|
|
*addr = CMD_READ_ARRAY; |
|
|
|
|
|
|
|
|
|
if (chip == ERR || *addr != data) |
|
|
|
|
rc = ERR_PROG_ERROR; |
|
|
|
|
if (chip == ERR || *addr != data) |
|
|
|
|
rc = ERR_PROG_ERROR; |
|
|
|
|
|
|
|
|
|
if (iflag) |
|
|
|
|
enable_interrupts(); |
|
|
|
|
if (iflag) |
|
|
|
|
enable_interrupts (); |
|
|
|
|
|
|
|
|
|
if (cflag) |
|
|
|
|
icache_enable(); |
|
|
|
|
if (cflag) |
|
|
|
|
icache_enable (); |
|
|
|
|
|
|
|
|
|
return rc; |
|
|
|
|
return rc; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------
|
|
|
|
|
* Copy memory to flash. |
|
|
|
|
*/ |
|
|
|
|
|
|
|
|
|
int write_buff (flash_info_t *info, uchar *src, ulong addr, ulong cnt) |
|
|
|
|
int write_buff (flash_info_t * info, uchar * src, ulong addr, ulong cnt) |
|
|
|
|
{ |
|
|
|
|
ulong cp, wp; |
|
|
|
|
int l; |
|
|
|
|
int i, rc; |
|
|
|
|
ushort data; |
|
|
|
|
|
|
|
|
|
wp = (addr & ~1); /* get lower word aligned address */ |
|
|
|
|
ulong cp, wp; |
|
|
|
|
int l; |
|
|
|
|
int i, rc; |
|
|
|
|
ushort data; |
|
|
|
|
|
|
|
|
|
wp = (addr & ~1); /* get lower word aligned address */ |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* handle unaligned start bytes |
|
|
|
|
*/ |
|
|
|
|
if ((l = addr - wp) != 0) { |
|
|
|
|
data = 0; |
|
|
|
|
for (i = 0, cp = wp; i < l; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*(uchar *) cp << 8); |
|
|
|
|
} |
|
|
|
|
for (; i < 2 && cnt > 0; ++i) { |
|
|
|
|
data = (data >> 8) | (*src++ << 8); |
|
|
|
|
--cnt; |
|
|
|
|
++cp; |
|
|
|
|
} |
|
|
|
|
for (; cnt == 0 && i < 2; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*(uchar *) cp << 8); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* handle unaligned start bytes |
|
|
|
|
*/ |
|
|
|
|
if ((l = addr - wp) != 0) { |
|
|
|
|
data = 0; |
|
|
|
|
for (i=0, cp=wp; i<l; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*(uchar *)cp << 8); |
|
|
|
|
if ((rc = write_hword (info, wp, data)) != 0) { |
|
|
|
|
return (rc); |
|
|
|
|
} |
|
|
|
|
wp += 2; |
|
|
|
|
} |
|
|
|
|
for (; i<2 && cnt>0; ++i) { |
|
|
|
|
data = (data >> 8) | (*src++ << 8); |
|
|
|
|
--cnt; |
|
|
|
|
++cp; |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* handle word aligned part |
|
|
|
|
*/ |
|
|
|
|
while (cnt >= 2) { |
|
|
|
|
data = *((vu_short *) src); |
|
|
|
|
if ((rc = write_hword (info, wp, data)) != 0) { |
|
|
|
|
return (rc); |
|
|
|
|
} |
|
|
|
|
src += 2; |
|
|
|
|
wp += 2; |
|
|
|
|
cnt -= 2; |
|
|
|
|
} |
|
|
|
|
for (; cnt==0 && i<2; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*(uchar *)cp << 8); |
|
|
|
|
|
|
|
|
|
if (cnt == 0) { |
|
|
|
|
return ERR_OK; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if ((rc = write_hword(info, wp, data)) != 0) { |
|
|
|
|
return (rc); |
|
|
|
|
/*
|
|
|
|
|
* handle unaligned tail bytes |
|
|
|
|
*/ |
|
|
|
|
data = 0; |
|
|
|
|
for (i = 0, cp = wp; i < 2 && cnt > 0; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*src++ << 8); |
|
|
|
|
--cnt; |
|
|
|
|
} |
|
|
|
|
wp += 2; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* handle word aligned part |
|
|
|
|
*/ |
|
|
|
|
while (cnt >= 2) { |
|
|
|
|
data = *((vu_short*)src); |
|
|
|
|
if ((rc = write_hword(info, wp, data)) != 0) { |
|
|
|
|
return (rc); |
|
|
|
|
for (; i < 2; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*(uchar *) cp << 8); |
|
|
|
|
} |
|
|
|
|
src += 2; |
|
|
|
|
wp += 2; |
|
|
|
|
cnt -= 2; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
if (cnt == 0) { |
|
|
|
|
return ERR_OK; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* handle unaligned tail bytes |
|
|
|
|
*/ |
|
|
|
|
data = 0; |
|
|
|
|
for (i=0, cp=wp; i<2 && cnt>0; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*src++ << 8); |
|
|
|
|
--cnt; |
|
|
|
|
} |
|
|
|
|
for (; i<2; ++i, ++cp) { |
|
|
|
|
data = (data >> 8) | (*(uchar *)cp << 8); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
return write_hword(info, wp, data); |
|
|
|
|
|
|
|
|
|
return write_hword (info, wp, data); |
|
|
|
|
} |
|
|
|
|