Subversion Repositories or1k

/* GPIO test */
 
#include "spr_defs.h"
#include "support.h"
#include "int.h"
 
/* Relative Register Addresses */
#define RGPIO_IN        0x00
#define RGPIO_OUT       0x04
#define RGPIO_OE        0x08
#define RGPIO_INTE      0x0C
#define RGPIO_PTRIG     0x10
#define RGPIO_AUX       0x14
#define RGPIO_CTRL      0x18
#define RGPIO_INTS      0x1C
 
/* Fields inside RGPIO_CTRL */
#define RGPIO_CTRL_ECLK      0x00000001
#define RGPIO_CTRL_NEC       0x00000002
#define RGPIO_CTRL_INTE      0x00000004
#define RGPIO_CTRL_INTS      0x00000008
 
#define GPIO_BASE 0xB0000000LU
 
#define GPIO_INT_LINE 23 /* To which interrupt is GPIO connected */
 
typedef volatile unsigned long *GPIO_REG;
 
GPIO_REG rgpio_in = (unsigned long *)(GPIO_BASE + RGPIO_IN),
  rgpio_out = (unsigned long *)(GPIO_BASE + RGPIO_OUT),
  rgpio_oe = (unsigned long *)(GPIO_BASE + RGPIO_OE),
  rgpio_inte = (unsigned long *)(GPIO_BASE + RGPIO_INTE),
  rgpio_ptrig = (unsigned long *)(GPIO_BASE + RGPIO_PTRIG),
  rgpio_aux = (unsigned long *)(GPIO_BASE + RGPIO_AUX),
  rgpio_ctrl = (unsigned long *)(GPIO_BASE + RGPIO_CTRL),
  rgpio_ints = (unsigned long *)(GPIO_BASE + RGPIO_INTS);
 
/* fails if x is false */
#define ASSERT(x) ((x)?1: fail (__FILE__, __LINE__))
 
static void fail (char *file, int line)
{
  printf( "Test failed in %s:%i\n", file, line );
  report( 0xeeeeeeee );
  exit( 1 );
}
 
 
static void wait_input( unsigned long value )
{
  unsigned long first = *rgpio_in;
  if ( first == value )
    return;
  while ( 1 ) {
    unsigned long curr = *rgpio_in;
    if ( curr == value )
      return;
    if ( curr != first ) {
      printf( "While waiting for 0x%08lX, input changed from 0x%08lX to 0x%08lX\n", value, first, curr );
      ASSERT( 0 );
    }
  }
}
 
static volatile unsigned int_count = 0;
 
 
static void gpio_interrupt( void *arg )
{
  ++ int_count;
}
 
static void init_interrupts( void )
{
  int_init();
  int_add( GPIO_INT_LINE, gpio_interrupt, 0);
 
  /* Enable interrupts */
  mtspr( SPR_SR, mfspr(SPR_SR) | SPR_SR_IEE );
}
 
 
 
static void test_registers( void )
{
  printf( "Testing initial values of all registers\n" );
  ASSERT( *rgpio_oe == 0 );
  ASSERT( *rgpio_inte == 0 );
  ASSERT( *rgpio_ptrig == 0 );
  ASSERT( *rgpio_ctrl == 0 );
  ASSERT( *rgpio_ints == 0 );
 
  printf( "Verifying that RGPIO_IN is read-only\n" );
  {
    unsigned long value = *rgpio_in;
    unsigned i;
    *rgpio_in = ~value;
    ASSERT( *rgpio_in == value );
 
    for ( i = 0; i < 32; ++ i ) {
      *rgpio_in = 1LU << i;
      ASSERT( *rgpio_in == value );
    }
  }
}
 
 
static void test_simple_io( void )
{
  unsigned i;
  unsigned long oe;
 
  printf( "Testing simple I/O\n" );
  for ( i = 1, oe = 1; i < 31; ++ i, oe = (oe << 1) | 1 ) {
    *rgpio_oe = oe;
 
    *rgpio_out = 0xFFFFFFFF;
    wait_input( 0xFFFFFFFF );
 
    *rgpio_out = 0x00000000;
    wait_input( 0x00000000 );
  }
}
 
 
static void clear_interrupt_status( void )
{
  *rgpio_ctrl &= ~RGPIO_CTRL_INTS;
  *rgpio_ints = 0;
}
 
static void assert_good_interrupt( unsigned expected_count, unsigned long expected_mask )
{
  ASSERT( int_count == expected_count );
  ASSERT( (*rgpio_ctrl & RGPIO_CTRL_INTS) == RGPIO_CTRL_INTS );
  ASSERT( (*rgpio_in & ~*rgpio_oe) == expected_mask );
  ASSERT( (*rgpio_ints & ~*rgpio_oe) == expected_mask );
}
 
static void test_interrupts( void )
{
  unsigned i;
 
  printf( "Testing interrupts\n" );
 
  *rgpio_oe = 0x80000000;
  int_count = 0;
  *rgpio_inte = 0x7fffffff;
  *rgpio_ptrig = 0x7fffffff;
  *rgpio_ctrl = RGPIO_CTRL_INTE;
 
  *rgpio_out = 0x80000000;
  for ( i = 0; i < 31; ++ i ) {
    /* Wait for interrupt */
    while ( int_count <= i );
    assert_good_interrupt( i + 1, 1LU << i );
    clear_interrupt_status();
    *rgpio_out = (i % 2) ? 0x80000000 : 0;
  }
 
  /* Return things to normal */
  *rgpio_ctrl = 0;
}
 
static void test_external_clock( void )
{
  unsigned i;
  printf( "Testing external clock\n" );
 
  *rgpio_oe = 0x80000000;
  *rgpio_inte = 0x7fffffff;
  *rgpio_ptrig = 0x7fffffff;
 
  /* Test positive edge */
  int_count = 0;
  *rgpio_ctrl = RGPIO_CTRL_INTE;
  *rgpio_out = 0x80000000;
  for ( i = 0; i < 31; ++ i ) {
    while ( int_count <= i );
    assert_good_interrupt( i + 1, 1LU << i );
    clear_interrupt_status();
    *rgpio_out = (i % 2) ? 0x80000000 : 0;
  }
 
  /* Test negative edge */
  int_count = 0;
  *rgpio_ctrl = RGPIO_CTRL_INTE | RGPIO_CTRL_NEC;
  *rgpio_out = 0x80000000;
  for ( i = 0; i < 31; ++ i ) {
    while ( int_count <= i );
    assert_good_interrupt( i + 1, 1LU << i );
    clear_interrupt_status();
    *rgpio_out = (i % 2) ? 0x80000000 : 0;
  }
 
  /* Return things to normal */
  *rgpio_ctrl = 0;
}
 
 
static void endshake( void )
{
  printf( "Finishing simulation\n" );
  *rgpio_oe = 0xffff0000;
  *rgpio_out = 0x12340000;
  wait_input( 0x12345678 );
  *rgpio_oe = 0xffffffff;
  *rgpio_out = 0xDeadDead;
}
 
 
int main()
{
  printf( "Starting GPIO test\n" );
 
  init_interrupts();
 
  test_registers();
  test_simple_io();
  test_interrupts();
  test_external_clock();
  endshake();
 
  printf( "Ending GPIO test\n" );
 
  report (0xdeaddead);
  return 0;
}