Subversion Repositories mips_enhanced

#include <stdio.h>
#include "hpi_defs.h"
#include "hpi_functions.h"
 
#define SIMULATION
 
#ifdef SIMULATION
 
//#define printf //
#define MSIZE 32
#define LOOPS 1
#define START 0x0000
#define DATA  ((USHORT)~(2*i))
//#define DATA  0xC53A//0xffff//
 
#else
 
#define MSIZE 512
#define LOOPS 4
#define START 0x0500 //0x0000
#define DATA  ((USHORT)~(2*i))
 
#endif
 
int main(int argc,char *argv[], char *envp[])
{
 
  USHORT const size = (USHORT) MSIZE;
  USHORT tmp, j, i, error=0;
  USHORT start = (USHORT) START;
  USHORT data1[size];
 
  CTRL_REG * pctrl = (CTRL_REG *) HPI_CTRL;
 
  pctrl->RESERVED = 0;
  pctrl->AtoCSlow = 1;
  pctrl->CStoCTRLlow = 2;
  pctrl->CTRLlowDvalid = 2;
  pctrl->CTRLlow = 3;
  pctrl->CTRLhighCShigh = 1;
  pctrl->CShighREC = 1;
 
  tmp = pctrl->reg;
 
  printf("\n\nHPI_NEW: Test for the LEON HPI bus interface\n\n");
  printf("Writing %d words from 0x%04x to 0x%04x\n", size, start, start+(size-1)*2);
  printf("AHB2HPI CTRL register: 0x%04x\n\n", tmp);
  printf("Start reading and writing data\n\n");
 
  for (j=0; j<LOOPS; j++) {
    for(i=0; i<size; i++) {
      lcd_hpi_write_word(start+i*2, DATA);
      tmp = lcd_hpi_read_word(start+i*2);
      if (tmp != DATA) {
        printf("R/W error #%d:\n", ++error);
        printf("Cycle #%d:\n", i);
        printf("Expected:\t0x%x\n", DATA);
        printf("Read:\t\t0x%x\n", tmp);
        printf("Address:\t0x%x\n\n", start+i*2);
      }
    }
  }
 
  /*
#ifdef SIMULATION
#undef SIMULATION
#endif
  */
 
  if(error == 0)
    printf("**** FINISHED without errors ****\n");
  else
    printf("**** ERRORS: %d ****\n", error);
 
  return error;
}