Thread yield control to any other threads

1 files changed, 13 insertions, 0 deletions

diff --git a/src/sys/schedule.c b/src/sys/schedule.c
index 6f2a72d..70aebb9 100644
--- a/src/sys/schedule.c
+++ b/src/sys/schedule.c
@@ -156,3 +156,16 @@ void* get_rthread_roffset(void)
 {
 	return &scheduler.thread_queues[scheduler.rthread->priority].ready.roffset;
 }
+
+void yield(void)
+{
+	struct Thread* rthread = scheduler.rthread;
+	if (rthread == &usrloopthread)
+		return;
+	unsigned char priority = rthread->priority;
+	struct ThreadRotBuffer* trb = &scheduler.thread_queues[priority].ready;
+	trb->roffset += 1;
+	trb->roffset %= TQUEUE_MAX;
+	trb->queue[trb->woffset++] = rthread;
+	trb->roffset %= TQUEUE_MAX;
+}