Subversion Repositories openrisc

#include "board.h"
#include "cpu-utils.h"
#include "cfi_ctrl.h"
 
#include "orpsoc-defines.h"
 
 
int main(void)
{
  /* 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;
  unsigned short* flash_data_short_ptr;
 
  /* test for number of blocks... */
  for(j=0;j<NUM_PAGES;j++)
    {
      page_base = j*(128*1024);
 
      cfi_ctrl_clear_status();
 
      /* Erase block  */
      if (cfi_ctrl_erase_block(page_base))
	exit(0xbaaaaaad);
 
      cfi_ctrl_clear_status();
 
      for (i=0;i<TEST_LENGTH;i++)
	{
	  tmp = (unsigned short)rand();
	  report(tmp&0xffff);
	  cfi_ctrl_write_short(tmp,page_base+i*2);
	  check_data[i] = tmp;
 
	}
 
      /* Read back as shorts and check it */
      cfi_ctrl_enable_data_read();
      for (i=0;i<TEST_LENGTH;i++)
	{
	  //tmp = REG16(CFI_CTRL_BASE + page_base + (i*2));
	  flash_data_short_ptr = (short*) (CFI_CTRL_BASE + page_base);
	  //if (tmp != check_data[i])
	  if (flash_data_short_ptr[i] != check_data[i])
	    exit(0xbaaaaaad);
 
	}
 
      char * flash_data_char_ptr = (char*) CFI_CTRL_BASE + page_base;
      char * chardata = (char*) check_data;
      /* Read back as bytes and check it */
      cfi_ctrl_enable_data_read();
      for (i=0;i<TEST_LENGTH*2;i++)
	{
	  if (flash_data_char_ptr[i] != chardata[i])
	    exit(0xbaaaaaad);
 
	}
 
      long * flash_data_long_ptr =  CFI_CTRL_BASE + page_base;
      long * longdata = (long*) check_data;
      /* Read back as longs and check it */
      cfi_ctrl_enable_data_read();
      for (i=0;i<TEST_LENGTH/2;i++)
	{
	  if (flash_data_long_ptr[i] != longdata[i])
	    exit(0xbaaaaaad);
 
	}
 
 
    }
 
  report(0x8000000d);
  exit(0);
}