Subversion Repositories or1k

#include <stdio.h>
 
#include "config.h"
 
#ifdef HAVE_INTTYPES_H
#include <inttypes.h>
#endif
 
#include "port.h"
#include "arch.h"
#include "sim-config.h"
#include "abstract.h"
#include "except.h"
 
struct test_config {
  uint32_t array[128];
  oraddr_t baseaddr;
};
 
/* Test write */
void test_write32 (oraddr_t addr, uint32_t value, void *dat)
{
  struct test_config *test = dat;
 
  if (addr & 0x00000080)
    test->array[addr & 0x7f] = value;
  else
    except_handle(EXCEPT_BUSERR, cur_vadd);
}
 
/* Test read */
uint32_t test_read32 (oraddr_t addr, void *dat)
{
  struct test_config *test = dat;
 
  if (addr & 0x00000080)
    return ~test->array[addr & 0x7f];
  else
    except_handle(EXCEPT_BUSERR, cur_vadd);
    return 0x00000000;
}
 
void test_reset (void *dat)
{
  struct test_config *test = dat;
  int i;
 
  for (i = 0; i < 128; i++)
    test->array[i] = 0x00000000;
}
 
/*---------------------------------------------------[ Test configuration ]---*/
void test_baseaddr(union param_val val, void *dat)
{
  struct test_config *test = dat;
  test->baseaddr = val.addr_val;
}
 
void *test_sec_start(void)
{
  struct test_config *test = malloc(sizeof(struct test_config));
 
  if(!test) {
    fprintf(stderr, "Peripheral Test: Run out of memory\n");
    exit(-1);
  }
 
  test->baseaddr = 0;
 
  return test;
}
 
void test_sec_end(void *dat)
{
  struct test_config *test = dat;
  if(test->baseaddr)
    register_memoryarea(test->baseaddr, 256, 4, 0, test_read32, test_write32, NULL);
  reg_sim_reset(test_reset, dat);
}
 
void reg_test_sec(void)
{
  struct config_section *sec = reg_config_sec("test", test_sec_start,
                                              test_sec_end);
 
  reg_config_param(sec, "baseaddr", paramt_addr, test_baseaddr);
}