diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2015-05-01 20:52:51 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2015-05-19 12:00:46 +0200 |
commit | e76c517d0726f91447e0e2c3ba14c00896456e89 (patch) | |
tree | caa429239407c3cfa4cfd8a4e68aae25e893ca35 /cpukit/score/src | |
parent | score: Fine grained locking for message queues (diff) | |
download | rtems-e76c517d0726f91447e0e2c3ba14c00896456e89.tar.bz2 |
score: Fine grained locking for semaphores
Update #2273.
Diffstat (limited to 'cpukit/score/src')
-rw-r--r-- | cpukit/score/src/coresemsurrender.c | 34 | ||||
-rw-r--r-- | cpukit/score/src/mpci.c | 7 |
2 files changed, 27 insertions, 14 deletions
diff --git a/cpukit/score/src/coresemsurrender.c b/cpukit/score/src/coresemsurrender.c index 58ba6a3fdf..9b3d8fd4be 100644 --- a/cpukit/score/src/coresemsurrender.c +++ b/cpukit/score/src/coresemsurrender.c @@ -20,34 +20,46 @@ #endif #include <rtems/score/coresemimpl.h> -#include <rtems/score/objectimpl.h> CORE_semaphore_Status _CORE_semaphore_Surrender( CORE_semaphore_Control *the_semaphore, Objects_Id id, - CORE_semaphore_API_mp_support_callout api_semaphore_mp_support + CORE_semaphore_API_mp_support_callout api_semaphore_mp_support, + ISR_lock_Context *lock_context ) { Thread_Control *the_thread; - ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; - if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { + _Thread_queue_Acquire_critical( &the_semaphore->Wait_queue, lock_context ); + + the_thread = _Thread_queue_First_locked( &the_semaphore->Wait_queue ); + if ( the_thread != NULL ) { +#if defined(RTEMS_MULTIPROCESSING) + _Thread_Dispatch_disable(); +#endif + + _Thread_queue_Extract_critical( + &the_semaphore->Wait_queue, + the_thread, + lock_context + ); #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); -#endif + _Thread_Dispatch_enable( _Per_CPU_Get() ); +#endif } else { - _ISR_Disable( level ); - if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) - the_semaphore->count += 1; - else - status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; - _ISR_Enable( level ); + if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) + the_semaphore->count += 1; + else + status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; + + _Thread_queue_Release( &the_semaphore->Wait_queue, lock_context ); } return status; diff --git a/cpukit/score/src/mpci.c b/cpukit/score/src/mpci.c index 7fd77f7597..6b3bc7fbd8 100644 --- a/cpukit/score/src/mpci.c +++ b/cpukit/score/src/mpci.c @@ -329,9 +329,10 @@ Thread _MPCI_Receive_server( void _MPCI_Announce ( void ) { - _Thread_Disable_dispatch(); - (void) _CORE_semaphore_Surrender( &_MPCI_Semaphore, 0, 0 ); - _Thread_Enable_dispatch(); + ISR_lock_Context lock_context; + + _ISR_lock_ISR_disable( &lock_context ); + (void) _CORE_semaphore_Surrender( &_MPCI_Semaphore, 0, 0, &lock_context ); } void _MPCI_Internal_packets_Send_process_packet ( |