Subversion Repositories aemb

/*
 * $Id: aeMB_testbench.c,v 1.12 2007-11-18 19:41:45 sybreon Exp $
 * 
 * AEMB Function Verification C Testbench
 * Copyright (C) 2004-2007 Shawn Tan Ser Ngiap <shawn.tan@aeste.net>
 *  
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public License
 * as published by the Free Software Foundation; either version 2.1 of
 * the License, or (at your option) any later version.
 * 
 * This library 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
 * Lesser General Public License for more details.
 * 
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
 * USA
 *
 * DESCRIPTION 
 * It tests a whole gamut of operations and is tightly linked to the
 * ae68_testbench.v testbench module for verification.
 * 
 * HISTORY
 * $Log: not supported by cvs2svn $
 * Revision 1.11  2007/11/14 23:41:06  sybreon
 * Fixed minor interrupt test typo.
 *
 * Revision 1.10  2007/11/14 22:12:02  sybreon
 * Added interrupt test routine.
 *
 * Revision 1.9  2007/11/09 20:51:53  sybreon
 * Added GET/PUT support through a FSL bus.
 *
 * Revision 1.8  2007/11/03 08:40:18  sybreon
 * Minor code cleanup.
 *
 * Revision 1.7  2007/11/02 18:32:19  sybreon
 * Enable MSR_IE with software.
 *
 * Revision 1.6  2007/04/30 15:57:10  sybreon
 * Removed byte acrobatics.
 *
 * Revision 1.5  2007/04/27 15:17:59  sybreon
 * Added code documentation.
 * Added new tests that test floating point, modulo arithmetic and multiplication/division.
 *
 * Revision 1.4  2007/04/25 22:15:05  sybreon
 * Added support for 8-bit and 16-bit data types.
 *
 * Revision 1.3  2007/04/04 14:09:04  sybreon
 * Added initial interrupt/exception support.
 *
 * Revision 1.2  2007/04/04 06:07:45  sybreon
 * Fixed C code bug which passes the test
 *
 * Revision 1.1  2007/03/09 17:41:57  sybreon
 * initial import
 *
 */
 
/**
   INTERRUPT TEST
 
   This tests for the following:
   - Pointer addressing
   - Interrupt handling
 */
 
void int_handler (void) __attribute__ ((interrupt_handler));
volatile int service = 0xDEADDEAD;
 
void int_enable()
{
  int tmp;  
  asm volatile ("mfs %0, rmsr;" 
		"ori %1, %0, 0x02;"
		"mts rmsr, %1;"
		: "=r" (tmp)
		: "r" (tmp));  
}
 
void int_disable()
{
  int tmp;  
  asm volatile ("mfs %0, rmsr;" 
		"andi %1, %0, 0xFD;"
		"mts rmsr, %1;"
		: "=r" (tmp)
		: "r" (tmp));  
}
 
void int_service() 
{
  int* pio = (int*)0xFFFFFFFC;
  *pio = 0x52544E49; // "INTR"
  service = 0;
}
 
void int_handler()
{
  int_service();
}
 
/**
   INTERRUPT TEST ROUTINE
*/
int int_test ()
{
  // Delay loop until hardware interrupt triggers
  for (volatile int i=0; i < 999; i++) {
    if (service == 0) return 0;
  };
 
  return -1;
}
 
/**
   FIBONACCI TEST
   http://en.literateprograms.org/Fibonacci_numbers_(C)
 
   This tests for the following:
   - Recursion & Iteration
   - 32/16/8-bit data handling
*/
 
unsigned int fib_slow(unsigned int n)
{
  return n < 2 ? n : fib_slow(n-1) + fib_slow(n-2);
}
 
unsigned int fib_fast(unsigned int n)
{
  unsigned int a[3];
  unsigned int *p=a;
  unsigned int i;
 
  for(i=0; i<=n; ++i) {
    if(i<2) *p=i;
    else {
      if(p==a) *p=*(a+1)+*(a+2);
      else if(p==a+1) *p=*a+*(a+2);
      else *p=*a+*(a+1);
    }
    if(++p>a+2) p=a;
  }
 
  return p==a?*(p+2):*(p-1);
}
 
int fib_test(int max) {
  unsigned int n;
  unsigned int fast, slow;  
  // 32-bit LUT
  unsigned int fib_lut32[] = {
    0, 1, 1, 2, 3, 5, 8, 13, 21, 34, 55, 89, 144, 233
  };  
  // 16-bit LUT
  unsigned short fib_lut16[] = {
    0, 1, 1, 2, 3, 5, 8, 13, 21, 34, 55, 89, 144, 233
  };    
  // 8-bit LUT
  unsigned char fib_lut8[] = {
    0, 1, 1, 2, 3, 5, 8, 13, 21, 34, 55, 89, 144, 233
  };  
 
  for (n=0;n<max;n++) {
    slow = fib_slow(n);    
    fast = fib_fast(n);
    if ((slow != fast) || 
	(fast != fib_lut32[n]) || 
	(fast != fib_lut16[n]) || 
	(fast != fib_lut8[n])) {
      return -1;      
    }
  }      
  return 0;  
}
 
