Subversion Repositories or1k

/* This is exception test for OpenRISC 1200 */

#include "spr_defs.h"

#include "support.h"

#include "int.h"

/* Define RAM physical location and size

   Bottom half will be used for this program, the rest

   will be used for testing */

#define FLASH_START 0x00000000

#define FLASH_SIZE  0x00200000

#define RAM_START   0x40000000

#define RAM_SIZE    0x00200000

/* MMU page size */

#define PAGE_SIZE 8192

/* Number of DTLB sets used (power of 2, max is 256) */

#define DTLB_SETS 32

/* Number of DTLB ways (2, 2, 3 etc., max is 4). */

#define DTLB_WAYS 1

/* Number of ITLB sets used (power of 2, max is 256) */

#define ITLB_SETS 32

/* Number of ITLB ways (1, 2, 3 etc., max is 4). */

#define ITLB_WAYS 1

/* TLB mode codes */

#define TLB_CODE_ONE_TO_ONE     0x00000000

#define TLB_CODE_PLUS_ONE_PAGE  0x10000000

#define TLB_CODE_MINUS_ONE_PAGE 0x20000000

#define TLB_TEXT_SET_NB 6

#define TLB_DATA_SET_NB 2

#define TLB_CODE_MASK   0xfffff000

#define TLB_PR_MASK     0x00000fff

#define DTLB_PR_NOLIMIT  ( SPR_DTLBTR_CI   | \

                          SPR_DTLBTR_URE  | \

                          SPR_DTLBTR_UWE  | \

                          SPR_DTLBTR_SRE  | \

                          SPR_DTLBTR_SWE  )

#define ITLB_PR_NOLIMIT  ( SPR_ITLBTR_CI   | \

                          SPR_ITLBTR_SXE  | \

                          SPR_ITLBTR_UXE  )

/* fails if x is false */

#define ASSERT(x) ((x)?1: fail (__FUNCTION__, __LINE__))

/* Exception vectors */

#define V_RESET       1

#define V_BERR        2

#define V_DPF         3

#define V_IPF         4

#define V_TICK        5

#define V_ALIGN       6

#define V_ILLINSN     7

#define V_INT         8

#define V_DTLB_MISS   9

#define V_ITLB_MISS   10

#define V_RANGE       11

#define V_SYS         12

#define V_TRAP        14

#if 1

#define debug printf

#else

#define debug

#endif

/* Extern functions */

extern void lo_dmmu_en (void);

extern void lo_immu_en (void);

extern unsigned long call (unsigned long add, unsigned long val);

extern unsigned long call_with_int (unsigned long add, unsigned long val);

extern void trap (void);

extern void b_trap (void);

extern void range (void);

extern void b_range (void);

extern int except_basic (void);

extern void (*test)(void);

extern int load_acc_32 (unsigned long add);

extern int load_acc_16 (unsigned long add);

extern int store_acc_32 (unsigned long add);

extern int store_acc_16 (unsigned long add);

extern int load_b_acc_32 (unsigned long add);

extern int int_trigger (void);

extern int int_loop (void);

extern int jump_back (void);

/* Local functions prototypes */

void dmmu_disable (void);

void immu_disable (void);

/* DTLB mode status */

volatile unsigned long dtlb_val;

/* ITLB mode status */

volatile unsigned long itlb_val;

/* Exception counter */

volatile int except_count;

/* Exception mask */

volatile unsigned long except_mask;

/* Exception efective address */

volatile unsigned long except_ea;

/* Eception PC */

volatile unsigned long except_pc;

void fail (char *func, int line)

{

#ifndef __FUNCTION__

#define __FUNCTION__ "?"

#endif

  immu_disable ();

  dmmu_disable ();

  debug("Test failed in %s:%i\n", func, line);

  report (0xeeeeeeee);

  exit (1);

}

void test_dummy (void)

{

        asm("_test:");

        asm("l.addi\t\tr3,r3,1") ;

        asm("l.nop" : :);

}

void copy_test (unsigned long phy_add)

{

        memcpy((void *)phy_add, (void *)&test, 8);

}

/* Bus error handler */

void bus_err_handler (void)

{

  except_mask |= 1 << V_BERR;

  except_count++;

}

/* Illegal insn handler */

void ill_insn_handler (void)

{

  except_mask |= 1 << V_ILLINSN;

  except_count++;

}

/* Low priority interrupt handler */

void tick_handler (void)

{

  /* Disable interrupt recognition */

  mtspr(SPR_ESR_BASE, mfspr(SPR_ESR_BASE) & ~SPR_SR_TEE);

  except_mask |= 1 << V_TICK;

  except_count++;

}

/* High priority interrupt handler */

void int_handler (void)

