diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2015-02-17 20:49:10 +0100 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2015-03-06 14:58:13 +0100 |
commit | 8ed1b181aafcb1e96c25ed5a96293eed79044db7 (patch) | |
tree | a9579d5f07c1866b8bd3e908bf68748a6b71f520 /rtemsbsd/rtems/rtems-bsd-muteximpl.c | |
parent | atomic.h: Use <stdatomic.h> or <atomic> for SMP (diff) | |
download | rtems-libbsd-8ed1b181aafcb1e96c25ed5a96293eed79044db7.tar.bz2 |
rtems_bsd_mutex: SMP support via ISR locks
Diffstat (limited to '')
-rw-r--r-- | rtemsbsd/rtems/rtems-bsd-muteximpl.c | 70 |
1 files changed, 54 insertions, 16 deletions
diff --git a/rtemsbsd/rtems/rtems-bsd-muteximpl.c b/rtemsbsd/rtems/rtems-bsd-muteximpl.c index 2873e32c..275a9543 100644 --- a/rtemsbsd/rtems/rtems-bsd-muteximpl.c +++ b/rtemsbsd/rtems/rtems-bsd-muteximpl.c @@ -7,7 +7,7 @@ */ /* - * Copyright (c) 2014 embedded brains GmbH. All rights reserved. + * Copyright (c) 2014, 2015 embedded brains GmbH. All rights reserved. * * embedded brains GmbH * Dornierstr. 4 @@ -42,54 +42,92 @@ #include <rtems/score/schedulerimpl.h> #include <rtems/score/threaddispatch.h> +#include <rtems/score/threadqimpl.h> + +#define INTEND_TO_BLOCK \ + (THREAD_WAIT_CLASS_OBJECT | THREAD_WAIT_STATE_INTEND_TO_BLOCK) + +#define BLOCKED \ + (THREAD_WAIT_CLASS_OBJECT | THREAD_WAIT_STATE_BLOCKED) + +#define INTERRUPT_SATISFIED \ + (THREAD_WAIT_CLASS_OBJECT | THREAD_WAIT_STATE_INTERRUPT_SATISFIED) void rtems_bsd_mutex_lock_more(struct lock_object *lock, rtems_bsd_mutex *m, - Thread_Control *owner, Thread_Control *executing, ISR_Level level) + Per_CPU_Control *cpu_self, Thread_Control *owner, + Thread_Control *executing, ISR_lock_Context *lock_context) { if (owner == executing) { BSD_ASSERT(lock->lo_flags & LO_RECURSABLE); ++m->nest_level; - _ISR_Enable(level); + _ISR_lock_Release_and_ISR_enable(&m->lock, lock_context); } else { + bool success; + _RBTree_Insert(&m->rivals, &executing->RBNode, _Thread_queue_Compare_priority, false); ++executing->resource_count; - _Thread_Disable_dispatch(); - _ISR_Enable(level); + _Thread_Dispatch_disable_critical(cpu_self); + _Giant_Acquire(cpu_self); + /* Priority inheritance */ _Scheduler_Change_priority_if_higher(_Scheduler_Get(owner), owner, executing->current_priority, false); + + _Thread_Wait_flags_set(executing, INTEND_TO_BLOCK); + + _ISR_lock_Release_and_ISR_enable(&m->lock, lock_context); + _Thread_Set_state(executing, STATES_WAITING_FOR_MUTEX); - _Thread_Enable_dispatch(); + success = _Thread_Wait_flags_try_change(executing, + INTEND_TO_BLOCK, BLOCKED); + if (!success) { + _Thread_Unblock(executing); + } + + _Giant_Release(cpu_self); + _Thread_Dispatch_enable(cpu_self); } } void rtems_bsd_mutex_unlock_more(rtems_bsd_mutex *m, Thread_Control *owner, - int keep_priority, RBTree_Node *first, ISR_Level level) + int keep_priority, RBTree_Node *first, ISR_lock_Context *lock_context) { - BSD_ASSERT(owner == _Thread_Executing); - if (first != NULL) { Thread_Control *new_owner; + bool success; _RBTree_Extract(&m->rivals, first); new_owner = THREAD_RBTREE_NODE_TO_THREAD(first); m->owner = new_owner; - _Thread_Disable_dispatch(); - _ISR_Enable(level); - - _Thread_Clear_state(new_owner, STATES_WAITING_FOR_MUTEX); - - _Thread_Enable_dispatch(); + success = _Thread_Wait_flags_try_change_critical(new_owner, + INTEND_TO_BLOCK, INTERRUPT_SATISFIED); + if (success) { + _ISR_lock_Release_and_ISR_enable(&m->lock, + lock_context); + } else { + Per_CPU_Control *cpu_self; + + cpu_self = _Per_CPU_Get(); + _Thread_Dispatch_disable_critical(cpu_self); + _ISR_lock_Release_and_ISR_enable(&m->lock, + lock_context); + _Giant_Acquire(cpu_self); + + _Thread_Unblock(new_owner); + + _Giant_Release(cpu_self); + _Thread_Dispatch_enable(cpu_self); + } } else { - _ISR_Enable(level); + _ISR_lock_Release_and_ISR_enable(&m->lock, lock_context); } if (!keep_priority) { |