From 9fa0a7f1da1b70bee995f53c6c96c43189018772 Mon Sep 17 00:00:00 2001
From: mrb0nk500 <b0nk@b0nk.xyz>
Date: Wed, 1 Feb 2023 18:45:02 -0400
Subject: global: Import Dolphin SDK

This version comes from the Metroid Prime decompilation project.
https://github.com/PrimeDecomp/prime
---
 src/Dolphin/os/OSMessage.c | 86 ++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 86 insertions(+)
 create mode 100644 src/Dolphin/os/OSMessage.c

(limited to 'src/Dolphin/os/OSMessage.c')

diff --git a/src/Dolphin/os/OSMessage.c b/src/Dolphin/os/OSMessage.c
new file mode 100644
index 0000000..db4d2fd
--- /dev/null
+++ b/src/Dolphin/os/OSMessage.c
@@ -0,0 +1,86 @@
+#include <dolphin/os.h>
+
+void OSInitMessageQueue(OSMessageQueue* mq, OSMessage* msgArray, s32 msgCount) {
+  OSInitThreadQueue(&mq->queueSend);
+  OSInitThreadQueue(&mq->queueReceive);
+  mq->msgArray = msgArray;
+  mq->msgCount = msgCount;
+  mq->firstIndex = 0;
+  mq->usedCount = 0;
+}
+
+BOOL OSSendMessage(OSMessageQueue* mq, OSMessage msg, s32 flags) {
+  BOOL enabled;
+  s32 lastIndex;
+
+  enabled = OSDisableInterrupts();
+
+  while (mq->msgCount <= mq->usedCount) {
+    if (!(flags & OS_MESSAGE_BLOCK)) {
+      OSRestoreInterrupts(enabled);
+      return FALSE;
+    } else {
+      OSSleepThread(&mq->queueSend);
+    }
+  }
+
+  lastIndex = (mq->firstIndex + mq->usedCount) % mq->msgCount;
+  mq->msgArray[lastIndex] = msg;
+  mq->usedCount++;
+
+  OSWakeupThread(&mq->queueReceive);
+
+  OSRestoreInterrupts(enabled);
+  return TRUE;
+}
+
+BOOL OSReceiveMessage(OSMessageQueue* mq, OSMessage* msg, s32 flags) {
+  BOOL enabled;
+
+  enabled = OSDisableInterrupts();
+
+  while (mq->usedCount == 0) {
+    if (!(flags & OS_MESSAGE_BLOCK)) {
+      OSRestoreInterrupts(enabled);
+      return FALSE;
+    } else {
+      OSSleepThread(&mq->queueReceive);
+    }
+  }
+
+  if (msg != NULL) {
+    *msg = mq->msgArray[mq->firstIndex];
+  }
+  mq->firstIndex = (mq->firstIndex + 1) % mq->msgCount;
+  mq->usedCount--;
+
+  OSWakeupThread(&mq->queueSend);
+
+  OSRestoreInterrupts(enabled);
+  return TRUE;
+}
+
+BOOL OSJamMessage(OSMessageQueue* mq, OSMessage msg, s32 flags) {
+  BOOL enabled;
+
+  enabled = OSDisableInterrupts();
+
+  while (mq->msgCount <= mq->usedCount)
+  {
+    if (!(flags & OS_MESSAGE_BLOCK)) {
+      OSRestoreInterrupts(enabled);
+      return FALSE;
+    } else {
+      OSSleepThread(&mq->queueSend);
+    }
+  }
+
+  mq->firstIndex = (mq->firstIndex + mq->msgCount - 1) % mq->msgCount;
+  mq->msgArray[mq->firstIndex] = msg;
+  mq->usedCount++;
+
+  OSWakeupThread(&mq->queueReceive);
+
+  OSRestoreInterrupts(enabled);
+  return TRUE;
+}
-- 
cgit v1.2.3-13-gbd6f