1 files changed, 36 insertions, 0 deletions
diff --git a/mdk-stage1/dietlibc/libpthread/pthread_mutex_trylock.c b/mdk-stage1/dietlibc/libpthread/pthread_mutex_trylock.c
new file mode 100644
index 000000000..fcf63f75e
--- /dev/null
+++ b/mdk-stage1/dietlibc/libpthread/pthread_mutex_trylock.c
@@ -0,0 +1,36 @@
+#include <unistd.h>
+#include <sched.h>
+#include <errno.h>
+
+#include <pthread.h>
+#include "thread_internal.h"
+
+/* will never return EINVAL ! */
+
+int pthread_mutex_trylock(pthread_mutex_t *mutex)
+{
+  _pthread_descr this;
+
+  __THREAD_INIT();
+
+  this = __thread_self();
+
+  if (this!=mutex->owner) {
+    /* wait for mutex to free */
+    if (__pthread_trylock(&(mutex->lock))) {
+      (*(__errno_location()))=EBUSY;
+      return -1;
+    }
+
+    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;
+}