1 files changed, 113 insertions, 0 deletions
diff --git a/libs/JSystem/src/JAudio2/JASTaskThread.cpp b/libs/JSystem/src/JAudio2/JASTaskThread.cpp
new file mode 100644
index 0000000000..30a6d07a98
--- /dev/null
+++ b/libs/JSystem/src/JAudio2/JASTaskThread.cpp
@@ -0,0 +1,113 @@
+#include "JSystem/JSystem.h" // IWYU pragma: keep
+
+#include "JSystem/JAudio2/JASTaskThread.h"
+#include "JSystem/JAudio2/JASCalc.h"
+#include "JSystem/JAudio2/JASCriticalSection.h"
+#include "JSystem/JKernel/JKRSolidHeap.h"
+
+JASTaskThread::JASTaskThread(int priority, int msgCount, u32 stackSize) :
+    JKRThread(JASDram, stackSize, msgCount, priority)
+{
+    field_0x84 = false;
+    OSInitThreadQueue(&threadQueue_);
+}
+
+JASTaskThread::~JASTaskThread() {
+    OSMessage msg;
+    BOOL received;
+    while (true) {
+        msg = waitMessage(&received);
+        if (!received) {
+            return;
+        }
+        JASKernel::getCommandHeap()->free(msg);
+    }
+}
+
+void* JASTaskThread::allocCallStack(JASThreadCallback callback, const void* msg, u32 msgSize) {
+    ThreadMemPool* heap;
+    u32 size = msgSize + 8;
+    JASThreadCallStack *callStack = (JASThreadCallStack*) JASKernel::getCommandHeap()->alloc(size);
+    if (callStack == NULL) {
+        return NULL;
+    }
+
+    callStack->msgType_ = 1;
+    JASCalc::bcopy(msg, callStack->msg.buffer, msgSize);
+    callStack->callback_ = callback;
+    return callStack;
+}
+
+void* JASTaskThread::allocCallStack(JASThreadCallback callback, void* msg) {
+    JASThreadCallStack *callStack;
+    callStack = (JASThreadCallStack*)JASKernel::getCommandHeap()->alloc(12);
+    if (callStack == NULL) {
+        return NULL;
+    }
+
+    callStack->msgType_ = 0;
+    callStack->msg.bufferPtr = msg;
+    callStack->callback_ = callback;
+    return callStack;
+}
+
+int JASTaskThread::sendCmdMsg(JASThreadCallback callback, const void* msg, u32 msgSize) {
+    void* callstack;
+
+    callstack = allocCallStack(callback, msg, msgSize);
+    if (callstack == NULL) {
+        return 0;
+    }
+
+    BOOL iVar2 = sendMessage(callstack);
+    if (!iVar2) {
+        JASKernel::getCommandHeap()->free(callstack);
+    }
+    return iVar2;
+}
+
+int JASTaskThread::sendCmdMsg(JASThreadCallback callback, void* msg) {
+    void* callstack;
+
+    callstack = allocCallStack(callback, msg);
+    if (callstack == NULL) {
+        return 0;
+    }
+
+    BOOL iVar2 = sendMessage(callstack);
+    if (!iVar2) {
+        JASKernel::getCommandHeap()->free(callstack);
+    }
+    return iVar2;
+}
+
+void* JASTaskThread::run() {
+    JASThreadCallStack* callstack;
+    OSInitFastCast();
+    do {
+        callstack = static_cast<JASThreadCallStack*>(waitMessageBlock());
+        if (field_0x84) {
+            OSSleepThread(&threadQueue_);
+        }
+
+        if (callstack->msgType_) {
+            callstack->callback_(callstack->msg.buffer);
+        } else {
+            callstack->callback_(callstack->msg.bufferPtr);
+        }
+
+        JASKernel::getCommandHeap()->free(callstack);
+    } while (true);
+}
+
+void JASTaskThread::pause(bool param_0) {
+    JASCriticalSection aJStack_14;
+    if (param_0) {
+        field_0x84 = 1;
+    } else {
+        if (field_0x84) {
+            OSWakeupThread(&threadQueue_);
+        }
+        field_0x84 = 0;
+    }
+}