diff options
Diffstat (limited to 'c/src/lib/libcpu/mips/tx39/vectorisrs/vectorisrs.c')
-rw-r--r-- | c/src/lib/libcpu/mips/tx39/vectorisrs/vectorisrs.c | 41 |
1 files changed, 41 insertions, 0 deletions
diff --git a/c/src/lib/libcpu/mips/tx39/vectorisrs/vectorisrs.c b/c/src/lib/libcpu/mips/tx39/vectorisrs/vectorisrs.c new file mode 100644 index 0000000000..15a4753123 --- /dev/null +++ b/c/src/lib/libcpu/mips/tx39/vectorisrs/vectorisrs.c @@ -0,0 +1,41 @@ +/* + * $Id$ + */ + +#include <rtems.h> +#include <stdlib.h> +#include <libcpu/tx3904.h> + +#define mips_get_cause( _cause ) \ + do { \ + asm volatile( "mfc0 %0, $13; nop" : "=g" (_cause) : ); \ + } while (0) + +#define CALL_ISR(_vector) \ + (_ISR_Vector_table[_vector])(_vector); + +void mips_vector_isr_handlers( void ) +{ + unsigned int sr; + unsigned int cause; + + mips_get_sr( sr ); + mips_get_cause( cause ); + + cause &= (sr & SR_IMASK); + cause >>= CAUSE_IPSHIFT; + + if ( cause & 0x80 ) /* IP[5] ==> INT0 */ + CALL_ISR( TX3904_IRQ_INT0 ); + + if ( cause & 0x40 ) { /* (IP[4] == 1) ==> IP[0-3] are valid */ + unsigned int v = (cause >> 2) & 0x0f; + CALL_ISR( v ); + } + + if ( cause & 0x02 ) /* SW[0] */ + CALL_ISR( TX3904_IRQ_SOFTWARE_1 ); + + if ( cause & 0x01 ) /* IP[1] */ + CALL_ISR( TX3904_IRQ_SOFTWARE_2 ); +} |