/**
   EUCLIDEAN TEST
   http://en.literateprograms.org/Euclidean_algorithm_(C)
 
   This tests for the following:
   - Modulo arithmetic
   - Goto
*/
 
int euclid_gcd(int a, int b) {
  if (b > a) goto b_larger;
  while (1) {
    a = a % b;
    if (a == 0) return b;
  b_larger:
    b = b % a;
    if (b == 0) return a;
  }
}
 
int euclid_test(int max) 
{
  int n;
  int euclid;
  // Random Numbers
  int euclid_a[] = {
    1804289383, 1681692777, 1957747793, 719885386, 596516649,
    1025202362, 783368690, 2044897763, 1365180540, 304089172,
    35005211, 294702567, 336465782, 278722862
  };  
  int euclid_b[] = {
    846930886, 1714636915, 424238335, 1649760492, 1189641421,
    1350490027, 1102520059, 1967513926, 1540383426, 1303455736,
    521595368, 1726956429, 861021530, 233665123
  };
 
  // GCD 
  int euclid_lut[] = {
    1, 1, 1, 2, 1, 1, 1, 1, 6, 4, 1, 3, 2, 1
  };
 
  for (n=0;n<max;n++) {
    euclid = euclid_gcd(euclid_a[n],euclid_b[n]);
    if (euclid != euclid_lut[n]) {
      return -1;
    }
  }
  return 0;
}
 
/**
   NEWTON-RHAPSON
   http://en.literateprograms.org/Newton-Raphson's_method_for_root_finding_(C)
 
   This tests for the following:
   - Multiplication & Division
   - Floating point arithmetic
   - Integer to Float conversion
*/
 
float newton_sqrt(float n)
{
  float x = 0.0;
  float xn = 0.0;  
  int iters = 0;  
  int i;
  for (i = 0; i <= (int)n; ++i)
    {
      float val = i*i-n;
      if (val == 0.0)
	return i;
      if (val > 0.0)
	{
	  xn = (i+(i-1))/2.0;
	  break;
	}
    }  
  while (!(iters++ >= 100
	   || x == xn))
    {
      x = xn;
      xn = x - (x * x - n) / (2 * x);
    }
  return xn;
}
 
int newton_test (int max) {
  int n;
  float newt;
  // 32-bit LUT
  float newt_lut[] = {
    0.000000000000000000000000,
    1.000000000000000000000000,
    1.414213538169860839843750,
    1.732050776481628417968750,
    2.000000000000000000000000,
    2.236068010330200195312500,
    2.449489831924438476562500,
    2.645751237869262695312500,
    2.828427076339721679687500,
    3.000000000000000000000000,
    3.162277698516845703125000,
    3.316624879837036132812500,
    3.464101552963256835937500,
    3.605551242828369140625000,
    3.741657495498657226562500
  };
 
  for (n=0;n<max;n++) {
    newt = newton_sqrt(n);
    if (newt != newt_lut[n]) {
      return -1;
    }
  } 
  return 0;
}
 
 
/**
   FSL TEST ROUTINE
*/
 
int fsl_test ()
{
  // TEST FSL1 ONLY
  int FSL = 0xCAFEF00D;
 
  asm ("PUT %0, RFSL1" :: "r"(FSL));
  asm ("GET %0, RFSL1" : "=r"(FSL));
 
  if (FSL != 0x01) return -1;
 
  asm ("PUT %0, RFSL31" :: "r"(FSL));
  asm ("GET %0, RFSL31" : "=r"(FSL));
 
  if (FSL != 0x1F) return -1;
 
  return 0;  
}
 
/**
   MAIN TEST PROGRAMME
 
   This is the main test procedure. It will output signals onto the
   MPI port that is checked by the testbench.
 */
 
 
int main () 
{
  // Message Passing Port
  int* mpi = (int*)0xFFFFFFFF;
 
  // Number of each test to run
  int max = 10;
 
  // Enable Global Interrupts
  int_enable();
 
  // INT TEST
  if (int_test() == -1) { *mpi = 0x4641494C; }
 
  // FSL TEST
  if (fsl_test() == -1) { *mpi = 0x4641494C; }
 
  // Fibonacci Test
  if (fib_test(max) == -1) { *mpi = 0x4641494C; }
 
  // Euclid Test
  if (euclid_test(max) == -1) { *mpi = 0x4641494C; }
 
  // Newton-Rhapson Test
  if (newton_test(max) == -1) { *mpi = 0x4641494C; }
 
  // Disable Global Interrupts
  int_disable();
  // ALL PASSED
  return 0;
}