Added scheduling logic

1 files changed, 17 insertions, 0 deletions

diff --git a/src/sys/schedule.c b/src/sys/schedule.c
index 0dc89e9..3aca0ff 100644
--- a/src/sys/schedule.c
+++ b/src/sys/schedule.c
@@ -1,5 +1,22 @@
+#include <globals.h>
+#include <sys/schedule.h>
+
 void init_scheduler(void)
 {
 	// Set rthread to usrloopthread - an infinitely running thread so that the pointer will never be null
+	usrloopthread.pc = (void*)loop;
+	usrloopthread.sp = 0x0FCC;
+	usrloopthread.sp_base = 0x1000;
+	usrloopthread.mptr = 0;
+	usrloopthread.pid = -1;
+	usrloopthread.priority = -1;
+	usrloopthread.status = THREAD_READY;
+	scheduler.rthread = &usrloopthread;
 	// Initialize Rotating Buffers
 }
+
+void loop(void)
+{
+	while(1)
+		asm volatile ("wfe");
+}