Implemented new thread scheduling logic that doesn't need a central scheduler thread, removed all uses of atomic waits

2026-05-23 15:02:04 -04:00 · 2024-04-25 02:57:06 -04:00
parent 5382ce6fd0
commit 68ee43f5ac
13 changed files with 440 additions and 571 deletions
@@ -0,0 +1,66 @@
+#include <cassert>
+
+#include "ultramodern.hpp"
+
+static PTR(OSThread) running_queue_impl = NULLPTR;
+
+static PTR(OSThread)* queue_to_ptr(RDRAM_ARG PTR(PTR(OSThread)) queue) {
+    if (queue == ultramodern::running_queue) {
+        return &running_queue_impl;
+    }
+    return TO_PTR(PTR(OSThread), queue);
+}
+
+void ultramodern::thread_queue_insert(RDRAM_ARG PTR(PTR(OSThread)) queue_, PTR(OSThread) toadd_) {
+    PTR(OSThread)* cur = queue_to_ptr(PASS_RDRAM queue_);
+    OSThread* toadd = TO_PTR(OSThread, toadd_); 
+    debug_printf("[Thread Queue] Inserting thread %d into queue 0x%08X\n", toadd->id, (uintptr_t)queue_);
+    while (*cur && TO_PTR(OSThread, *cur)->priority > toadd->priority) {
+        cur = &TO_PTR(OSThread, *cur)->next;
+    }
+    toadd->next = (*cur);
+    toadd->queue = queue_;
+    *cur = toadd_;
+
+    debug_printf("  Contains:");
+    cur = queue_to_ptr(PASS_RDRAM queue_);
+    while (*cur) {
+        debug_printf("%d (%d) ", TO_PTR(OSThread, *cur)->id, TO_PTR(OSThread, *cur)->priority);
+        cur = &TO_PTR(OSThread, *cur)->next;
+    }
+    debug_printf("\n");
+}
+
+PTR(OSThread) ultramodern::thread_queue_pop(RDRAM_ARG PTR(PTR(OSThread)) queue_) {
+    PTR(OSThread)* queue = queue_to_ptr(PASS_RDRAM queue_);
+    PTR(OSThread) ret = *queue;
+    *queue = TO_PTR(OSThread, ret)->next;
+    TO_PTR(OSThread, ret)->queue = NULLPTR;
+    debug_printf("[Thread Queue] Popped thread %d from queue 0x%08X\n", TO_PTR(OSThread, ret)->id, (uintptr_t)queue_);
+    return ret;
+}
+
+bool ultramodern::thread_queue_remove(RDRAM_ARG PTR(PTR(OSThread)) queue_, PTR(OSThread) t_) {
+    debug_printf("[Thread Queue] Removing thread %d from queue 0x%08X\n", TO_PTR(OSThread, t_)->id, (uintptr_t)queue_);
+
+    PTR(PTR(OSThread)) cur = queue_;
+    while (cur != NULLPTR) {
+        PTR(OSThread)* cur_ptr = queue_to_ptr(PASS_RDRAM queue_);
+        if (*cur_ptr == t_) {
+            return true;
+        }
+        cur = TO_PTR(OSThread, *cur_ptr)->next;
+    }
+
+    return false;
+}
+
+bool ultramodern::thread_queue_empty(RDRAM_ARG PTR(PTR(OSThread)) queue_) {
+    PTR(OSThread)* queue = queue_to_ptr(PASS_RDRAM queue_);
+    return *queue == NULLPTR;
+}
+
+PTR(OSThread) ultramodern::thread_queue_peek(RDRAM_ARG PTR(PTR(OSThread)) queue_) {
+    PTR(OSThread)* queue = queue_to_ptr(PASS_RDRAM queue_);
+    return *queue;
+}