score: Assert scheduler index validity

Update #4844.

cpukit/include/rtems/score/mrspimpl.h

@@ -130,6 +130,7 @@ static inline Priority_Control _MRSP_Get_priority(
   uint32_t scheduler_index;
 
   scheduler_index = _Scheduler_Get_index( scheduler );
+  _Assert( scheduler_index < _Scheduler_Count );
   return mrsp->ceiling_priorities[ scheduler_index ];
 }
 
@@ -149,6 +150,7 @@ static inline void _MRSP_Set_priority(
   uint32_t scheduler_index;
 
   scheduler_index = _Scheduler_Get_index( scheduler );
+  _Assert( scheduler_index < _Scheduler_Count );
   mrsp->ceiling_priorities[ scheduler_index ] = new_priority;
 }
 

cpukit/include/rtems/score/threadimpl.h

@@ -1598,12 +1598,12 @@ static inline Scheduler_Node *_Thread_Scheduler_get_node_by_index(
   size_t                scheduler_index
 )
 {
+  _Assert( scheduler_index < _Scheduler_Count );
 #if defined(RTEMS_SMP)
   return (Scheduler_Node *)
     ( (uintptr_t) the_thread->Scheduler.nodes
       + scheduler_index * _Scheduler_Node_size );
 #else
-  _Assert( scheduler_index == 0 );
   (void) scheduler_index;
   return the_thread->Scheduler.nodes;
 #endif

cpukit/score/src/threadqops.c

@@ -291,6 +291,7 @@ static Thread_queue_Priority_queue *_Thread_queue_Priority_queue_by_index(
 )
 {
 #if defined(RTEMS_SMP)
+  _Assert( scheduler_index < _Scheduler_Count );
   return &heads->Priority[ scheduler_index ];
 #else
   (void) scheduler_index;