diff options
Diffstat (limited to 'c/src/lib/libcpu/mips/r46xx/vectorisrs/vectorisrs.c')
-rw-r--r-- | c/src/lib/libcpu/mips/r46xx/vectorisrs/vectorisrs.c | 46 |
1 files changed, 46 insertions, 0 deletions
diff --git a/c/src/lib/libcpu/mips/r46xx/vectorisrs/vectorisrs.c b/c/src/lib/libcpu/mips/r46xx/vectorisrs/vectorisrs.c new file mode 100644 index 0000000000..8f2a2f1c3c --- /dev/null +++ b/c/src/lib/libcpu/mips/r46xx/vectorisrs/vectorisrs.c @@ -0,0 +1,46 @@ +/* + * $Id$ + */ + +#include <rtems.h> +#include <stdlib.h> + +#define mips_get_cause( _cause ) \ + do { \ + asm volatile( "mfc0 %0, $13; nop" : "=g" (_cause) : ); \ + } while (0) + +#define CALL_ISR(_vector) \ + do { \ + if ( _ISR_Vector_table[_vector] ) \ + (_ISR_Vector_table[_vector])(_vector); \ + else \ + mips_default_exception(_vector); \ + } while (0) + +void mips_default_exception( int vector ) +{ + printk( "Unhandled exception %d\n", vector ); + rtems_fatal_error_occurred(1); +} + +void mips_vector_isr_handlers( void ) +{ + unsigned int sr; + unsigned int cause; + unsigned int i; + unsigned int mask; + + mips_get_sr( sr ); + mips_get_cause( cause ); + + cause &= (sr & SR_IMASK); + cause >>= CAUSE_IPSHIFT; + + /* XXX check this and think about it. */ + + for ( i=1, mask=0x80 ; i<=8 ; i++, mask >>= 1 ) { + if ( cause & mask ) + CALL_ISR( 8 - i ); + } +} |