minios: add trydown

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

1 files changed, 13 insertions, 0 deletions

diff --git a/extras/mini-os/include/semaphore.h b/extras/mini-os/include/semaphore.h
index 261cd7e5da..19f515a1f1 100644
--- a/extras/mini-os/include/semaphore.h
+++ b/extras/mini-os/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;