diff options
author | Joel Sherrill <joel.sherrill@oarcorp.com> | 2014-07-15 12:37:36 -0500 |
---|---|---|
committer | Joel Sherrill <joel.sherrill@oarcorp.com> | 2014-07-15 13:42:30 -0500 |
commit | 32506647001a815e3c0daf25757d386104a07184 (patch) | |
tree | 8ab18c675b7617011d405e915e00d455d18ea334 /cpukit/score/src/threadqdequeue.c | |
parent | Thread Queue Priority Discipline Reimplemented with RBTree (diff) | |
download | rtems-32506647001a815e3c0daf25757d386104a07184.tar.bz2 |
Thread Queue: Merge discipline subroutines into main methods
There was a lot of duplication between the discipline subroutines.
With the transition to RBTrees for priority discipline, there were
only a few lines of source code manipulating the data structure
for FIFO and priority. Thus is made sense to fold these back
into the main methods.
As part of doing this all of the tests for discipline were changed
to be in the same order.
Diffstat (limited to 'cpukit/score/src/threadqdequeue.c')
-rw-r--r-- | cpukit/score/src/threadqdequeue.c | 72 |
1 files changed, 56 insertions, 16 deletions
diff --git a/cpukit/score/src/threadqdequeue.c b/cpukit/score/src/threadqdequeue.c index 93d5c07a1b..3b55e52e83 100644 --- a/cpukit/score/src/threadqdequeue.c +++ b/cpukit/score/src/threadqdequeue.c @@ -7,7 +7,7 @@ */ /* - * COPYRIGHT (c) 1989-2008. + * COPYRIGHT (c) 1989-2014. * On-Line Applications Research Corporation (OAR). * * The license and distribution terms for this file may be @@ -19,33 +19,73 @@ #include "config.h" #endif +#include <rtems/score/chainimpl.h> +#include <rtems/score/threadimpl.h> #include <rtems/score/threadqimpl.h> #include <rtems/score/isrlevel.h> +#include <rtems/score/rbtreeimpl.h> +#include <rtems/score/watchdogimpl.h> Thread_Control *_Thread_queue_Dequeue( Thread_queue_Control *the_thread_queue ) { - Thread_Control *(*dequeue_p)( Thread_queue_Control * ); Thread_Control *the_thread; ISR_Level level; Thread_blocking_operation_States sync_state; - if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) - dequeue_p = _Thread_queue_Dequeue_priority; - else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ - dequeue_p = _Thread_queue_Dequeue_fifo; - - the_thread = (*dequeue_p)( the_thread_queue ); + the_thread = NULL; _ISR_Disable( level ); - if ( !the_thread ) { - sync_state = the_thread_queue->sync_state; - if ( (sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || - (sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) { - the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; - the_thread = _Thread_Executing; - } + + /* + * Invoke the discipline specific dequeue method. + */ + if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_FIFO ) { + if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) { + the_thread = (Thread_Control *) + _Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo ); + } + } else { /* must be THREAD_QUEUE_DISCIPLINE_PRIORITY */ + RBTree_Node *first; + + first = _RBTree_Get( &the_thread_queue->Queues.Priority, RBT_LEFT ); + if ( first ) { + the_thread = _RBTree_Container_of( first, Thread_Control, RBNode ); + } + } + + /* + * We did not find a thread to unblock. + */ + if ( !the_thread ) { + sync_state = the_thread_queue->sync_state; + if ( (sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || + (sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) { + the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; + the_thread = _Thread_Executing; } - _ISR_Enable( level ); + _ISR_Enable( level ); + return NULL; + } + + /* + * We found a thread to unblock. + */ + the_thread->Wait.queue = NULL; + if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { + _ISR_Enable( level ); + } else { + _Watchdog_Deactivate( &the_thread->Timer ); + _ISR_Enable( level ); + (void) _Watchdog_Remove( &the_thread->Timer ); + } + + _Thread_Unblock( the_thread ); + +#if defined(RTEMS_MULTIPROCESSING) + if ( !_Objects_Is_local_id( the_thread->Object.id ) ) + _Thread_MP_Free_proxy( the_thread ); +#endif + return the_thread; } |