Subversion Repositories openrisc

#include "board.h"
#include "cpu-utils.h"
#include "cfi_ctrl.h"
#include "uart.h"
#include "printf.h"
#include "orpsoc-defines.h"
 
 
int main(void)
{
  uart_init(DEFAULT_UART);
 
  printf("cfi_ctrl-simple test");
 
  /* Reset the flash */
  cfi_ctrl_reset_flash();
 
  /* wait for the controller to be done */
  while (cfi_ctrl_busy());
 
#define NUM_PAGES 8
#define TEST_LENGTH 64
  int i,j;
  unsigned int page_base;
  unsigned short check_data[TEST_LENGTH];
  unsigned short tmp;
 
  /* test for number of blocks... */
  for(j=0;j<NUM_PAGES;j++)
    {
      page_base = j*(128*1024);
 
      printf("Status before clear: %02x\n",cfi_ctrl_get_status()&0xff);
      cfi_ctrl_clear_status();
      printf("Status after clear: %02x\n",cfi_ctrl_get_status()&0xff);
 
      /* Erase block  */
      if (cfi_ctrl_erase_block(page_base))
	{
	  //exit(0xbaaaaaad);
	  printf("Error erasing block at %08x\n",page_base);
	  printf("Aborting test\n");
	  exit(1);
	}
 
      cfi_ctrl_clear_status();
 
      for (i=0;i<TEST_LENGTH;i++)
	{
	  tmp = (unsigned short)rand();
	  //report(tmp&0xffff);
	  printf("writing data: %04x\n", tmp&0xffff);
	  cfi_ctrl_write_short(tmp,page_base+i*2);
	  check_data[i] = tmp;
 
	}
 
      /* Read back the data and check it */
      cfi_ctrl_enable_data_read();
      for (i=0;i<TEST_LENGTH;i++)
	{
	  tmp = REG16(CFI_CTRL_BASE + page_base + (i*2));
	  if (tmp != check_data[i])
	    //exit(0xbaaaaaad);
	    printf("read data was not written data: %04x != %04x\n", tmp&0xffff,
		   check_data[i]);
	}
    }
 
  report(0x8000000d);
  exit(0);
}