padsetup OK (#383)

* padsetup OK * Made tharo's suggestions * Made arg name consistent
2026-05-30 00:46:24 -04:00 · 2021-11-02 14:35:57 -07:00
parent c761477799
commit 4841a4a0bf
3 changed files with 34 additions and 3 deletions
@@ -1,3 +1,34 @@
 #include "global.h"

-#pragma GLOBAL_ASM("asm/non_matchings/boot/padsetup/func_80086620.s")
+s32 PadSetup_Init(OSMesgQueue* mq, u8* outMask, OSContStatus* status) {
+    s32 ret;
+    s32 i;
+
+    *outMask = 0xFF;
+    ret = osContInit(mq, outMask, status);
+    if (ret != 0) {
+        return ret;
+    }
+    if (*outMask == 0xFF) {
+        if (osContStartQuery(mq) != 0) {
+            return 1;
+        }
+        osRecvMesg(mq, NULL, OS_MESG_BLOCK);
+        osContGetQuery(status);
+
+        *outMask = 0;
+
+        for (i = 0; i < MAXCONTROLLERS; i++) {
+            switch (status[i].errno) {
+                case 0:
+                    if (status[i].type == CONT_TYPE_NORMAL) {
+                        *outMask |= 1 << i;
+                    }
+                    break;
+                default:
+                    break;
+            }
+        }
+    }
+    return 0;
+}