diff options
Diffstat (limited to 'c/src/lib/libcpu/sh/sh7032/score')
-rw-r--r-- | c/src/lib/libcpu/sh/sh7032/score/cpu_asm.c | 22 |
1 files changed, 13 insertions, 9 deletions
diff --git a/c/src/lib/libcpu/sh/sh7032/score/cpu_asm.c b/c/src/lib/libcpu/sh/sh7032/score/cpu_asm.c index b9caadb242..cc94c11693 100644 --- a/c/src/lib/libcpu/sh/sh7032/score/cpu_asm.c +++ b/c/src/lib/libcpu/sh/sh7032/score/cpu_asm.c @@ -287,6 +287,8 @@ void __ISR_Handler( unsigned32 vector) _CPU_ISR_Disable( level ); + _Thread_Dispatch_disable_level--; + _ISR_Nest_level--; #if( CPU_HAS_SOFTWARE_INTERRUPT_STACK == TRUE) @@ -296,16 +298,18 @@ void __ISR_Handler( unsigned32 vector) stack_ptr = _old_stack_ptr; #endif - _Thread_Dispatch_disable_level--; - _CPU_ISR_Enable( level ); - if ( _Thread_Dispatch_disable_level == 0 ) - { - if(( _Context_Switch_necessary) || (! _ISR_Signals_to_thread_executing)) - { - _ISR_Signals_to_thread_executing = FALSE; - _Thread_Dispatch(); - } + if ( _ISR_Nest_level ) + return; + + if ( _Thread_Dispatch_disable_level ) { + _ISR_Signals_to_thread_executing = FALSE; + return; + } + + if ( _Context_Switch_necessary || _ISR_Signals_to_thread_executing ) { + _ISR_Signals_to_thread_executing = FALSE; + _Thread_Dispatch(); } } |