[rtems commit] score: Add missing idle thread exchanges

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    81659420b01f235a29a04be52ec5375d4d593f53
Changeset: http://git.rtems.org/rtems/commit/?id=81659420b01f235a29a04be52ec5375d4d593f53

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Wed Oct 20 08:23:07 2021 +0200

score: Add missing idle thread exchanges

Update #4531.

---

 cpukit/include/rtems/score/schedulersmpimpl.h | 18 ++++++++++++++++++
 1 file changed, 18 insertions(+)

diff --git a/cpukit/include/rtems/score/schedulersmpimpl.h b/cpukit/include/rtems/score/schedulersmpimpl.h
index 944b4fc..a074b53 100644
--- a/cpukit/include/rtems/score/schedulersmpimpl.h
+++ b/cpukit/include/rtems/score/schedulersmpimpl.h
@@ -1098,6 +1098,15 @@ static inline void _Scheduler_SMP_Schedule_highest_ready(
         victim,
         _Scheduler_SMP_Release_idle_thread
       );
+    } else if ( action == SCHEDULER_TRY_TO_SCHEDULE_DO_IDLE_EXCHANGE ) {
+      _Scheduler_SMP_Node_change_state(
+        highest_ready,
+        SCHEDULER_SMP_NODE_SCHEDULED
+      );
+
+      ( *move_from_ready_to_scheduled )( context, highest_ready );
+
+      _Scheduler_Exchange_idle_thread( highest_ready, victim );
     } else {
       _Assert( action == SCHEDULER_TRY_TO_SCHEDULE_DO_BLOCK );
 
@@ -1162,6 +1171,15 @@ static inline void _Scheduler_SMP_Preempt_and_schedule_highest_ready(
         victim,
         _Scheduler_SMP_Release_idle_thread
       );
+    } else if ( action == SCHEDULER_TRY_TO_SCHEDULE_DO_IDLE_EXCHANGE ) {
+      _Scheduler_SMP_Node_change_state(
+        highest_ready,
+        SCHEDULER_SMP_NODE_SCHEDULED
+      );
+
+      ( *move_from_ready_to_scheduled )( context, highest_ready );
+
+      _Scheduler_Exchange_idle_thread( highest_ready, victim );
     } else {
       _Assert( action == SCHEDULER_TRY_TO_SCHEDULE_DO_BLOCK );