microblaze port

[musl] / src / thread / sem_trywait.c

diff --git a/src/thread/sem_trywait.c b/src/thread/sem_trywait.c
index d0e928e..04edf46 100644 (file)
--- a/src/thread/sem_trywait.c
+++ b/src/thread/sem_trywait.c
@@ -3,9 +3,11 @@
 
 int sem_trywait(sem_t *sem)
 {
-       int val = a_fetch_add(sem->__val, -1);
-       if (val > 0) return 0;
-       a_inc(sem->__val);
+       int val;
+       while ((val=sem->__val[0]) > 0) {
+               int new = val-1-(val==1 && sem->__val[1]);
+               if (a_cas(sem->__val, val, new)==val) return 0;
+       }
        errno = EAGAIN;
        return -1;
 }