Subversion Repositories or1k

#include "common.h"

#include "support.h"

#include "flash.h"

int fl_init (void)

{

  unsigned long tmp;

  reg_write(FLASH_BASE_ADDR, 0x00ff00ff);

  reg_write(FLASH_BASE_ADDR, 0x00900090);

  tmp = reg_read(FLASH_BASE_ADDR) << 8;

  reg_write(FLASH_BASE_ADDR, 0x00900090);

  tmp = tmp | reg_read(FLASH_BASE_ADDR + 4);

  debug("id = %08x ", tmp);

  /*  if (tmp != 0x89188918) {

    printf ("bad ID\n");

    return 1;

    } else debug ("good ID\n");*/

  reg_write(FLASH_BASE_ADDR, 0x00ff00ff);

  return 0;

}

int check_error (unsigned long sr, unsigned long addr)

{

  if(check_error_bit(sr, FL_SR_ERASE_ERR)) {

    printf ("erase error at %08lx\n", addr);

    /* Clear status register */

    reg_write(FLASH_BASE_ADDR, 0x05D00050);

    return 1;

  } else if (check_error_bit(sr, FL_SR_PROG_ERR)) {

    printf ("program error at %08lx\n", addr);

    /* Clear status register */

    reg_write(FLASH_BASE_ADDR, 0x05D00050);

    return 1;

  } else if (check_error_bit(sr, FL_SR_PROG_LV)) {

    printf ("low voltage error\n");

    /* Clear status register */

    reg_write(FLASH_BASE_ADDR, 0x05D00050);

    return 1;

  } else if (check_error_bit(sr, FL_SR_LOCK)) {

    printf ("lock bit error at %08lx\n", addr);

    /* Clear status register */

    reg_write(FLASH_BASE_ADDR, 0x05D00050);

    return 1;

  }

  return 0;

}

int fl_block_erase (unsigned long addr)

{

  unsigned long sr;

  reg_write(addr & ~(FLASH_BLOCK_SIZE - 1), 0x00200020);

  reg_write(addr & ~(FLASH_BLOCK_SIZE - 1), 0x00D000D0);

  do {

#if 0

    reg_write(FLASH_BASE_ADDR, 0x00700070);

#endif

    sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));

  } while (fl_wait_busy(sr));

  /* Clear status register */

  reg_write(FLASH_BASE_ADDR, 0x00500050);

  reg_write(FLASH_BASE_ADDR, 0x00ff00ff);

#ifndef CFG_IN_FLASH

  return check_error(sr, addr);

#else

  return 0;

#endif

}

int fl_unlock_one_block (unsigned long addr)

{

  unsigned long sr = 0x0;

  reg_write((addr & ~(FLASH_BLOCK_SIZE - 1)), 0x00600060);

  reg_write((addr & ~(FLASH_BLOCK_SIZE - 1)), 0x00d000d0);

  do {

#if 0

    reg_write(FLASH_BASE_ADDR, 0x00700070);

#endif

    sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));

  } while (fl_wait_busy(sr));

  /* Clear status register */

  reg_write(FLASH_BASE_ADDR, 0x00500050);

  reg_write(FLASH_BASE_ADDR, 0x00ff00ff);

#ifndef CFG_IN_FLASH

  return check_error(sr, addr);

#else

  return 0;

#endif

}

int fl_unlock_blocks (void)

{

  unsigned long c;

  unsigned int i;

  for (i = 0, c = FLASH_BASE_ADDR; i < (FLASH_SIZE / FLASH_BLOCK_SIZE);

       i++, c += FLASH_BLOCK_SIZE)

    if (fl_unlock_one_block (c)) return -1;

  return 0;

}

int fl_word_program (unsigned long addr, unsigned long val)

{

  unsigned long sr;

  reg_write(addr, 0x00400040);

  reg_write(addr, val);

  do {

#if FLASH_ORG_16_1 /* bender */

    reg_write(FLASH_BASE_ADDR, 0x00700070);

#endif

    sr = reg_read(addr & ~(FLASH_BLOCK_SIZE - 1));

  } while (fl_wait_busy(sr));

  /* Clear status register */

  reg_write(FLASH_BASE_ADDR, 0x00500050);

  reg_write(FLASH_BASE_ADDR, 0x00ff00ff);

#ifndef CFG_IN_FLASH

  return check_error(sr, addr);

#else

  return 0;

#endif

}

/* 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 += INC_ADDR)

        if (fl_word_program (tmp, tmp))

          return 1;

      printf ("done\n");

      printf ("Checking... ");

      for (tmp = taddr; tmp < taddr + tlen * FLASH_BLOCK_SIZE; i++, tmp += INC_ADDR)

        if (reg_read(tmp) != tmp) {

          printf ("failed on location %08lx: %08lx\n", tmp, REG32(tmp));

          return 1;

        }

      printf ("done\n");

    }

  }

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

  tlen = len / 8;

  tmp = 0;

  printf ("Programing");

  for (i = 0; i < len; i += INC_ADDR) {

    if (fl_word_program (dst_addr + i, reg_read(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 += INC_ADDR) {

      if(reg_read(src_addr + i) != reg_read(dst_addr + i)) {

        printf ("error at %08lx: %lx != %lx\n", src_addr + i,

                reg_read(src_addr + i), reg_read(dst_addr + i));

        return 1;

      }

      if (i > tmp) {

        printf (".");

        tmp += tlen;

      }

    }

  }

  printf (" done\n");

  return 0;

}