Initial revision

1 files changed, 33 insertions, 0 deletions

diff --git a/mdk-stage1/dietlibc/libpthread/pthread_mutex_lock.c b/mdk-stage1/dietlibc/libpthread/pthread_mutex_lock.c
new file mode 100644
index 000000000..0c3ade9e8
--- /dev/null
+++ b/mdk-stage1/dietlibc/libpthread/pthread_mutex_lock.c
@@ -0,0 +1,33 @@
+#include <unistd.h>
+#include <sched.h>
+#include <errno.h>
+
+#include <pthread.h>
+#include "thread_internal.h"
+
+/* will never return EINVAL ! */
+
+int pthread_mutex_lock(pthread_mutex_t *mutex)
+{
+  _pthread_descr this;
+
+  __THREAD_INIT();
+
+  this = __thread_self();
+
+  if (this!=mutex->owner) {
+    /* wait for mutex to free */
+    __pthread_lock(&(mutex->lock));
+
+    mutex->owner=this;
+  }
+  else if (mutex->kind==PTHREAD_MUTEX_ERRORCHECK_NP)
+  {
+    (*(__errno_location()))=EDEADLK;
+    return -1;
+  }
+
+  if (mutex->kind==PTHREAD_MUTEX_RECURSIVE_NP) ++(mutex->count);
+
+  return 0;
+}