{

  /* Disable interrupt recognition */

  mtspr(SPR_ESR_BASE, mfspr(SPR_ESR_BASE) & ~SPR_SR_IEE);

  except_mask |= 1 << V_INT;

  except_count++;

}

/* Trap handler */

void trap_handler (void)

{

  except_mask |= 1 << V_TRAP;

  except_count++;

}

/* Align handler */

void align_handler (void)

{

  except_mask |= 1 << V_ALIGN;

  except_count++;

}

/* Range handler */

void range_handler (void)

{

  /* Disable range exception */

  mtspr (SPR_ESR_BASE, mfspr (SPR_ESR_BASE) & ~SPR_SR_OVE);

  except_mask |= 1 << V_RANGE;

  except_count++;

}

/* DTLB miss exception handler */

void dtlb_miss_handler (void)

{

  unsigned long ea;

  int set, way = 0;

  int i;

  /* Get EA that cause the exception */

  ea = mfspr (SPR_EEAR_BASE);

  /* Find TLB set and LRU way */

  set = (ea / PAGE_SIZE) % DTLB_SETS;

  for (i = 0; i < DTLB_WAYS; i++) {

    if ((mfspr (SPR_DTLBMR_BASE(i) + set) & SPR_DTLBMR_LRU) == 0) {

      way = i;

      break;

    }

  }

  mtspr (SPR_DTLBMR_BASE(way) + set, (ea & SPR_DTLBMR_VPN) | SPR_DTLBMR_V);

  mtspr (SPR_DTLBTR_BASE(way) + set, (ea & SPR_DTLBTR_PPN) | dtlb_val);

  except_mask |= 1 << V_DTLB_MISS;

  except_count++;

}

/* ITLB miss exception handler */

void itlb_miss_handler (void)

{

  unsigned long ea;

  int set, way = 0;

  int i;

  /* Get EA that cause the exception */

  ea = mfspr (SPR_EEAR_BASE);

  /* Find TLB set and LRU way */

  set = (ea / PAGE_SIZE) % ITLB_SETS;

  for (i = 0; i < ITLB_WAYS; i++) {

    if ((mfspr (SPR_ITLBMR_BASE(i) + set) & SPR_ITLBMR_LRU) == 0) {

      way = i;

      break;

    }

  }

  mtspr (SPR_ITLBMR_BASE(way) + set, (ea & SPR_ITLBMR_VPN) | SPR_ITLBMR_V);

  mtspr (SPR_ITLBTR_BASE(way) + set, (ea & SPR_ITLBTR_PPN) | itlb_val);

  except_mask |= 1 << V_ITLB_MISS;

  except_count++;

}

/* Data page fault exception handler */

void dpage_fault_handler (void)

{

  unsigned long ea;

  int set, way = 0;

  int i;

  /* Get EA that cause the exception */

  ea = mfspr (SPR_EEAR_BASE);

  /* Find TLB set and way */

  set = (ea / PAGE_SIZE) % DTLB_SETS;

  for (i = 0; i < DTLB_WAYS; i++) {

    if ((mfspr (SPR_DTLBMR_BASE(i) + set) & SPR_DTLBMR_VPN) == (ea & SPR_DTLBMR_VPN)) {

      way = i;

      break;

    }

  }

  /* Give permission */

  mtspr (SPR_DTLBTR_BASE(way) + set, (mfspr (SPR_DTLBTR_BASE(way) + set) & ~DTLB_PR_NOLIMIT) | dtlb_val);

  except_mask |= 1 << V_DPF;

  except_count++;

}

/* Intstruction page fault exception handler */

void ipage_fault_handler (void)

{

  unsigned long ea;

  int set, way = 0;

  int i;

  /* Get EA that cause the exception */

  ea = mfspr (SPR_EEAR_BASE);

  /* Find TLB set and way */

  set = (ea / PAGE_SIZE) % ITLB_SETS;

  for (i = 0; i < ITLB_WAYS; i++) {

    if ((mfspr (SPR_ITLBMR_BASE(i) + set) & SPR_ITLBMR_VPN) == (ea & SPR_ITLBMR_VPN)) {

      way = i;

      break;

    }

  }

  /* Give permission */

  mtspr (SPR_ITLBTR_BASE(way) + set, (mfspr (SPR_ITLBTR_BASE(way) + set) & ~ITLB_PR_NOLIMIT) | itlb_val);

  except_mask |= 1 << V_IPF;

  except_count++;

}

/*Enable DMMU */

void dmmu_enable (void)

{

  /* Enable DMMU */

  lo_dmmu_en ();

}

/* Disable DMMU */

void dmmu_disable (void)

{

  mtspr (SPR_SR, mfspr (SPR_SR) & ~SPR_SR_DME);

}

/* Enable IMMU */

