diff options
Diffstat (limited to 'cpukit/rtems/src/taskmode.c')
| -rw-r--r-- | cpukit/rtems/src/taskmode.c | 21 |
1 files changed, 20 insertions, 1 deletions
diff --git a/cpukit/rtems/src/taskmode.c b/cpukit/rtems/src/taskmode.c index bbe59bb6df..3d6dee8105 100644 --- a/cpukit/rtems/src/taskmode.c +++ b/cpukit/rtems/src/taskmode.c @@ -24,6 +24,25 @@ #include <rtems/score/threadimpl.h> #include <rtems/config.h> +static void _RTEMS_Tasks_Dispatch_if_necessary( + Thread_Control *executing, + bool needs_asr_dispatching +) +{ + if ( _Thread_Dispatch_is_enabled() ) { + bool dispatch_necessary = needs_asr_dispatching; + + if ( !_Thread_Is_heir( executing ) && executing->is_preemptible ) { + dispatch_necessary = true; + _Thread_Dispatch_necessary = dispatch_necessary; + } + + if ( dispatch_necessary ) { + _Thread_Dispatch(); + } + } +} + rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, @@ -101,7 +120,7 @@ rtems_status_code rtems_task_mode( } } - _Thread_Dispatch_if_necessary( executing, needs_asr_dispatching ); + _RTEMS_Tasks_Dispatch_if_necessary( executing, needs_asr_dispatching ); return RTEMS_SUCCESSFUL; } |