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