void immu_enable (void)

{

  /* Enable IMMU */

  lo_immu_en ();

}

/* Disable IMMU */

void immu_disable (void)

{

  mtspr (SPR_SR, mfspr (SPR_SR) & ~SPR_SR_IME);

}

/* Tick timer init */

void tick_init (int period, int hp_int)

{

  /* Disable tick timer exception recognition */

  mtspr(SPR_SR, mfspr(SPR_SR) & ~SPR_SR_TEE);

  /* Set period of one cycle, restartable mode */

  mtspr(SPR_TTMR, SPR_TTMR_IE | SPR_TTMR_RT | (period & SPR_TTMR_PERIOD));

  /* Reset counter */

  mtspr(SPR_TTCR, 0);

}

/* Interrupt test */

int interrupt_test (void)

{

  unsigned long ret;

  int i;

  /* Init tick timer */

  tick_init (1, 1);

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Test normal high priority interrupt trigger */

  ret = call ((unsigned long)&int_trigger, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_TICK));

  ASSERT(ret == 0);

  ASSERT(except_pc == (unsigned long)int_trigger + 16);

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Test inetrrupt in delay slot */

  tick_init (10, 1);

  /* Hopefully we will have interrupt recognition between branch insn and delay slot */

  except_pc = (unsigned long)&int_loop;

  for (i = 0; i < 10; i++) {

    call_with_int (except_pc, RAM_START);

    ASSERT(except_pc == (unsigned long)&int_loop);

  }

  return 0;

}

/* ITLB miss test */

int itlb_test (void)

{

  int i, j, ret;

  unsigned long ea, ta;

  /* Invalidate all entries in ITLB */

  for (i = 0; i < ITLB_WAYS; i++) {

    for (j = 0; j < ITLB_SETS; j++) {

      mtspr (SPR_ITLBMR_BASE(i) + j, 0);

      mtspr (SPR_ITLBTR_BASE(i) + j, 0);

    }

  }

  /* Set one to one translation for the use of this program */

  for (i = 0; i < TLB_TEXT_SET_NB; i++) {

    ea = FLASH_START + (i*PAGE_SIZE);

    ta = FLASH_START + (i*PAGE_SIZE);

    mtspr (SPR_ITLBMR_BASE(0) + i, ea | SPR_ITLBMR_V);

    mtspr (SPR_ITLBTR_BASE(0) + i, ta | ITLB_PR_NOLIMIT);

  }

  /* Set dtlb no permisions */

  itlb_val = SPR_ITLBTR_CI;

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Enable IMMU */

  immu_enable ();

  /* Copy jump instruction to last location of a page */

  ea = RAM_START + (RAM_SIZE/2) + ((TLB_TEXT_SET_NB + 1)*PAGE_SIZE) - 8;

  memcpy((void *)ea, (void *)&jump_back, 12);

  /* Check if there was ITLB miss exception */

  ret = call (ea, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_ITLB_MISS));

  ASSERT(except_pc == ea);

  ASSERT(ret == 0);

  /* Set dtlb no permisions */

  itlb_val = SPR_ITLBTR_CI | SPR_ITLBTR_SXE;

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Check if there was IPF miss exception */

  ret = call (ea, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_IPF));

  ASSERT(except_pc == ea);

  ASSERT(ret == 0);

  /* Set dtlb no permisions */

  itlb_val = SPR_ITLBTR_CI;

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Check if there was ITLB miss exception */

  ret = call (ea, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_ITLB_MISS));

  ASSERT(except_pc == ea + 4);

  ASSERT(ret == 0);

  /* Set dtlb no permisions */

  itlb_val = SPR_ITLBTR_CI | SPR_ITLBTR_SXE;

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Check if there was IPF exception */

  ret = call (ea, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_IPF));

  ASSERT(except_pc == ea + 4);

  ASSERT(ret == 0);

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  ret = call (ea, 0);

  ASSERT(except_count == 0);

  ASSERT(ret == 1);

  /* Disable IMMU */

  immu_disable ();

  return 0;

}

/* DTLB miss test */

int dtlb_test (void)

