Subversion Repositories or1k

#include "common.h"
#include "support.h"
#include "flash.h"
 
/* Returns nonzero if there is an error */
int fl_init (void)
{
  unsigned long tmp;
  REG32(FLASH_BASE_ADDR) = 0x00ff00ff;
 
  REG32(FLASH_BASE_ADDR) = 0x00900090;
  tmp = REG32(FLASH_BASE_ADDR) << 8;
  REG32(FLASH_BASE_ADDR) = 0x00900090;
  tmp = tmp | REG32(FLASH_BASE_ADDR + 4);
  debug("id = %08x ", tmp);
  if (tmp != 0x89188918) {
    printf ("bad ID\n");
    return 1;
  } else debug ("good ID\n");
  REG32(FLASH_BASE_ADDR) = 0x00ff00ff;
  return 0;
}
 
int check_error (unsigned long sr, unsigned long addr)
{
  if ((sr & (FL_SR_ERASE_ERR << 16)) || (sr & FL_SR_ERASE_ERR)) {
    printf ("erase error at %08lx\n", addr);
    /* Clear status register */
    REG32(FLASH_BASE_ADDR) = 0x05D00050;
    return 1;
  } else if ((sr & (FL_SR_PROG_ERR << 16)) || (sr & FL_SR_PROG_ERR)) {
    printf ("program error at %08lx\n", addr);
    /* Clear status register */
    REG32(FLASH_BASE_ADDR) = 0x05D00050;
    return 1;
  } else if ((sr & (FL_SR_PROG_LV << 16)) || (sr & FL_SR_PROG_LV)) {
    printf ("low voltage error\n");
    /* Clear status register */
    REG32(FLASH_BASE_ADDR) = 0x05D00050;
    return 1;
  } else if ((sr & (FL_SR_LOCK << 16)) || (sr & FL_SR_LOCK)) {
    printf ("lock bit error at %08lx\n", addr);
    /* Clear status register */
    REG32(FLASH_BASE_ADDR) = 0x05D00050;
    return 1;
  }
  return 0;
}
 
int fl_block_erase (unsigned long addr)
{
  unsigned long sr;
 
  REG32(addr & ~(FLASH_BLOCK_SIZE - 1)) = 0x00200020;
  REG32(addr & ~(FLASH_BLOCK_SIZE - 1)) = 0x00D000D0;
 
  do {
    REG32(FLASH_BASE_ADDR) = 0x00700070;
    sr = REG32(FLASH_BASE_ADDR);
  } while (!(sr & (FL_SR_WSM_READY << 16)) || !(sr & FL_SR_WSM_READY));
 
  REG32(FLASH_BASE_ADDR) = 0x00ff00ff;
  return check_error (sr, addr);
}
 
int fl_unlock_blocks (void)
{
  unsigned long sr;
 
  printf ("Clearing all lock bits... ");
  REG32(FLASH_BASE_ADDR) = 0x00600060;
  REG32(FLASH_BASE_ADDR) = 0x00d000d0;
 
  do {
    REG32(FLASH_BASE_ADDR) = 0x00700070;
    sr = REG32(FLASH_BASE_ADDR);
  } while (!(sr & (FL_SR_WSM_READY << 16)) || !(sr & FL_SR_WSM_READY));
  printf ("done\n");
  return check_error (sr, FLASH_BASE_ADDR);
}
 
int fl_word_program (unsigned long addr, unsigned long val)
{
  unsigned long sr;
 
  REG32(addr) = 0x00400040;
  REG32(addr) = val;
 
  do {
    REG32(FLASH_BASE_ADDR) = 0x00700070;
    sr = REG32(FLASH_BASE_ADDR);
  } while (!(sr & (FL_SR_WSM_READY << 16)) || !(sr & FL_SR_WSM_READY));
 
  REG32(FLASH_BASE_ADDR) = 0x00ff00ff;
  return check_error (sr, addr);
}
 
/* 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)
{
  unsigned long tmp, taddr, tlen;
  unsigned long i;
 
  if (erase) {
    fl_unlock_blocks ();
 
    if (erase == 2) {
      taddr = dst_addr & ~(FLASH_BLOCK_SIZE - 1);
      tlen = (dst_addr + len + FLASH_BLOCK_SIZE - 1) / FLASH_BLOCK_SIZE;
    } else {
      taddr = FLASH_BASE_ADDR;
      tlen = FLASH_SIZE / FLASH_BLOCK_SIZE;
    }
 
    printf ("Erasing flash... ");
    for (i = 0, tmp = taddr; i < tlen; i++, tmp += FLASH_BLOCK_SIZE)
      if (fl_block_erase (tmp)) return 1;
    printf ("done\n");
 
    if (verify) {  
      printf ("Writing test pattern... ");
      for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += 4)
        if (fl_word_program (tmp, tmp)) return 1;
      printf ("done\n");
 
      printf ("Checking... ");
      for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += 4)
        if (REG32(tmp) != tmp) {
          printf ("failed on location %08lx: %08lx\n", tmp, REG32(tmp));
          return 1;
        }
      printf ("done\n");
    }
  }
 
  REG32(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);
 
  tlen = len / 8;
  tmp = 0;
  printf ("Programing");
  for (i = 0; i < len; i += 4) {
    if (fl_word_program (dst_addr + i, REG32(src_addr + i))) return 1;
    if (i > tmp) {
      printf (".");
      tmp += tlen;
    }
  }
  printf (" done\n");
 
  if (verify) {
    printf ("Verifying");
    tmp = 0;
    for (i = 0; i < len; i += 4) {
      if (REG32(src_addr + i) != REG32(dst_addr + i)) {
        printf ("error at %08lx: %08lx != %08lx\n", src_addr + i, REG32(src_addr + i), REG32(dst_addr + i));
        return 1;
      }
      if (i > tmp) {
        printf (".");
        tmp += tlen;
      }
    }
  }
  printf (" done\n");
  return 0;
}