From cf0b8a52287ee7c747b1d5a7d77abdef1fb46f94 Mon Sep 17 00:00:00 2001 From: Alex Auvolat Date: Fri, 13 Feb 2015 20:28:54 +0100 Subject: Reorganize code in preparation for user apps. --- src/common/libkogata/mutex.c | 27 +++++++++++++++++++++++++++ 1 file changed, 27 insertions(+) create mode 100644 src/common/libkogata/mutex.c (limited to 'src/common/libkogata/mutex.c') diff --git a/src/common/libkogata/mutex.c b/src/common/libkogata/mutex.c new file mode 100644 index 0000000..b345ee5 --- /dev/null +++ b/src/common/libkogata/mutex.c @@ -0,0 +1,27 @@ +#include + +/* Internal use only. This function is atomic, meaning it cannot be interrupted by a system task switch. */ +static uint32_t atomic_exchange(uint32_t* ptr, uint32_t newval) { + uint32_t r; + asm volatile("xchg (%%ecx), %%eax" : "=a"(r) : "c"(ptr), "a"(newval)); + return r; +} + +void mutex_lock(uint32_t* mutex) { + while (atomic_exchange(mutex, MUTEX_LOCKED) == MUTEX_LOCKED) { + yield(); + } +} + +bool mutex_try_lock(uint32_t* mutex) { + if (atomic_exchange(mutex, MUTEX_LOCKED) == MUTEX_LOCKED) { + return false; + } + return true; +} + +void mutex_unlock(uint32_t* mutex) { + *mutex = MUTEX_UNLOCKED; +} + +/* vim: set ts=4 sw=4 tw=0 noet :*/ -- cgit v1.2.3