Subversion Repositories aemb

/* $Id: corefunc.hh,v 1.4 2008-05-11 13:51:50 sybreon Exp $

**

** AEMB Function Verification C++ Testbench

** Copyright (C) 2004-2008 Shawn Tan 

**

** This file is part of AEMB.

**

** AEMB is free software: you can redistribute it and/or modify it

** under the terms of the GNU General Public License as published by

** the Free Software Foundation, either version 3 of the License, or

** (at your option) any later version.

**

** AEMB is distributed in the hope that it will be useful, but WITHOUT

** ANY WARRANTY; without even the implied warranty of MERCHANTABILITY

** or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public

** License for more details.

**

** You should have received a copy of the GNU General Public License

** along with AEMB.  If not, see .

*/

/**

AEMB Software Verification

@file corefunc.hh

These are custom functions written to test certain hardware functions

that cannot be tested through numerical algorithms.

*/

#ifndef COREFUNC_HH

#define COREFUNC_HH

#ifdef __cplusplus

extern "C" {

#endif

#define MAGIC 0xAE63AE63 // magic number

volatile int exce = 0;

volatile void _hw_exception_handler()

{

  int resr;

  asm volatile ("mfs %0, resr" : "=r"(resr));

  switch (resr)

    {

    case 1: // unaligned

      --exce;

      break;

    case 2: // illegal

      ++exce;

      break;

    default:

      exce = 0;

      break;

    }

  asm volatile ("rted r17, 0\n"

                "nop\n");

}

  /**

EXCEPTION TEST ROUTINE

*/

int exceptionTest(int timeout)

{

  volatile int *toggle = (int *)0xFFFFFFE2;

  // enable exceptions

  asm volatile (".long 0xDEADC0DE"); // define illegal instruction (1 error)

  *toggle = *toggle; // test unaligned memory access (2 errors)

  // disable exceptions

  return (exce != -1) ? EXIT_FAILURE : EXIT_SUCCESS;

}

volatile int intr = 0;

void __attribute__ ((interrupt_handler)) interruptHandler()

{

  int *toggle = (int *)0xFFFFFFE0;

  intr++; // flag the interrupt service routine

  *toggle = -1; // disable interrupts

}

/**

INTERRUPT TEST ROUTINE

*/

int interruptTest(int timeout)

{

  aembEnableInterrupts();

  for (int timer=0; (timer < timeout * 100); ++timer)

    asm volatile ("nop"); // delay loop

  aembDisableInterrupts();

  return (intr == 0) ? EXIT_FAILURE : EXIT_SUCCESS;

}

/**

   FSL TEST ROUTINE

*/

int xslTest (int code)

{

  // TEST FSL1 ONLY

  int FSL = code;

  asm ("PUT %0, RFSL0" :: "r"(FSL));

  asm ("GET %0, RFSL0" : "=r"(FSL));

  if (FSL != code) return EXIT_FAILURE;

  asm ("PUT %0, RFSL31" :: "r"(FSL));

  asm ("GET %0, RFSL31" : "=r"(FSL));

  if (FSL != code) return EXIT_FAILURE;

  return EXIT_SUCCESS;

}

/**

   MALLOC TEST

   Works well with newlib malloc routine. Do some patterned tests.

*/

int memoryTest(int size)

{

  volatile void *alloc;

  int magic;

  alloc = malloc(size * sizeof(int)); // allocate 32 byte

  if (alloc == NULL)

    return EXIT_FAILURE;

  *(int *)alloc = MAGIC; // write to memory

  magic = *(int *)alloc; // read from memory

  return (magic == MAGIC) ? EXIT_SUCCESS : EXIT_FAILURE;

}

#ifdef __cplusplus

}

#endif

#endif