From 7d3884b5cfc282dbdfe5d9a22d8b2b343280b8af Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Tue, 1 Feb 2022 20:36:30 -0700
Subject: Thread yield control to any other threads

---
 src/sys/schedule.c | 13 +++++++++++++
 1 file changed, 13 insertions(+)

(limited to 'src/sys/schedule.c')

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;
+}
-- 
cgit v1.2.1