diff options
Diffstat (limited to 'cpukit/score/cpu/lm32/irq.c')
-rw-r--r-- | cpukit/score/cpu/lm32/irq.c | 93 |
1 files changed, 93 insertions, 0 deletions
diff --git a/cpukit/score/cpu/lm32/irq.c b/cpukit/score/cpu/lm32/irq.c new file mode 100644 index 0000000000..a6fe8fd18b --- /dev/null +++ b/cpukit/score/cpu/lm32/irq.c @@ -0,0 +1,93 @@ +/* + * lm32 interrupt handler + * + * Derived from c4x/irq.c and nios2/irq.c + * + * COPYRIGHT (c) 1989-2009. + * On-Line Applications Research Corporation (OAR). + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.com/license/LICENSE. + * + * $Id$ + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include <rtems/system.h> +#include <rtems/score/cpu.h> +#include <rtems/score/thread.h> +#include <rtems/score/isr.h> +#include <rtems/score/percpu.h> + +/* + * This routine provides the RTEMS interrupt management. + * + * Upon entry, interrupts are disabled + */ + +#if( CPU_HAS_SOFTWARE_INTERRUPT_STACK == TRUE) + unsigned long *_old_stack_ptr; +#endif + +void *_exception_stack_frame; + +register unsigned long *stack_ptr __asm__ ("sp"); + +void __ISR_Handler(uint32_t vector, CPU_Interrupt_frame *ifr) +{ + register uint32_t level; + _exception_stack_frame = NULL; + + /* Interrupts are disabled upon entry to this Handler */ + + _Thread_Dispatch_disable_level++; + +#if( CPU_HAS_SOFTWARE_INTERRUPT_STACK == TRUE) + if ( _ISR_Nest_level == 0 ) { + /* Install irq stack */ + _old_stack_ptr = stack_ptr; + stack_ptr = _CPU_Interrupt_stack_high - 4; + } +#endif + + _ISR_Nest_level++; + + if ( _ISR_Vector_table[ vector] ) + { + (*_ISR_Vector_table[ vector ])(vector, ifr); + }; + + /* Make sure that interrupts are disabled again */ + _CPU_ISR_Disable( level ); + + _ISR_Nest_level--; + +#if( CPU_HAS_SOFTWARE_INTERRUPT_STACK == TRUE) + if( _ISR_Nest_level == 0) + stack_ptr = _old_stack_ptr; +#endif + + _Thread_Dispatch_disable_level--; + + _CPU_ISR_Enable( level ); + + if ( _ISR_Nest_level ) + return; + + if ( _Thread_Dispatch_necessary ) { + + /* save off our stack frame so the context switcher can get to it */ + _exception_stack_frame = ifr; + + _Thread_Dispatch(); + + /* and make sure its clear in case we didn't dispatch. if we did, its + * already cleared */ + _exception_stack_frame = NULL; + } +} + |