1 files changed, 21 insertions, 0 deletions
diff --git a/mdk-stage1/dietlibc/libpthread/pthread_setschedparam.c b/mdk-stage1/dietlibc/libpthread/pthread_setschedparam.c
new file mode 100644
index 000000000..df007c408
--- /dev/null
+++ b/mdk-stage1/dietlibc/libpthread/pthread_setschedparam.c
@@ -0,0 +1,21 @@
+#include <unistd.h>
+#include <errno.h>
+
+#include <pthread.h>
+#include "thread_internal.h"
+
+int pthread_setschedparam(pthread_t target_thread, int policy, const struct sched_param *param)
+{
+  __THREAD_INIT();
+
+  if (__find_thread_id(target_thread)<0) {
+    return ESRCH;
+  }
+
+  if (((policy == SCHED_OTHER) && (param->sched_priority==0)) ||
+      (((policy == SCHED_RR) || (policy == SCHED_FIFO)) &&
+       ((param->sched_priority > 0) && (param->sched_priority <100))))
+    return sched_setscheduler(target_thread, policy, param);
+
+  return EINVAL;
+}