1 files changed, 155 insertions, 0 deletions
diff --git a/libc/bionic/semaphore.c b/libc/bionic/semaphore.c
new file mode 100644
index 0000000..fa9de0e
--- /dev/null
+++ b/libc/bionic/semaphore.c
@@ -0,0 +1,155 @@
+/*
+ * Copyright (C) 2008 The Android Open Source Project
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *  * Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ *  * Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
+ * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+#include <semaphore.h>
+#include <errno.h>
+#include <sys/time.h>
+#include <sys/atomics.h>
+
+int sem_init(sem_t *sem, int pshared, unsigned int value)
+{
+    if (sem == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+
+    if (pshared != 0) {
+        errno = ENOSYS;
+        return -1;
+    }
+
+    sem->count = value;
+    return 0;
+}
+
+
+int sem_destroy(sem_t *sem)
+{
+    if (sem == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+    if (sem->count == 0) {
+        errno = EBUSY;
+        return -1;
+    }
+    return 0;
+}
+
+
+sem_t *sem_open(const char *name, int oflag, ...)
+{
+    name=name;
+    oflag=oflag;
+
+    errno = ENOSYS;
+    return SEM_FAILED;
+}
+
+
+int sem_close(sem_t *sem)
+{
+    if (sem == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+    errno = ENOSYS;
+    return -1;
+}
+
+
+int sem_unlink(const char * name)
+{
+    errno = ENOSYS;
+    return -1;
+}
+
+
+static int
+__atomic_dec_if_positive( volatile unsigned int*  pvalue )
+{
+    unsigned int  old;
+
+    do {
+        old = *pvalue;
+    }
+    while ( old != 0 && __atomic_cmpxchg( (int)old, (int)old-1, (volatile int*)pvalue ) != 0 );
+
+    return old;
+}
+
+int sem_wait(sem_t *sem)
+{
+    if (sem == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+
+    for (;;) {
+        if (__atomic_dec_if_positive(&sem->count))
+            break;
+
+        __futex_wait(&sem->count, 0, 0);
+    }
+    return 0;
+}
+
+int sem_post(sem_t *sem)
+{
+    if (sem == NULL)
+        return EINVAL;
+
+    if (__atomic_inc((volatile int*)&sem->count) == 0)
+        __futex_wake(&sem->count, 1);
+
+    return 0;
+}
+
+int  sem_trywait(sem_t *sem)
+{
+    if (sem == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+
+    if (__atomic_dec_if_positive(&sem->count) > 0) {
+        return 0;
+    } else {
+        return EAGAIN;
+    }
+}
+
+int  sem_getvalue(sem_t *sem, int *sval)
+{
+    if (sem == NULL || sval == NULL) {
+        errno = EINVAL;
+        return -1;
+    }
+
+    *sval = sem->count;
+    return 0;
+}