Initial commit: TXW82x FPV v2.7.0.7-42229 SDK + project sources

sdk/lib/posix/pthread_mutex.c

@@ -0,0 +1,198 @@
+#include "sys_config.h"
+#include "typesdef.h"
+#include "errno.h"
+#include "osal/semaphore.h"
+#include "osal/task.h"
+#include "osal/string.h"
+#include "osal/timer.h"
+#include "osal/mutex.h"
+#include "lib/common/rbuffer.h"
+#include "lib/posix/pthread.h"
+
+#ifdef TXWSDK_POSIX
+
+int pthread_mutex_destroy(pthread_mutex_t *mutex)
+{
+#ifdef __MINILIBC__
+    os_mutex_t *m = (os_mutex_t *)(mutex->mutex);
+    if (m) {
+        os_mutex_del(m);
+        os_free(m);
+    }
+
+    mutex->initted = 0;
+    mutex->mutex = NULL;
+    mutex->attr = NULL;
+#else
+    os_mutex_t *m = (os_mutex_t *)(*mutex);
+    if (m) {
+        os_mutex_del(m);
+        os_free(m);
+    }
+#endif
+    return 0;
+}
+
+int pthread_mutex_init(pthread_mutex_t *mutex, const pthread_mutexattr_t *attr)
+{
+    os_mutex_t *m;
+
+#ifdef __MINILIBC__
+    if (NULL == mutex) {
+        return -EINVAL;
+    }
+
+    os_memset(mutex, 0, sizeof(pthread_mutex_t));
+    m = os_zalloc(sizeof(os_mutex_t));
+    if (m == NULL) {
+        pthread_err("alloc fail\r\n");
+        return -ENOMEM;
+    }
+
+    os_mutex_init(m);
+    mutex->initted = 1;
+    mutex->mutex = m;
+    mutex->attr = (pthread_mutexattr_t *)attr;
+#else
+    if (mutex == NULL) {
+        return -EINVAL;
+    }
+
+    m = os_zalloc(sizeof(os_mutex_t));
+    if (m == NULL) {
+        pthread_err("alloc fail\r\n");
+        return -ENOMEM;
+    }
+
+    os_mutex_init(m);
+    *mutex = (pthread_mutex_t)m;
+#endif
+    return RET_OK;
+}
+
+int pthread_mutex_lock(pthread_mutex_t *mutex)
+{
+#ifdef __MINILIBC__
+    if (NULL == mutex) {
+        return -EINVAL;
+    }
+
+    if (NULL == mutex->mutex) {
+        pthread_mutex_init(mutex, NULL);
+    }
+
+    return os_mutex_lock((os_mutex_t *)(mutex->mutex), osWaitForever);
+#else
+    os_mutex_t *m;
+
+    if (*mutex == 0) {
+        pthread_mutex_init(mutex, NULL);
+    }
+    m = (os_mutex_t *)(*mutex);
+    if (m) {
+        return os_mutex_lock(m, osWaitForever);
+    }
+    return -EINVAL;
+#endif
+}
+
+int pthread_mutex_timedlock(pthread_mutex_t *mutex, const struct timespec *abstime)
+{
+#ifdef __MINILIBC__
+    if (NULL == mutex) {
+        return -EINVAL;
+    }
+
+    if (NULL == mutex->mutex) {
+        pthread_mutex_init(mutex, NULL);
+    }
+
+    return os_mutex_lock((os_mutex_t *)(mutex->mutex), pthread_timespec_delta(abstime));
+#else
+    os_mutex_t *m;
+
+    if (*mutex == 0) {
+        pthread_mutex_init(mutex, NULL);
+    }
+    m = (os_mutex_t *)(*mutex);
+    if (m) {
+        return os_mutex_lock(m, pthread_timespec_delta(abstime));
+    }
+    return -EINVAL;
+#endif
+}
+
+int pthread_mutex_trylock(pthread_mutex_t *mutex)
+{
+#ifdef __MINILIBC__
+    if (NULL == mutex) {
+        return -EINVAL;
+    }
+
+    if (NULL == mutex->mutex) {
+        pthread_mutex_init(mutex, NULL);
+    }
+
+    return os_mutex_lock((os_mutex_t *)(mutex->mutex), 0);
+#else
+    os_mutex_t *m;
+
+    if (*mutex == 0) {
+        pthread_mutex_init(mutex, NULL);
+    }
+    m = (os_mutex_t *)(*mutex);
+    if (m) {
+        return os_mutex_lock(m, 0);
+    }
+    return -EINVAL;
+#endif
+}
+
+int pthread_mutex_unlock(pthread_mutex_t *mutex)
+{
+#ifdef __MINILIBC__
+    if (NULL == mutex) {
+        return -EINVAL;
+    }
+
+    if (NULL == mutex->mutex) {
+        pthread_mutex_init(mutex, NULL);
+    }
+
+    return os_mutex_unlock((os_mutex_t *)(mutex->mutex));
+#else
+    os_mutex_t *m;
+
+    if (*mutex == 0) {
+        pthread_mutex_init(mutex, NULL);
+    }
+    m = (os_mutex_t *)(*mutex);
+    if (m) {
+        return os_mutex_unlock(m);
+    }
+    return -EINVAL;
+#endif
+}
+
+int pthread_mutexattr_destroy(pthread_mutexattr_t *attr)
+{
+    return 0;
+}
+
+int pthread_mutexattr_gettype(const pthread_mutexattr_t *attr, int *type)
+{
+    return 0;
+}
+
+int pthread_mutexattr_init(pthread_mutexattr_t *attr)
+{
+    return 0;
+}
+
+int pthread_mutexattr_settype(pthread_mutexattr_t *attr, int type)
+{
+    return 0;
+}
+
+#endif
+