minios: add trydown

Signed-off-by: Samuel Thibault <samuel.thibault@eu.citrix.com>

diff --git a/include/semaphore.h b/include/semaphore.h
index 261cd7e5dabf5e7351c27eb063e73d26be2a0cee..19f515a1f162a29b22cd8699e56bc85db1bbcf04 100644 (file)
--- a/include/semaphore.h
+++ b/include/semaphore.h
@@ -49,6 +49,19 @@ static inline void init_SEMAPHORE(struct semaphore *sem, int count)
 
 #define init_MUTEX(sem) init_SEMAPHORE(sem, 1)
 
+static inline int trydown(struct semaphore *sem)
+{
+    unsigned long flags;
+    int ret = 0;
+    local_irq_save(flags);
+    if (sem->count > 0) {
+        ret = 1;
+        sem->count--;
+    }
+    local_irq_restore(flags);
+    return ret;
+}
+
 static void inline down(struct semaphore *sem)
 {
     unsigned long flags;