{

  int i, j, ret;

  unsigned long ea, ta;

  /* Invalidate all entries in DTLB */

  for (i = 0; i < DTLB_WAYS; i++) {

    for (j = 0; j < DTLB_SETS; j++) {

      mtspr (SPR_DTLBMR_BASE(i) + j, 0);

      mtspr (SPR_DTLBTR_BASE(i) + j, 0);

    }

  }

  /* Set one to one translation for the use of this program */

  for (i = 0; i < TLB_DATA_SET_NB; i++) {

    ea = RAM_START + (i*PAGE_SIZE);

    ta = RAM_START + (i*PAGE_SIZE);

    mtspr (SPR_DTLBMR_BASE(0) + i, ea | SPR_ITLBMR_V);

    mtspr (SPR_DTLBTR_BASE(0) + i, ta | DTLB_PR_NOLIMIT);

  }

  /* Set dtlb no permisions */

  dtlb_val = SPR_DTLBTR_CI;

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Set pattern */

  ea = RAM_START + (RAM_SIZE/2) + ((TLB_DATA_SET_NB)*PAGE_SIZE);

  REG32(ea) = 0x87654321;

  /* Enable DMMU */

  dmmu_enable ();

  /* Check if there was DTLB miss exception */

  ret = call ((unsigned long)&load_b_acc_32, ea);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_DTLB_MISS));

  ASSERT(except_pc == (unsigned long)load_b_acc_32 + 8);

  ASSERT(except_ea == ea);

  ASSERT(ret == 0x12345678);

  /* Set dtlb no permisions */

  dtlb_val = SPR_DTLBTR_CI | SPR_DTLBTR_SRE;

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Check if there was DPF miss exception */

  ret = call ((unsigned long)&load_b_acc_32, ea);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_DPF));

  ASSERT(except_pc == (unsigned long)load_b_acc_32 + 8);

  ASSERT(except_ea == ea);

  ASSERT(ret == 0x12345678);

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  ret = call ((unsigned long)&load_b_acc_32, ea);

  ASSERT(except_count == 0);

  ASSERT(ret == 0x87654321);

  /* Disable DMMU */

  dmmu_disable ();

  return 0;

}

/* Bus error test */

int buserr_test (void)

{

  int i, j, ret;

  unsigned long ea, ta;

  /* Invalidate all entries in ITLB */

  for (i = 0; i < ITLB_WAYS; i++) {

    for (j = 0; j < ITLB_SETS; j++) {

      mtspr (SPR_ITLBMR_BASE(i) + j, 0);

      mtspr (SPR_ITLBTR_BASE(i) + j, 0);

    }

  }

  /* Set one to one translation for the use of this program */

  for (i = 0; i < TLB_TEXT_SET_NB; i++) {

    ea = FLASH_START + (i*PAGE_SIZE);

    ta = FLASH_START + (i*PAGE_SIZE);

    mtspr (SPR_ITLBMR_BASE(0) + i, ea | SPR_ITLBMR_V);

    mtspr (SPR_ITLBTR_BASE(0) + i, ta | ITLB_PR_NOLIMIT);

  }

  /* Invalidate all entries in DTLB */

  for (i = 0; i < DTLB_WAYS; i++) {

    for (j = 0; j < DTLB_SETS; j++) {

      mtspr (SPR_DTLBMR_BASE(i) + j, 0);

      mtspr (SPR_DTLBTR_BASE(i) + j, 0);

    }

  }

  /* Set one to one translation for the use of this program */

  for (i = 0; i < TLB_DATA_SET_NB; i++) {

    ea = RAM_START + (i*PAGE_SIZE);

    ta = RAM_START + (i*PAGE_SIZE);

    mtspr (SPR_DTLBMR_BASE(0) + i, ea | SPR_ITLBMR_V);

    mtspr (SPR_DTLBTR_BASE(0) + i, ta | DTLB_PR_NOLIMIT);

  }

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Set IMMU translation */

  ea = RAM_START + (RAM_SIZE) + ((TLB_TEXT_SET_NB)*PAGE_SIZE);

  itlb_val = SPR_ITLBTR_CI | SPR_ITLBTR_SXE;

  mtspr (SPR_ITLBMR_BASE(0) + TLB_TEXT_SET_NB, (ea & SPR_ITLBMR_VPN) | SPR_ITLBMR_V);

  mtspr (SPR_ITLBTR_BASE(0) + TLB_TEXT_SET_NB, ((ea + PAGE_SIZE) & SPR_ITLBTR_PPN) | itlb_val);

  /* Enable IMMU */

  immu_enable ();

  /* Check if there was bus error exception */

  ret = call (ea, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_BERR));

  ASSERT(except_pc == ea);

  ASSERT(except_ea == ea);

  /* Disable IMMU */

  immu_disable ();

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;

  except_ea = 0;

  /* Copy jump instruction to last location of RAM */

  ea = RAM_START + RAM_SIZE - 8;

  memcpy((void *)ea, (void *)&jump_back, 8);

  /* Check if there was bus error exception */

  ret = call (ea, 0);

  ASSERT(except_count == 1);

  ASSERT(except_mask == (1 << V_BERR));

  ASSERT(except_pc == ea + 4);

  ASSERT(except_ea == ea + 8);

  /* Reset except counter */

  except_count = 0;

  except_mask = 0;

  except_pc = 0;