#include "common.h"
|
#include "common.h"
|
#include "support.h"
|
#include "support.h"
|
#include "flash.h"
|
#include "flash.h"
|
|
|
int fl_init (void)
|
int fl_init (void)
|
{
|
{
|
unsigned long tmp;
|
unsigned long tmp;
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00900090);
|
reg_write(FLASH_BASE_ADDR, 0x00900090);
|
tmp = reg_read(FLASH_BASE_ADDR) << 8;
|
tmp = reg_read(FLASH_BASE_ADDR) << 8;
|
reg_write(FLASH_BASE_ADDR, 0x00900090);
|
reg_write(FLASH_BASE_ADDR, 0x00900090);
|
tmp = tmp | reg_read(FLASH_BASE_ADDR + 4);
|
tmp = tmp | reg_read(FLASH_BASE_ADDR + 4);
|
|
|
debug("id = %08x ", tmp);
|
debug("id = %08x ", tmp);
|
/* if (tmp != 0x89188918) {
|
/* if (tmp != 0x89188918) {
|
printf ("bad ID\n");
|
printf ("bad ID\n");
|
return 1;
|
return 1;
|
} else debug ("good ID\n");*/
|
} else debug ("good ID\n");*/
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|
int check_error (unsigned long sr, unsigned long addr)
|
int check_error (unsigned long sr, unsigned long addr)
|
{
|
{
|
if(check_error_bit(sr, FL_SR_ERASE_ERR)) {
|
if(check_error_bit(sr, FL_SR_ERASE_ERR)) {
|
printf ("erase error at %08lx\n", addr);
|
printf ("erase error at %08lx\n", addr);
|
/* Clear status register */
|
/* Clear status register */
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
return 1;
|
return 1;
|
} else if (check_error_bit(sr, FL_SR_PROG_ERR)) {
|
} else if (check_error_bit(sr, FL_SR_PROG_ERR)) {
|
printf ("program error at %08lx\n", addr);
|
printf ("program error at %08lx\n", addr);
|
/* Clear status register */
|
/* Clear status register */
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
return 1;
|
return 1;
|
} else if (check_error_bit(sr, FL_SR_PROG_LV)) {
|
} else if (check_error_bit(sr, FL_SR_PROG_LV)) {
|
printf ("low voltage error\n");
|
printf ("low voltage error\n");
|
/* Clear status register */
|
/* Clear status register */
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
return 1;
|
return 1;
|
} else if (check_error_bit(sr, FL_SR_LOCK)) {
|
} else if (check_error_bit(sr, FL_SR_LOCK)) {
|
printf ("lock bit error at %08lx\n", addr);
|
printf ("lock bit error at %08lx\n", addr);
|
/* Clear status register */
|
/* Clear status register */
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
reg_write(FLASH_BASE_ADDR, 0x05D00050);
|
return 1;
|
return 1;
|
}
|
}
|
return 0;
|
return 0;
|
}
|
}
|
|
|
int fl_block_erase (unsigned long addr)
|
int fl_block_erase (unsigned long addr)
|
{
|
{
|
unsigned long sr;
|
unsigned long sr;
|
|
|
reg_write(addr & ~(FLASH_BLOCK_SIZE - 1), 0x00200020);
|
reg_write(addr & ~(FLASH_BLOCK_SIZE - 1), 0x00200020);
|
reg_write(addr & ~(FLASH_BLOCK_SIZE - 1), 0x00D000D0);
|
reg_write(addr & ~(FLASH_BLOCK_SIZE - 1), 0x00D000D0);
|
|
|
do {
|
do {
|
#if 0
|
#if 0
|
reg_write(FLASH_BASE_ADDR, 0x00700070);
|
reg_write(FLASH_BASE_ADDR, 0x00700070);
|
#endif
|
#endif
|
sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));
|
sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));
|
} while (fl_wait_busy(sr));
|
} while (fl_wait_busy(sr));
|
|
|
/* Clear status register */
|
/* Clear status register */
|
reg_write(FLASH_BASE_ADDR, 0x00500050);
|
reg_write(FLASH_BASE_ADDR, 0x00500050);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
#ifndef CFG_IN_FLASH
|
#ifndef CFG_IN_FLASH
|
return check_error(sr, addr);
|
return check_error(sr, addr);
|
#else
|
#else
|
return 0;
|
return 0;
|
#endif
|
#endif
|
}
|
}
|
|
|
int fl_unlock_one_block (unsigned long addr)
|
int fl_unlock_one_block (unsigned long addr)
|
{
|
{
|
unsigned long sr = 0x0;
|
unsigned long sr = 0x0;
|
|
|
reg_write((addr & ~(FLASH_BLOCK_SIZE - 1)), 0x00600060);
|
reg_write((addr & ~(FLASH_BLOCK_SIZE - 1)), 0x00600060);
|
reg_write((addr & ~(FLASH_BLOCK_SIZE - 1)), 0x00d000d0);
|
reg_write((addr & ~(FLASH_BLOCK_SIZE - 1)), 0x00d000d0);
|
|
|
do {
|
do {
|
#if 0
|
#if 0
|
reg_write(FLASH_BASE_ADDR, 0x00700070);
|
reg_write(FLASH_BASE_ADDR, 0x00700070);
|
#endif
|
#endif
|
sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));
|
sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));
|
} while (fl_wait_busy(sr));
|
} while (fl_wait_busy(sr));
|
|
|
/* Clear status register */
|
/* Clear status register */
|
reg_write(FLASH_BASE_ADDR, 0x00500050);
|
reg_write(FLASH_BASE_ADDR, 0x00500050);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
|
|
#ifndef CFG_IN_FLASH
|
#ifndef CFG_IN_FLASH
|
return check_error(sr, addr);
|
return check_error(sr, addr);
|
#else
|
#else
|
return 0;
|
return 0;
|
#endif
|
#endif
|
}
|
}
|
|
|
int fl_unlock_blocks (void)
|
int fl_unlock_blocks (void)
|
{
|
{
|
unsigned long c;
|
unsigned long c;
|
unsigned int i;
|
unsigned int i;
|
|
|
for (i = 0, c = FLASH_BASE_ADDR; i < (FLASH_SIZE / FLASH_BLOCK_SIZE);
|
for (i = 0, c = FLASH_BASE_ADDR; i < (FLASH_SIZE / FLASH_BLOCK_SIZE);
|
i++, c += FLASH_BLOCK_SIZE)
|
i++, c += FLASH_BLOCK_SIZE)
|
if (fl_unlock_one_block (c)) return -1;
|
if (fl_unlock_one_block (c)) return -1;
|
|
|
return 0;
|
return 0;
|
}
|
}
|
|
|
int fl_word_program (unsigned long addr, unsigned long val)
|
int fl_word_program (unsigned long addr, unsigned long val)
|
{
|
{
|
unsigned long sr;
|
unsigned long sr;
|
|
|
reg_write(addr, 0x00400040);
|
reg_write(addr, 0x00400040);
|
reg_write(addr, val);
|
reg_write(addr, val);
|
do {
|
do {
|
#if FLASH_ORG_16_1 /* bender */
|
#if FLASH_ORG_16_1 /* bender */
|
reg_write(FLASH_BASE_ADDR, 0x00700070);
|
reg_write(FLASH_BASE_ADDR, 0x00700070);
|
#endif
|
#endif
|
sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));
|
sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));
|
} while (fl_wait_busy(sr));
|
} while (fl_wait_busy(sr));
|
/* Clear status register */
|
/* Clear status register */
|
|
|
reg_write(FLASH_BASE_ADDR, 0x00500050);
|
reg_write(FLASH_BASE_ADDR, 0x00500050);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
#ifndef CFG_IN_FLASH
|
#ifndef CFG_IN_FLASH
|
return check_error(sr, addr);
|
return check_error(sr, addr);
|
#else
|
#else
|
return 0;
|
return 0;
|
#endif
|
#endif
|
}
|
}
|
|
|
/* erase = 1 (whole chip), erase = 2 (required only) */
|
/* erase = 1 (whole chip), erase = 2 (required only) */
|
int fl_program (unsigned long src_addr, unsigned long dst_addr, unsigned long len, int erase, int verify)
|
int fl_program (unsigned long src_addr, unsigned long dst_addr, unsigned long len, int erase, int verify)
|
{
|
{
|
unsigned long tmp, taddr, tlen;
|
unsigned long tmp, taddr, tlen;
|
unsigned long i;
|
unsigned long i;
|
|
|
if (erase) {
|
if (erase) {
|
fl_unlock_blocks ();
|
fl_unlock_blocks ();
|
|
|
if (erase == 2) {
|
if (erase == 2) {
|
taddr = dst_addr & ~(FLASH_BLOCK_SIZE - 1);
|
taddr = dst_addr & ~(FLASH_BLOCK_SIZE - 1);
|
tlen = (dst_addr + len + FLASH_BLOCK_SIZE - 1) / FLASH_BLOCK_SIZE;
|
tlen = (dst_addr + len + FLASH_BLOCK_SIZE - 1) / FLASH_BLOCK_SIZE;
|
} else {
|
} else {
|
taddr = FLASH_BASE_ADDR;
|
taddr = FLASH_BASE_ADDR;
|
tlen = FLASH_SIZE / FLASH_BLOCK_SIZE;
|
tlen = FLASH_SIZE / FLASH_BLOCK_SIZE;
|
}
|
}
|
|
|
printf ("Erasing flash... ");
|
printf ("Erasing flash... ");
|
for (i = 0, tmp = taddr; i < tlen; i++, tmp += FLASH_BLOCK_SIZE)
|
for (i = 0, tmp = taddr; i < tlen; i++, tmp += FLASH_BLOCK_SIZE)
|
if (fl_block_erase (tmp))
|
if (fl_block_erase (tmp))
|
return 1;
|
return 1;
|
|
|
printf ("done\n");
|
printf ("done\n");
|
|
|
if (verify) {
|
if (verify) {
|
printf ("Writing test pattern... ");
|
printf ("Writing test pattern... ");
|
for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += INC_ADDR)
|
for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += INC_ADDR)
|
if (fl_word_program (tmp, tmp))
|
if (fl_word_program (tmp, tmp))
|
return 1;
|
return 1;
|
|
|
printf ("done\n");
|
printf ("done\n");
|
|
|
printf ("Checking... ");
|
printf ("Checking... ");
|
|
|
for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += INC_ADDR)
|
for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += INC_ADDR)
|
if (reg_read(tmp) != tmp) {
|
if (reg_read(tmp) != tmp) {
|
printf ("failed on location %08lx: %08lx\n", tmp, REG32(tmp));
|
printf ("failed on location %08lx: %08lx\n", tmp, REG32(tmp));
|
return 1;
|
return 1;
|
}
|
}
|
printf ("done\n");
|
printf ("done\n");
|
}
|
}
|
}
|
}
|
|
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
reg_write(FLASH_BASE_ADDR, 0x00ff00ff);
|
|
|
printf ("Copying from %08lx-%08lx to %08lx-%08lx\n", src_addr, src_addr + len - 1, dst_addr, dst_addr + len - 1);
|
printf ("Copying from %08lx-%08lx to %08lx-%08lx\n", src_addr, src_addr + len - 1, dst_addr, dst_addr + len - 1);
|
|
|
tlen = len / 8;
|
tlen = len / 8;
|
tmp = 0;
|
tmp = 0;
|
|
|
printf ("Programing");
|
printf ("Programing");
|
for (i = 0; i < len; i += INC_ADDR) {
|
for (i = 0; i < len; i += INC_ADDR) {
|
if (fl_word_program (dst_addr + i, reg_read(src_addr + i)))
|
if (fl_word_program (dst_addr + i, reg_read(src_addr + i)))
|
return 1;
|
return 1;
|
|
|
if (i > tmp) {
|
if (i > tmp) {
|
printf (".");
|
printf (".");
|
tmp += tlen;
|
tmp += tlen;
|
}
|
}
|
}
|
}
|
|
|
printf (" done\n");
|
printf (" done\n");
|
|
|
if (verify) {
|
if (verify) {
|
printf ("Verifying");
|
printf ("Verifying");
|
tmp = 0;
|
tmp = 0;
|
for (i = 0; i < len; i += INC_ADDR) {
|
for (i = 0; i < len; i += INC_ADDR) {
|
if(reg_read(src_addr + i) != reg_read(dst_addr + i)) {
|
if(reg_read(src_addr + i) != reg_read(dst_addr + i)) {
|
printf ("error at %08lx: %lx != %lx\n", src_addr + i,
|
printf ("error at %08lx: %lx != %lx\n", src_addr + i,
|
reg_read(src_addr + i), reg_read(dst_addr + i));
|
reg_read(src_addr + i), reg_read(dst_addr + i));
|
return 1;
|
return 1;
|
}
|
}
|
if (i > tmp) {
|
if (i > tmp) {
|
printf (".");
|
printf (".");
|
tmp += tlen;
|
tmp += tlen;
|
}
|
}
|
}
|
}
|
}
|
}
|
|
|
printf (" done\n");
|
printf (" done\n");
|
return 0;
|
return 0;
|
}
|
}
|
|
|
