diff options
Diffstat (limited to 'libgloss/sparc_leon/kernel_mutex.c')
-rw-r--r-- | libgloss/sparc_leon/kernel_mutex.c | 107 |
1 files changed, 107 insertions, 0 deletions
diff --git a/libgloss/sparc_leon/kernel_mutex.c b/libgloss/sparc_leon/kernel_mutex.c new file mode 100644 index 000000000..a81344932 --- /dev/null +++ b/libgloss/sparc_leon/kernel_mutex.c @@ -0,0 +1,107 @@ +/* + * Copyright (c) 2011 Aeroflex Gaisler + * + * BSD license: + * + * Permission is hereby granted, free of charge, to any person obtaining a copy + * of this software and associated documentation files (the "Software"), to deal + * in the Software without restriction, including without limitation the rights + * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell + * copies of the Software, and to permit persons to whom the Software is + * furnished to do so, subject to the following conditions: + * + * The above copyright notice and this permission notice shall be included in + * all copies or substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL + * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER + * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN + * THE SOFTWARE. + */ + + +#include <asm-leon/queue.h> +/*#include <sys/fsu_pthread_queue.h>*/ +#include <asm-leon/contextswitch.h> +#include <asm-leon/leonbare_kernel.h> +#include <asm-leon/leonbare_debug.h> +#include <asm-leon/stack.h> +#include <asm-leon/leonstack.h> +#include <asm-leon/irq.h> + +leonbare_mutex_t +leonbare_mutex_init (leonbare_mutex_t m) +{ + m->mx_owner_cnt = 0; + m->mx_owner = 0; + LBTAILQ_INIT (&(m->mx_threads)); + + LEONBARE_PROTECT_KERNEL_START (); + { + LBTAILQ_INSERT_TAIL (LEONBARE_KR_ALLM, m, mx_allm); + } + LEONBARE_PROTECT_KERNEL_END (); + +} + +int +_self__leonbare_mutex_lock (leonbare_mutex_t m, int wait) +{ + int ret = LEONBARE_MUTEX_LOCK_OK; + leonbare_thread_t c; + + LEONBARE_PROTECT_MUTEXSTRUCT_START (m); + while (1) + { + if (LEONBARE_MUTEX_OWNER_GET (m) == 0) + { + LEONBARE_MUTEX_OWNER_SET (m, LEONBARE_KR_CURRENT); + LEONBARE_MUTEX_OWNER_CNT_SET (m, 0); + LBTAILQ_INSERT_TAIL (&c->th_mutex_locked, m, mx_locked); + ret = LEONBARE_MUTEX_LOCK_OK; + break; + } + else if (m->mx_owner == LEONBARE_KR_CURRENT) + { + m->mx_owner_cnt++; + ret = LEONBARE_MUTEX_LOCK_OK; + break; + } + LBTAILQ_INSERT_TAIL (&m->mx_threads, c, th_mutex); + current_suspend (); + } + LEONBARE_PROTECT_MUTEXSTRUCT_END (m); + return ret; +} + +int +leonbare_mutex_unlock (leonbare_mutex_t m) +{ + int ret = LEONBARE_MUTEX_UNLOCK_ERROR; + leonbare_thread_t c, h; + + LEONBARE_PROTECT_MUTEXSTRUCT_START (m); + { + c = LEONBARE_KR_CURRENT; + if (m->mx_owner != c) + { + ret = LEONBARE_MUTEX_UNLOCK_OK; + } + else if (m->mx_owner == c && m->mx_owner_cnt) + { + m->mx_owner_cnt--; + ret = LEONBARE_MUTEX_UNLOCK_OK; + } + else if ((h = LBTAILQ_FIRST (&m->mx_threads))) + { + LBTAILQ_REMOVE (&m->mx_threads, h, th_mutex); + leonbare_thread_resume (h); + ret = LEONBARE_MUTEX_UNLOCK_OK; + } + } + LEONBARE_PROTECT_MUTEXSTRUCT_END (m); + return ret; +} |