match all the functions

3 files changed, 2360 insertions, 52 deletions

diff --git a/src/agb_flash.c b/src/agb_flash.c
index 34fb4e84a..a9cf13d5f 100644
--- a/src/agb_flash.c
+++ b/src/agb_flash.c
@@ -74,7 +74,7 @@ u16 SetFlashTimerIntr(u8 timerNum, void (**intrFunc)(void))
         return 1;
 
     sTimerNum = timerNum;
-    sTimerReg = &REG_TMCNT(sTimerNum);
+    sTimerReg = &REG_TMCNT_L(sTimerNum);
     *intrFunc = FlashTimerIntr;
     return 0;
 }
diff --git a/src/librfu_rfu.c b/src/librfu_rfu.c
index 7437bcecf..f5f13cc5d 100644
--- a/src/librfu_rfu.c
+++ b/src/librfu_rfu.c
@@ -1,77 +1,2218 @@
-#include "global.h"
-#include "main.h"
-
 #include "librfu.h"
 
-// Nonmatching, only register differences
-/*u16 rfu_initializeAPI(u32 *unk0, u16 unk1, IntrFunc *interrupt, bool8 copyInterruptToRam)
+struct LLSFStruct
+{
+    u8 unk00;
+    u8 unk01;
+    u8 unk02;
+    u8 unk03;
+    u8 unk04;
+    u8 unk05;
+    u8 unk06;
+    u8 unk07;
+    u8 unk08;
+    u8 unk09;
+    u8 unk0A;
+    u8 unk0B;
+    u8 unk0C;
+    u16 unk0E;
+};
+
+struct RfuLocalStruct
+{
+    u8 unk00;
+    u8 unk01;
+    u8 unk02;
+    u8 unk03;
+    u8 unk04;
+    u8 unk05;
+    u16 unk06;
+};
+
+static void rfu_CB_defaultCallback(u8, u16);
+static void rfu_CB_reset(u8, u16);
+static void rfu_CB_configGameData(u8, u16);
+static void rfu_CB_stopMode(u8, u16);
+static void rfu_CB_startSearchChild(u8, u16);
+static void rfu_CB_pollAndEndSearchChild(u8, u16);
+static void rfu_CB_startSearchParent(u8, u16);
+static void rfu_CB_pollSearchParent(u8, u16);
+static void rfu_CB_pollConnectParent(u8, u16);
+static void rfu_CB_pollConnectParent(u8, u16);
+static void rfu_CB_disconnect(u8, u16);
+static void rfu_CB_CHILD_pollConnectRecovery(u8, u16);
+static void rfu_CB_sendData(__attribute__((unused)) u8, u16);
+static void rfu_CB_sendData2(__attribute__((unused)) u8, u16);
+static void rfu_CB_sendData3(u8, u16);
+static void rfu_CB_recvData(u8, u16);
+static void rfu_enableREQCallback(bool8);
+static void rfu_STC_clearAPIVariables(void);
+static void rfu_STC_readChildList(void);
+static void rfu_STC_readParentCandidateList(void);
+static void rfu_STC_REQ_callback(u8, u16);
+static void rfu_STC_removeLinkData(u8, u8);
+static void rfu_STC_fastCopy(const u8 **, u8 **, s32);
+static void rfu_STC_clearLinkStatus(u8);
+static void rfu_NI_checkCommFailCounter(void);
+static u16 rfu_STC_setSendData_org(u8, u8, u8, const void *, u32);
+static void rfu_constructSendLLFrame(void);
+static u16 rfu_STC_NI_constructLLSF(u8, u8 **, struct NIComm *);
+static u16 rfu_STC_UNI_constructLLSF(u8, u8 **);
+static void rfu_STC_PARENT_analyzeRecvPacket(void);
+static void rfu_STC_CHILD_analyzeRecvPacket(void);
+static u16 rfu_STC_analyzeLLSF(u8, const u8 *, u16);
+static void rfu_STC_UNI_receive(u8, const struct RfuLocalStruct *, const u8 *);
+static void rfu_STC_NI_receive_Receiver(u8, const struct RfuLocalStruct *, const u8 *);
+static void rfu_STC_NI_receive_Sender(u8, u8, const struct RfuLocalStruct *, __attribute__((unused)) const u8 *);
+static void rfu_STC_NI_initSlot_asRecvDataEntity(u8, struct NIComm *);
+static void rfu_STC_NI_initSlot_asRecvControllData(u8, struct NIComm *);
+
+//struct RfuSlotStatusUNI *gRfuSlotStatusUNI[RFU_CHILD_MAX];
+//struct RfuSlotStatusNI *gRfuSlotStatusNI[RFU_CHILD_MAX];
+//struct RfuLinkStatus *gRfuLinkStatus;
+//struct RfuStatic *gRfuStatic;
+//struct RfuFixed *gRfuFixed;
+
+/*static const struct LLSFStruct llsf_struct[2] = {
+  {
+    2, 14, 0, 10, 9, 5, 7, 2,
+    0, 15, 1, 3, 3, 0x1f
+  }, {
+    3, 22, 18, 14, 13, 9, 11, 3,
+    15, 15, 1, 3, 3, 0x7f
+  }
+};
+
+#ifdef EMERALD
+static const char lib_ver[] = "RFU_V1026";
+#else
+static const char lib_ver[] = "RFU_V1024";
+#endif
+
+static const char str_checkMbootLL[] = "RFU-MBOOT";
+*/
+extern const struct LLSFStruct llsf_struct[2];
+extern const char str_checkMbootLL[];// = "RFU-MBOOT";
+
+u16 rfu_initializeAPI(struct RfuAPIBuffer *APIBuffer, u16 buffByteSize, IntrFunc *sioIntrTable_p, bool8 copyInterruptToRam)
 {
     u16 i;
-    u16 *v13;
-    u16 *v12;
-    u16 num;
+    u16 *dst;
+    const u16 *src;
+    u16 r3;
 
-    if (((u32)unk0 & 0xF000000) == 0x2000000 && copyInterruptToRam)
-    {
-        return 2;
-    }
-    
-    if ((u32)unk0 & 3)
-        return 2;
-    
-    // Nintendo pls, just use a ternary for once
+    // is in EWRAM? 
+    if (((u32)APIBuffer & 0xF000000) == 0x2000000 && copyInterruptToRam)
+        return ERR_RFU_API_BUFF_ADR;
+    // is not 4-byte aligned? 
+    if ((u32)APIBuffer & 3)
+        return ERR_RFU_API_BUFF_ADR;
     if (copyInterruptToRam)
     {
         // An assert/debug print may have existed before, ie
-        // printf("%s %u < %u", "somefile.c:12345", unk1, num)
+        // printf("%s %u < %u", "somefile.c:12345", buffByteSize, num)
         // to push this into r3?
-        num = 0xe64;
-        if (unk1 < num)
-            return 1;
+        r3 = sizeof(struct RfuAPIBuffer);
+        if (buffByteSize < r3)
+            return ERR_RFU_API_BUFF_SIZE;
+    }
+    if (!copyInterruptToRam)
+    {
+        r3 = 0x504; // same issue as above
+        if (buffByteSize < r3)
+            return ERR_RFU_API_BUFF_SIZE;
     }
+    gRfuLinkStatus = &APIBuffer->linkStatus;
+    gRfuStatic = &APIBuffer->static_;
+    gRfuFixed = &APIBuffer->fixed;
+    gRfuSlotStatusNI[0] = &APIBuffer->NI[0];
+    gRfuSlotStatusUNI[0] = &APIBuffer->UNI[0];
+    for (i = 1; i < RFU_CHILD_MAX; ++i)
+    {
+        gRfuSlotStatusNI[i] = &gRfuSlotStatusNI[i - 1][1];
+        gRfuSlotStatusUNI[i] = &gRfuSlotStatusUNI[i - 1][1];
+    }
+    // TODO: Is it possible to fix the following 2 statements? 
+    // It's equivalent to: 
+    // gRfuFixed->STWIBuffer = &APIBuffer->intr;
+    // STWI_init_all(&APIBuffer->intr, sioIntrTable_p, copyInterruptToRam);
+    gRfuFixed->STWIBuffer = (struct RfuIntrStruct *)&gRfuSlotStatusUNI[3][1];
+    STWI_init_all((struct RfuIntrStruct *)&gRfuSlotStatusUNI[3][1], sioIntrTable_p, copyInterruptToRam);
+    rfu_STC_clearAPIVariables();
+    for (i = 0; i < RFU_CHILD_MAX; ++i)
+    {
+        gRfuSlotStatusNI[i]->recvBuffer = NULL;
+        gRfuSlotStatusNI[i]->recvBufferSize = 0;
+        gRfuSlotStatusUNI[i]->recvBuffer = NULL;
+        gRfuSlotStatusUNI[i]->recvBufferSize = 0;
+    }
+    // looks like a macro copying data
+    do
+    {
+        src = (const u16 *)((u32)&rfu_STC_fastCopy & 0xFFFFFFFE);
+        dst = gRfuFixed->fastCopyBuffer;
+        for (r3 = 0x2F; r3 != 0xFFFF; --r3) // copy rfu_STC_fastCopy function body to buffer
+            *dst++ = *src++;
+        gRfuFixed->fastCopyPtr = (void *)gRfuFixed->fastCopyBuffer + 1;
+    } while (0);
+    return 0;
+}
+
+static void rfu_STC_clearAPIVariables(void)
+{
+    u16 IMEBackup = REG_IME;
+    u8 i, r4;
+
+    REG_IME = 0;
+    r4 = gRfuStatic->flags;
+    CpuFill16(0, gRfuStatic, sizeof(struct RfuStatic));
+    gRfuStatic->flags = r4 & 8;
+    CpuFill16(0, gRfuLinkStatus, sizeof(struct RfuLinkStatus));
+    gRfuLinkStatus->watchInterval = 4;
+    gRfuStatic->nowWatchInterval = 0;
+    gRfuLinkStatus->parentChild = MODE_NEUTRAL;
+    rfu_clearAllSlot();
+    gRfuStatic->SCStartFlag = 0;
+    for (i = 0; i < NELEMS(gRfuStatic->cidBak); ++i)
+        gRfuStatic->cidBak[i] = 0;
+    REG_IME = IMEBackup;
+}
 
-    if (copyInterruptToRam == FALSE)
+void rfu_REQ_PARENT_resumeRetransmitAndChange(void)
+{
+    STWI_set_Callback_M(rfu_STC_REQ_callback);
+    STWI_send_ResumeRetransmitAndChangeREQ();
+}
+
+u16 rfu_UNI_PARENT_getDRAC_ACK(u8 *ackFlag)
+{
+    struct RfuIntrStruct *buf;
+
+    *ackFlag = 0;
+    if (gRfuLinkStatus->parentChild != MODE_PARENT)
+        return ERR_MODE_NOT_PARENT;
+    buf = rfu_getSTWIRecvBuffer();
+    switch (buf->rxPacketAlloc.rfuPacket8.data[0])
+    {
+    case 40:
+    case 54:
+        if (buf->rxPacketAlloc.rfuPacket8.data[1] == 0)
+            *ackFlag = gRfuLinkStatus->connSlotFlag;
+        else
+            *ackFlag = buf->rxPacketAlloc.rfuPacket8.data[4];
+        return 0;
+    default:
+        return ERR_REQ_CMD_ID;
+    }
+}
+
+void rfu_setTimerInterrupt(u8 timerNo, IntrFunc *timerIntrTable_p)
+{
+    STWI_init_timer(timerIntrTable_p, timerNo);
+}
+
+struct RfuIntrStruct *rfu_getSTWIRecvBuffer(void)
+{
+    return gRfuFixed->STWIBuffer;
+}
+
+void rfu_setMSCCallback(void (*callback)(u16 reqCommandId))
+{
+    STWI_set_Callback_S(callback);
+}
+
+void rfu_setREQCallback(void (*callback)(u16 reqCommandId, u16 reqResult))
+{
+    gRfuFixed->reqCallback = callback;
+    rfu_enableREQCallback(callback != NULL);
+}
+
+static void rfu_enableREQCallback(bool8 enable)
+{
+    if (enable)
+        gRfuStatic->flags |= 8;
+    else
+        gRfuStatic->flags &= 0xF7;
+}
+
+static void rfu_STC_REQ_callback(u8 r5, u16 reqResult)
+{
+    STWI_set_Callback_M(rfu_CB_defaultCallback);
+    gRfuStatic->reqResult = reqResult;
+    if (gRfuStatic->flags & 8)
+        gRfuFixed->reqCallback(r5, reqResult);
+}
+
+static void rfu_CB_defaultCallback(u8 r0, u16 reqResult)
+{
+    s32 r5;
+    u8 i;
+
+    if (r0 == 0xFF)
     {
-        num = 0x504; // same as above, this should be r3 not r0
-        if (unk1 < num)
+        if (gRfuStatic->flags & 8)
+            gRfuFixed->reqCallback(r0, reqResult);
+        r5 = gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag;
+        for (i = 0; i < RFU_CHILD_MAX; ++i)
+            if ((r5 >> i) & 1)
+                rfu_STC_removeLinkData(i, 1);
+        gRfuLinkStatus->parentChild = MODE_NEUTRAL;
+    }
+}
+
+u16 rfu_waitREQComplete(void)
+{
+    STWI_poll_CommandEnd();
+    return gRfuStatic->reqResult;
+}
+
+void rfu_REQ_RFUStatus(void)
+{
+    STWI_set_Callback_M(rfu_STC_REQ_callback);
+    STWI_send_SystemStatusREQ();
+}
+
+u16 rfu_getRFUStatus(u8 *rfuState)
+{
+    if (gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[0] != 0x93)
+        return ERR_REQ_CMD_ID;
+    if (STWI_poll_CommandEnd() == 0)
+        *rfuState = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[7];
+    else
+        *rfuState = 0xFF;
+    return 0;
+}
+
+u16 rfu_MBOOT_CHILD_inheritanceLinkStatus(void)
+{
+    const char *s1 = str_checkMbootLL;
+    char *s2 = (char *)0x30000F0;
+    u16 checksum;
+    u16 *r2;
+    u8 i;
+
+    while (*s1 != '\0')
+        if (*s1++ != *s2++)
             return 1;
+    r2 = (u16 *)0x3000000;
+    checksum = 0;
+    for (i = 0; i < 90; ++i)
+        checksum += *r2++;
+    if (checksum != *(u16 *)0x30000FA)
+        return 1;
+    CpuCopy16((u16 *)0x3000000, gRfuLinkStatus, sizeof(struct RfuLinkStatus));
+    gRfuStatic->flags |= 0x80;
+    return 0;
+}
+
+void rfu_REQ_stopMode(void)
+{
+    vu32 *timerReg;
+
+    if (REG_IME == 0)
+    {
+        rfu_STC_REQ_callback(61, 6);
+        gSTWIStatus->error = ERR_REQ_CMD_IME_DISABLE;
     }
-    gRfuLinkStatus = unk0;
-    gRfuStatic = unk0 + (0xB4 / sizeof(u32));
-    gRfuFixed = (struct RfuFixed*)(unk0 + (0xDC / sizeof(u32)));
-    gRfuSlotStatusNI[0] = (struct RfuSlotStatusNI*)(unk0 + (0x1BC / sizeof(u32)));
-    gRfuSlotStatusUNI[0] = (struct RfuSlotStatusUNI*)(unk0 + (0x37C / sizeof(u32)));
+    else
+    {
+        AgbRFU_SoftReset();
+        rfu_STC_clearAPIVariables();
+        if (AgbRFU_checkID(8) == 0x8001)
+        {
+            timerReg = &REG_TMCNT(gSTWIStatus->timerSelect);
+            *timerReg = 0;
+            *timerReg = (TIMER_ENABLE | TIMER_1024CLK) << 16;
+            while (*timerReg << 16 < 262 << 16)
+                ;
+            *timerReg = 0;
+            STWI_set_Callback_M(rfu_CB_stopMode);
+            STWI_send_StopModeREQ();
+        }
+        else
+        {
+            REG_SIOCNT = SIO_MULTI_MODE;
+            rfu_STC_REQ_callback(61, 0);
+        }
+    }
+}
 
-    for (i = 1; i < 4; i++, num)
+static void rfu_CB_stopMode(u8 a1, u16 reqResult)
+{
+    if (reqResult == 0)
+        REG_SIOCNT = SIO_MULTI_MODE;
+    rfu_STC_REQ_callback(a1, reqResult);
+}
+
+u32 rfu_REQBN_softReset_and_checkID(void)
+{
+    u32 r2;
+
+    if (REG_IME == 0)
+        return ERR_ID_CHECK_IME_DISABLE;
+    AgbRFU_SoftReset();
+    rfu_STC_clearAPIVariables();
+    if ((r2 = AgbRFU_checkID(30)) == 0)
+        REG_SIOCNT = SIO_MULTI_MODE;
+    return r2;
+}
+
+void rfu_REQ_reset(void)
+{
+    STWI_set_Callback_M(rfu_CB_reset);
+    STWI_send_ResetREQ();
+}
+
+static void rfu_CB_reset(u8 a1, u16 reqResult)
+{
+    if (reqResult == 0)
+        rfu_STC_clearAPIVariables();
+    rfu_STC_REQ_callback(a1, reqResult);
+}
+
+void rfu_REQ_configSystem(u16 availSlotFlag, u8 maxMFrame, u8 mcTimer)
+{
+    STWI_set_Callback_M(rfu_STC_REQ_callback);
+    STWI_send_SystemConfigREQ((availSlotFlag & AVAIL_SLOT1) | 0x3C, maxMFrame, mcTimer);
+    if (mcTimer == 0)
     {
-        gRfuSlotStatusNI[i] = (struct RfuSlotStatusNI*)&gRfuSlotStatusNI[i-1]->unk_70;
-        gRfuSlotStatusUNI[i] = (struct RfuSlotStatusUNI*)&gRfuSlotStatusUNI[i-1]->unk_1c;
+        gRfuStatic->unk_1a = 1;
+    }
+    else
+    {
+        u16 IMEBackup = REG_IME;
+
+        REG_IME = 0;
+        gRfuStatic->unk_1a = Div(600, mcTimer);
+        REG_IME = IMEBackup;
     }
+}
+
+void rfu_REQ_configGameData(u8 mbootFlag, u16 serialNo, const u8 *gname, const u8 *uname)
+{
+    u8 sp[16];
+    u8 i;
+    u8 r3;
+    const u8 *gnameBackup = gname;
+    const u8 *unameBackup;
+
+    sp[0] = serialNo;
+    sp[1] = serialNo >> 8;
+    if (mbootFlag != 0)
+        sp[1] = (serialNo >> 8) | 0x80;
+    for (i = 2; i < 15; ++i)
+        sp[i] = *gname++;
+    r3 = 0;
+    unameBackup = uname;
+    for (i = 0; i < 8; ++i)
+    {
+        r3 += *unameBackup++;
+        r3 += *gnameBackup++;
+    }
+    sp[15] = ~r3;
+    if (mbootFlag != 0)
+        sp[14] = 0;
+    STWI_set_Callback_M(rfu_CB_configGameData);
+    STWI_send_GameConfigREQ(sp, uname);
+}
+
+static void rfu_CB_configGameData(u8 ip, u16 r7)
+{
+    s32 r2, r3;
+    u8 *r4;
+    u8 i;
+    u8 *r1;
+
+    if (r7 == 0)
+    {
+        r1 = gSTWIStatus->txPacket->rfuPacket8.data;
+        r2 = gRfuLinkStatus->my.serialNo = r1[4];
+        gRfuLinkStatus->my.serialNo = (r1[5] << 8) | r2;
+        r4 = &r1[6];
+        if (gRfuLinkStatus->my.serialNo & 0x8000)
+        {
+            gRfuLinkStatus->my.serialNo = gRfuLinkStatus->my.serialNo ^ 0x8000;
+            gRfuLinkStatus->my.mbootFlag = 1;
+        }
+        else
+        {
+            gRfuLinkStatus->my.mbootFlag = 0;
+        }
+        for (i = 0; i < RFU_GAME_NAME_LENGTH; ++i)
+            gRfuLinkStatus->my.gname[i] = *r4++;
+        ++r4;
+        for (i = 0; i < RFU_USER_NAME_LENGTH; ++i)
+            gRfuLinkStatus->my.uname[i] = *r4++;
+    }
+    rfu_STC_REQ_callback(ip, r7);
+}
+
+void rfu_REQ_startSearchChild(void)
+{
+    u16 r1;
+
+    for (r1 = 0; r1 < 4; ++r1)
+        gRfuStatic->lsFixedCount[r1] = 0;
+    STWI_set_Callback_M(rfu_CB_defaultCallback);
+    STWI_send_SystemStatusREQ();
+    r1 = STWI_poll_CommandEnd();
+    if (r1 == 0)
+    {
+        if (gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[7] == 0)
+            rfu_STC_clearLinkStatus(1);
+    }
+    else
+    {
+        rfu_STC_REQ_callback(25, r1);
+    }
+    STWI_set_Callback_M(rfu_CB_startSearchChild);
+    STWI_send_SC_StartREQ();
+}
+
+static void rfu_CB_startSearchChild(u8 r3, u16 reqResult)
+{
+    if (reqResult == 0)
+        gRfuStatic->SCStartFlag = 1;
+    rfu_STC_REQ_callback(r3, reqResult);
+}
+
+static void rfu_STC_clearLinkStatus(u8 r4)
+{
+    u8 i;
     
-    gRfuFixed->unk_dc = (u32)&gRfuSlotStatusUNI[3]->unk_1c;
-    STWI_init_all(&gRfuSlotStatusUNI[3]->unk_1c, interrupt, copyInterruptToRam);
-    rfu_STC_clearAPIVariables();
+    rfu_clearAllSlot();
+    if (r4 != 0)
+    {
+        CpuFill16(0, gRfuLinkStatus->partner, sizeof(gRfuLinkStatus->partner));
+        gRfuLinkStatus->findParentCount = 0;
+    }
+    for (i = 0; i < RFU_CHILD_MAX; ++i)
+        gRfuLinkStatus->strength[i] = 0;
+    gRfuLinkStatus->connCount = 0;
+    gRfuLinkStatus->connSlotFlag = 0;
+    gRfuLinkStatus->linkLossSlotFlag = 0;
+    gRfuLinkStatus->getNameFlag = 0;
+}
+
+void rfu_REQ_pollSearchChild(void)
+{
+    STWI_set_Callback_M(rfu_CB_pollAndEndSearchChild);
+    STWI_send_SC_PollingREQ();
+}
 
-    for (i = 0; i < 4; i++)
+void rfu_REQ_endSearchChild(void)
+{
+    STWI_set_Callback_M(rfu_CB_pollAndEndSearchChild);
+    STWI_send_SC_EndREQ();
+}
+
+static void rfu_CB_pollAndEndSearchChild(u8 r4, u16 reqResult)
+{
+    if (reqResult == 0)
+        rfu_STC_readChildList();
+    if (r4 == 26)
     {
-        gRfuSlotStatusNI[i]->unk_68 = 0;
-        gRfuSlotStatusNI[i]->unk_6c = 0;
-        gRfuSlotStatusUNI[i]->unk_14 = 0;
-        gRfuSlotStatusUNI[i]->unk_18 = 0;
+        if (gRfuLinkStatus->my.id == 0)
+        {
+            STWI_set_Callback_M(rfu_CB_defaultCallback);
+            STWI_send_SystemStatusREQ();
+            if (STWI_poll_CommandEnd() == 0)
+                gRfuLinkStatus->my.id = *(u16 *)&gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.data[0];
+        }
     }
+    else if (r4 == 27)
+    {
+        if (gRfuLinkStatus->parentChild == MODE_NEUTRAL)
+            gRfuLinkStatus->my.id = 0;
+        gRfuStatic->SCStartFlag = 0;
+    }
+    rfu_STC_REQ_callback(r4, reqResult);
+}
 
-    // Not matching, register differences
-    v12 = (u16*)((u32)&sub_82E53F4 & ~1);
-    v13 = (u16*)gRfuFixed->unk_8;
-        
-    for (i = 47; i != 0xFFFF; i--)
+static void rfu_STC_readChildList(void)
+{
+    u32 r5;
+    u8 r8 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[1];
+    u8 *r4;
+    u8 i;
+    u8 r2;
+
+    for (r4 = &gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[4];
+         r8 != 0;
+         r4 += 4)
     {
-        *v13 = *v12;
-        ++v12;
-        ++v13;
+        r2 = r4[2];
+        if (r2 < RFU_CHILD_MAX && !((gRfuLinkStatus->connSlotFlag >> r2) & 1) && !((gRfuLinkStatus->linkLossSlotFlag >> r2) & 1))
+        {
+            gRfuStatic->lsFixedCount[r2] = 0xF0;
+            gRfuLinkStatus->strength[r2] = 0x10;
+            gRfuLinkStatus->connSlotFlag |= 1 << r2;
+            ++gRfuLinkStatus->connCount;
+            gRfuLinkStatus->partner[r2].id = *(u16 *)r4;
+            gRfuLinkStatus->partner[r2].slot = r2;
+            gRfuLinkStatus->parentChild = MODE_PARENT;
+            gRfuStatic->flags &= 0x7F;
+            gRfuStatic->cidBak[r2] = gRfuLinkStatus->partner[r2].id;
+        }
+        --r8;
     }
+}
+
+void rfu_REQ_startSearchParent(void)
+{
+    STWI_set_Callback_M(rfu_CB_startSearchParent);
+    STWI_send_SP_StartREQ();
+}
+
+static void rfu_CB_startSearchParent(u8 r5, u16 reqResult)
+{
+    if (reqResult == 0)
+        rfu_STC_clearLinkStatus(0);
+    rfu_STC_REQ_callback(r5, reqResult);
+}
+
+void rfu_REQ_pollSearchParent(void)
+{
+    STWI_set_Callback_M(rfu_CB_pollSearchParent);
+    STWI_send_SP_PollingREQ();
+}
+
+static void rfu_CB_pollSearchParent(u8 r5, u16 reqResult)
+{
+    if (reqResult == 0)
+        rfu_STC_readParentCandidateList();
+    rfu_STC_REQ_callback(r5, reqResult);
+}
+
+void rfu_REQ_endSearchParent(void)
+{
+    STWI_set_Callback_M(rfu_STC_REQ_callback);
+    STWI_send_SP_EndREQ();
+}
+
+static void rfu_STC_readParentCandidateList(void)
+{
+    u8 r7, r6, r5, r4, r3;
+    u8 *r1, *r2;
+    struct RfuTgtData *r4_;
+
+    CpuFill16(0, gRfuLinkStatus->partner, sizeof(gRfuLinkStatus->partner));
+    r2 = &gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[0];
+    r7 = r2[1];
+    r2 += 4;
+    gRfuLinkStatus->findParentCount = 0;
+    for (r6 = 0; r6 < 4 && r7 != 0; ++r6)
+    {
+        r7 -= 7;
+        r1 = r2 + 6;
+        r2 += 19;
+        r5 = ~*r2;
+        ++r2;
+        r4 = 0;
+        for (r3 = 0; r3 < 8; ++r3)
+        {
+            r4 += *r2++;
+            r4 += *r1++;
+        }
+        if (r4 == r5)
+        {
+            r2 -= 28;
+            r4_ = &gRfuLinkStatus->partner[gRfuLinkStatus->findParentCount];
+            r4_->id = *(u16 *)r2;
+            r2 += 2;
+            r4_->slot = *r2;
+            r2 += 2;
+            r4_->serialNo = *(u16 *)r2 & 0x7FFF;
+            if (*(u16 *)r2 & 0x8000)
+                r4_->mbootFlag = 1;
+            else
+                r4_->mbootFlag = 0;
+            r2 += 2;
+            for (r3 = 0; r3 < RFU_GAME_NAME_LENGTH; ++r3)
+                r4_->gname[r3] = *r2++;
+            ++r2;
+            for (r3 = 0; r3 < RFU_USER_NAME_LENGTH; ++r3)
+                r4_->uname[r3] = *r2++;
+            ++gRfuLinkStatus->findParentCount;
+        }
+    }
+}
+
+void rfu_REQ_startConnectParent(u16 pid)
+{
+    u16 r3 = 0;
+    u8 i;
+    for (i = 0; i < RFU_CHILD_MAX && gRfuLinkStatus->partner[i].id != pid; ++i)
+        ;
+    if (i == 4)
+        r3 = 256;
+    if (r3 == 0)
+    {
+        gRfuStatic->tryPid = pid;
+        STWI_set_Callback_M(rfu_STC_REQ_callback);
+        STWI_send_CP_StartREQ(pid);
+    }
+    else
+    {
+        rfu_STC_REQ_callback(31, r3);
+    }
+}
+
+void rfu_REQ_pollConnectParent(void)
+{
+    STWI_set_Callback_M(rfu_CB_pollConnectParent);
+    STWI_send_CP_PollingREQ();
+}
+
+static void rfu_CB_pollConnectParent(u8 sp24, u16 sp28)
+{
+    u16 id;
+    u8 slot;
+    u8 r2, r5;
+    struct RfuTgtData *r9;
+    struct RfuTgtData sp;
+
+    if (sp28 == 0)
+    {
+        id = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.data[0];
+        slot = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[6];
+        if (gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[7] == 0)
+        {
+            r2 = 1 << slot;
+            if (!(r2 & gRfuLinkStatus->connSlotFlag))
+            {
+                gRfuLinkStatus->connSlotFlag |= r2;
+                gRfuLinkStatus->linkLossSlotFlag &= ~r2;
+                gRfuLinkStatus->my.id = id;
+                ++gRfuLinkStatus->connCount;
+                gRfuLinkStatus->parentChild = MODE_CHILD;
+                gRfuStatic->flags |= 0x80;
+                for (r5 = 0; r5 < RFU_CHILD_MAX; ++r5)
+                {
+                    if (gRfuLinkStatus->partner[r5].id == gRfuStatic->tryPid)
+                    {
+                        if (gRfuLinkStatus->findParentCount != 0)
+                        {
+                            r9 = &sp;
+                            CpuCopy16(&gRfuLinkStatus->partner[r5], &sp, sizeof(struct RfuTgtData));
+                            CpuFill16(0, gRfuLinkStatus->partner, sizeof(gRfuLinkStatus->partner));
+                            gRfuLinkStatus->findParentCount = 0;
+                        }
+                        else
+                        {
+                            r9 = &gRfuLinkStatus->partner[r5];
+                        }
+                        break;
+                    }
+                }
+                if (r5 < RFU_CHILD_MAX)
+                {
+                    CpuCopy16(r9, &gRfuLinkStatus->partner[slot], sizeof(struct RfuTgtData));
+                    gRfuLinkStatus->partner[slot].slot = slot;
+                }
+            }
+        }
+    }
+    rfu_STC_REQ_callback(sp24, sp28);
+}
+
+u16 rfu_getConnectParentStatus(u8 *status, u8 *connectSlotNo)
+{
+    u8 r0, *r2;
+
+    *status = 0xFF;
+    r2 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data;
+    r0 = r2[0] + 96;
+    if (r0 <= 1)
+    {
+        r2 += 6;
+        *connectSlotNo = r2[0];
+        *status = r2[1];
+        return 0;
+    }
+    return ERR_REQ_CMD_ID;
+}
+
+void rfu_REQ_endConnectParent(void)
+{
+    STWI_set_Callback_M(rfu_CB_pollConnectParent);
+    STWI_send_CP_EndREQ();
+    if (gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[6] < 4)
+        gRfuStatic->linkEmergencyFlag[gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[6]] = 0;
+}
+
+u16 rfu_syncVBlank(void)
+{
+    u8 r3, r4;
+    s32 r5;
+
+    rfu_NI_checkCommFailCounter();
+    if (gRfuLinkStatus->parentChild == MODE_NEUTRAL)
+        return 0;
+    if (gRfuStatic->nowWatchInterval != 0)
+        --gRfuStatic->nowWatchInterval;
+    r3 = rfu_getMasterSlave();
+    if (!(gRfuStatic->flags & 2))
+    {
+        if (r3 == 0)
+        {
+            gRfuStatic->flags |= 4;
+            gRfuStatic->watchdogTimer = 360;
+        }
+    }
+    else if (r3 != 0)
+    {
+        gRfuStatic->flags &= 0xFB;
+    }
+    if (r3 != 0)
+        gRfuStatic->flags &= 0xFD;
+    else
+        gRfuStatic->flags |= 2;
+    if (!(gRfuStatic->flags & 4))
+        return 0;
+    if (gRfuStatic->watchdogTimer == 0)
+    {
+        gRfuStatic->flags &= 0xFB;
+        r5 = gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag;
+        for (r4 = 0; r4 < RFU_CHILD_MAX; ++r4)
+            if ((r5 >> r4) & 1)
+                rfu_STC_removeLinkData(r4, 1);
+        gRfuLinkStatus->parentChild = MODE_NEUTRAL;
+        return 1;
+    }
+    --gRfuStatic->watchdogTimer;
+    return 0;
+}
+
+u16 rfu_REQBN_watchLink(u16 reqCommandId, u8 *bmLinkLossSlot, u8 *linkLossReason, u8 *parentBmLinkRecoverySlot)
+{
+    u8 sp08 = 0;
+    u8 sp0C = 0;
+    u8 i;
+    s32 sp10, sp14;
+    u8 *r2;
+    u8 r9, r6, r3, connSlotFlag, r0;
+    
+    *bmLinkLossSlot = 0;
+    *linkLossReason = REASON_DISCONNECTED;
+    *parentBmLinkRecoverySlot = 0;
+    if (gRfuLinkStatus->parentChild == MODE_NEUTRAL || gSTWIStatus->msMode == 0)
+        return 0;
+    if (gRfuStatic->flags & 4)
+        gRfuStatic->watchdogTimer = 360;
+    if (gRfuStatic->nowWatchInterval == 0)
+    {
+        gRfuStatic->nowWatchInterval = 4;
+        sp08 = 1;
+    }
+    if ((u8)reqCommandId == 41)
+    {
+        u8 *r1 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data;
         
-    gRfuFixed->unk_4 = (u32)(&gRfuFixed->unk_8[1]);
-        
+        *bmLinkLossSlot = r1[4];
+        *linkLossReason = r1[5];
+        if (*linkLossReason == REASON_LINK_LOSS)
+            *bmLinkLossSlot = gRfuLinkStatus->connSlotFlag;
+        sp08 = 2;
+    }
+    else
+    {
+        if (reqCommandId == 310)
+        {
+            r6 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[5];
+            r6 ^= gRfuLinkStatus->connSlotFlag;
+            *bmLinkLossSlot = r6 & gRfuLinkStatus->connSlotFlag;
+            *linkLossReason = REASON_LINK_LOSS;
+            for (i = 0; i < RFU_CHILD_MAX; ++i)
+            {
+                if ((*bmLinkLossSlot >> i) & 1)
+                {
+                    gRfuLinkStatus->strength[i] = 0;
+                    rfu_STC_removeLinkData(i, 0);
+                }
+            }
+        }
+        if (sp08 == 0)
+            return 0;
+    }
+    sp10 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.command;
+    sp14 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.data[0];
+    STWI_set_Callback_M(rfu_CB_defaultCallback);
+    STWI_send_LinkStatusREQ();
+    sp0C = STWI_poll_CommandEnd();
+    if (sp0C == 0)
+    {
+        r2 = &gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[4];
+        for (i = 0; i < RFU_CHILD_MAX; ++i)
+            gRfuLinkStatus->strength[i] = *r2++;
+        r9 = 0;
+        i = 0;
+    }
+    else
+    {
+        rfu_STC_REQ_callback(17, sp0C);
+        return sp0C;
+    }
+    for (; i < RFU_CHILD_MAX; ++i)
+    {
+        if (gRfuStatic->lsFixedCount[i] != 0)
+        {
+            gRfuStatic->lsFixedCount[i] -= 4;
+            if (gRfuLinkStatus->strength[i] <= 15)
+                gRfuLinkStatus->strength[i] = 16;
+        }
+        r6 = 1 << i;
+        if (sp0C == 0)
+        {
+            if (sp08 == 1 && (gRfuLinkStatus->connSlotFlag & r6))
+            {
+                if (gRfuLinkStatus->strength[i] == 0)
+                {
+                    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+                    {
+                        ++gRfuStatic->linkEmergencyFlag[i];
+                        if (gRfuStatic->linkEmergencyFlag[i] > 3)
+                        {
+                            *bmLinkLossSlot |= r6;
+                            *linkLossReason = sp08; // why not directly use REASON_LINK_LOSS?
+                        }
+                    }
+                    else
+                    {
+                        STWI_send_SystemStatusREQ();
+                        if (STWI_poll_CommandEnd() == 0)
+                        {
+                            if (gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[7] == 0)
+                            {
+                                *bmLinkLossSlot |= r6;
+                                *linkLossReason = sp08; // why not directly use REASON_LINK_LOSS?
+                            }
+                            else
+                            {
+                                if (++gRfuStatic->linkEmergencyFlag[i] > gRfuStatic->unk_1a)
+                                {
+                                    gRfuStatic->linkEmergencyFlag[i] = 0;
+                                    STWI_send_DisconnectREQ(gRfuLinkStatus->connSlotFlag);
+                                    STWI_poll_CommandEnd();
+                                    *bmLinkLossSlot |= r6;
+                                    *linkLossReason = sp08; // why not directly use REASON_LINK_LOSS?
+                                }
+                            }
+                        }
+                    }
+                }
+                else
+                {
+                    gRfuStatic->linkEmergencyFlag[i] = sp0C; // why not directly use 0? 
+                }
+            }
+            if (gRfuLinkStatus->parentChild == MODE_PARENT && gRfuLinkStatus->strength[i] != 0)
+            {
+                if (r6 & gRfuLinkStatus->linkLossSlotFlag)
+                {
+                    if (gRfuLinkStatus->strength[i] > 10)
+                    {
+                        *parentBmLinkRecoverySlot |= r6;
+                        gRfuLinkStatus->connSlotFlag |= r6;
+                        gRfuLinkStatus->linkLossSlotFlag &= ~r6;
+                        ++gRfuLinkStatus->connCount;
+                        gRfuStatic->linkEmergencyFlag[i] = 0;
+                    }
+                    else
+                    {
+                        gRfuLinkStatus->strength[i] = 0;
+                    }
+                }
+                else
+                {
+                    if (!((gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag) & r6))
+                    {
+                        STWI_send_SlotStatusREQ();
+                        STWI_poll_CommandEnd();
+                        r2 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data;
+                        r3 = r2[1] - 1;
+                        for (r2 += 8; r3 != 0; r2 += 4, --r3)
+                        {
+                            u16 r4 = *(u16 *)r2;
+
+                            if (r2[2] == i && r4 == gRfuStatic->cidBak[i])
+                            {
+                                r9 |= 1 << i;
+                                break;
+                            }
+                        }
+                    }
+                }
+            }
+        }
+        connSlotFlag = gRfuLinkStatus->connSlotFlag;
+        r0 = *bmLinkLossSlot;
+        r0 &= connSlotFlag;
+        if (r6 & r0)
+            rfu_STC_removeLinkData(i, 0);
+    }
+    if (r9 != 0)
+    {
+        STWI_send_DisconnectREQ(r9);
+        STWI_poll_CommandEnd();
+    }
+    // equivalent to:
+    // gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.command = sp10;
+    *(u32 *)gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data = sp10;
+    gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.data[0] = sp14;
+    return 0;
+}
+
+static void rfu_STC_removeLinkData(u8 r7, u8 r12)
+{
+    u8 r5 = 1 << r7;
+    s32 r6;
+
+    gRfuStatic->lsFixedCount[r7] = 0;
+    if ((gRfuLinkStatus->connSlotFlag & r5) && gRfuLinkStatus->connCount != 0)
+        --gRfuLinkStatus->connCount;
+    gRfuLinkStatus->connSlotFlag &= r6 = ~r5;
+    gRfuLinkStatus->linkLossSlotFlag |= r5;
+    if ((*(u32 *)gRfuLinkStatus & 0xFF00FF) == 0)
+        gRfuLinkStatus->parentChild = MODE_NEUTRAL;
+    if (r12 != 0)
+    {
+        CpuFill16(0, &gRfuLinkStatus->partner[r7], sizeof(struct RfuTgtData));
+        gRfuLinkStatus->linkLossSlotFlag &= r6;
+        gRfuLinkStatus->getNameFlag &= r6;
+        gRfuLinkStatus->strength[r7] = 0;
+    }
+}
+
+void rfu_REQ_disconnect(u8 bmDisconnectSlot)
+{
+    u16 r1;
+
+    if ((gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag) & bmDisconnectSlot)
+    {
+        gRfuStatic->recoveryBmSlot = bmDisconnectSlot;
+        if (gRfuLinkStatus->parentChild == MODE_NEUTRAL && gRfuStatic->flags & 0x80)
+        {
+            if (gRfuLinkStatus->linkLossSlotFlag & bmDisconnectSlot)
+                rfu_CB_disconnect(48, 0);
+        }
+        else if (gRfuStatic->SCStartFlag
+              && (STWI_set_Callback_M(rfu_CB_defaultCallback),
+                  STWI_send_SC_EndREQ(),
+                  (r1 = STWI_poll_CommandEnd()) != 0))
+        {
+            rfu_STC_REQ_callback(27, r1);
+        }
+        else
+        {
+            STWI_set_Callback_M(rfu_CB_disconnect);
+            STWI_send_DisconnectREQ(bmDisconnectSlot);
+        }
+    }
+}
+
+static void rfu_CB_disconnect(u8 r6, u16 r5)
+{
+    u8 r4, r0;
+
+    if (r5 == 3 && gRfuLinkStatus->parentChild == MODE_CHILD)
+    {
+        STWI_set_Callback_M(rfu_CB_defaultCallback);
+        STWI_send_SystemStatusREQ();
+        if (STWI_poll_CommandEnd() == 0 && gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[7] == 0)
+            r5 = 0;
+    }
+    gRfuStatic->recoveryBmSlot &= gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag;
+    gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[8] = gRfuStatic->recoveryBmSlot;
+    if (r5 == 0)
+    {
+        for (r4 = 0; r4 < RFU_CHILD_MAX; ++r4)
+        {
+            r0 = 1 << r4;
+            if (r0 & gRfuStatic->recoveryBmSlot)
+                rfu_STC_removeLinkData(r4, 1);
+        }
+    }
+    if ((gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag) == 0)
+        gRfuLinkStatus->parentChild = MODE_NEUTRAL;
+    rfu_STC_REQ_callback(r6, r5);
+    if (gRfuStatic->SCStartFlag)
+    {
+        STWI_set_Callback_M(rfu_CB_defaultCallback);
+        STWI_send_SC_StartREQ();
+        r5 = STWI_poll_CommandEnd();
+        if (r5 != 0)
+            rfu_STC_REQ_callback(25, r5);
+    }
+}
+
+void rfu_REQ_CHILD_startConnectRecovery(u8 bmRecoverySlot)
+{
+    u8 i;
+
+    gRfuStatic->recoveryBmSlot = bmRecoverySlot;
+    for (i = 0; i < RFU_CHILD_MAX && !((bmRecoverySlot >> i) & 1); ++i)
+        ;
+    STWI_set_Callback_M(rfu_STC_REQ_callback);
+    // if i == 4, gRfuLinkStatus->partner[i].id becomes gRfuLinkStatus->my.id
+    STWI_send_CPR_StartREQ(gRfuLinkStatus->partner[i].id, gRfuLinkStatus->my.id, bmRecoverySlot);
+}
+
+void rfu_REQ_CHILD_pollConnectRecovery(void)
+{
+    STWI_set_Callback_M(rfu_CB_CHILD_pollConnectRecovery);
+    STWI_send_CPR_PollingREQ();
+}
+
+static void rfu_CB_CHILD_pollConnectRecovery(u8 r8, u16 r7)
+{
+    u8 r3, r4;
+    struct RfuLinkStatus *r2;
+
+    if (r7 == 0 && gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[4] == 0 && gRfuStatic->recoveryBmSlot)
+    {
+        gRfuLinkStatus->parentChild = MODE_CHILD;
+        for (r4 = 0; r4 < NELEMS(gRfuStatic->linkEmergencyFlag); ++r4)
+        {
+            r3 = 1 << r4;
+            r2 = gRfuLinkStatus; // ???
+            if (gRfuStatic->recoveryBmSlot & r3 & r2->linkLossSlotFlag)
+            {
+                gRfuLinkStatus->connSlotFlag |= r3;
+                gRfuLinkStatus->linkLossSlotFlag &= ~r3;
+                ++gRfuLinkStatus->connCount;
+                gRfuStatic->linkEmergencyFlag[r4] = 0;
+            }
+        }
+        gRfuStatic->recoveryBmSlot = 0;
+    }
+    rfu_STC_REQ_callback(r8, r7);
+}
+
+u16 rfu_CHILD_getConnectRecoveryStatus(u8 *status)
+{
+    u8 r0;
+
+    *status = 0xFF;
+    r0 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[0] + 77;
+    if (r0 <= 1)
+    {
+        *status = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[4];
+        return 0;
+    }
+    return ERR_REQ_CMD_ID;
+}
+
+void rfu_REQ_CHILD_endConnectRecovery(void)
+{
+    STWI_set_Callback_M(rfu_CB_CHILD_pollConnectRecovery);
+    STWI_send_CPR_EndREQ();
+}
+
+static void rfu_STC_fastCopy(const u8 **src_p, u8 **dst_p, s32 size)
+{
+    const u8 *src = *src_p;
+    u8 *dst = *dst_p;
+    s32 i;
+
+    for (i = size - 1; i != -1; --i)
+        *dst++ = *src++;
+    *src_p = src;
+    *dst_p = dst;
+}
+
+void rfu_REQ_changeMasterSlave(void)
+{
+    if (STWI_read_status(1) == 1)
+    {
+        STWI_set_Callback_M(rfu_STC_REQ_callback);
+        STWI_send_MS_ChangeREQ();
+    }
+    else
+    {
+        rfu_STC_REQ_callback(39, 0);
+    }
+}
+
+bool8 rfu_getMasterSlave(void)
+{
+    bool8 masterSlave = STWI_read_status(1);
+
+    if (masterSlave == AGB_CLK_MASTER)
+    {
+        if (gSTWIStatus->unk_2c)
+        {
+            if (gSTWIStatus->reqActiveCommand == 39
+             || gSTWIStatus->reqActiveCommand == 37
+             || gSTWIStatus->reqActiveCommand == 55)
+                masterSlave = AGB_CLK_SLAVE;
+        }
+    }
+    return masterSlave;
+}
+
+void rfu_clearAllSlot(void)
+{
+    u16 i;
+    u16 IMEBackup = REG_IME;
+    
+    REG_IME = 0;
+    for (i = 0; i < RFU_CHILD_MAX; ++i)
+    {
+        CpuFill16(0, gRfuSlotStatusNI[i], 2 * sizeof(struct NIComm));
+        CpuFill16(0, gRfuSlotStatusUNI[i], sizeof(struct UNISend) + sizeof(struct UNIRecv));
+        gRfuLinkStatus->remainLLFrameSizeChild[i] = 16;
+    }
+    gRfuLinkStatus->remainLLFrameSizeParent = LLF_P_SIZE;
+    gRfuLinkStatus->sendSlotNIFlag = 0;
+    gRfuLinkStatus->recvSlotNIFlag = 0;
+    gRfuLinkStatus->sendSlotUNIFlag = 0;
+    gRfuStatic->recvRenewalFlag = 0;
+    REG_IME = IMEBackup;
+}
+
+static void rfu_STC_releaseFrame(u8 r5, u8 r3, struct NIComm *r4)
+{
+
+    if (!(gRfuStatic->flags & 0x80))
+    {
+        if (r3 == 0)
+            gRfuLinkStatus->remainLLFrameSizeParent += r4->payloadSize;
+        gRfuLinkStatus->remainLLFrameSizeParent += 3;
+    }
+    else
+    {
+        if (r3 == 0)
+            gRfuLinkStatus->remainLLFrameSizeChild[r5] += r4->payloadSize;
+        gRfuLinkStatus->remainLLFrameSizeChild[r5] += 2;
+    }
+}
+
+u16 rfu_clearSlot(u8 connTypeFlag, u8 slotStatusIndex)
+{
+    u16 r10, r3, r1;
+    struct NIComm *r4;
+
+    if (slotStatusIndex >= RFU_CHILD_MAX)
+        return ERR_SLOT_NO;
+    if (!(connTypeFlag & (TYPE_UNI_SEND | TYPE_UNI_RECV | TYPE_NI_SEND | TYPE_NI_RECV)))
+        return ERR_COMM_TYPE;
+    r10 = REG_IME;
+    REG_IME = 0;
+    if (connTypeFlag & (TYPE_NI_SEND | TYPE_NI_RECV))
+    {
+        for (r3 = 0; r3 < 2; ++r3)
+        {
+            r4 = NULL;
+            if (r3 == 0)
+            {
+                if (connTypeFlag & TYPE_NI_SEND)
+                {
+                    r4 = &gRfuSlotStatusNI[slotStatusIndex]->send;
+                    gRfuLinkStatus->sendSlotNIFlag &= ~r4->bmSlotOrg;
+                }
+            }
+            else
+            {
+                if (connTypeFlag & TYPE_NI_RECV)
+                {
+                    r4 = &gRfuSlotStatusNI[slotStatusIndex]->recv;
+                    gRfuLinkStatus->recvSlotNIFlag &= ~(1 << slotStatusIndex);
+                }
+            }
+            if (r4 != NULL)
+            {
+                if (r4->state & SLOT_BUSY_FLAG)
+                {
+                    rfu_STC_releaseFrame(slotStatusIndex, r3, r4);
+                    for (r1 = 0; r1 < RFU_CHILD_MAX; ++r1)
+                        if ((r4->bmSlotOrg >> r1) & 1)
+                            r4->failCounter = 0;
+                }
+                CpuFill16(0, r4, sizeof(struct NIComm));
+            }
+        }
+    }
+    if (connTypeFlag & TYPE_UNI_SEND)
+    {
+        struct RfuSlotStatusUNI *r3 = gRfuSlotStatusUNI[slotStatusIndex];
+
+        if (r3->send.state & SLOT_BUSY_FLAG)
+        {
+            if (!(gRfuStatic->flags & 0x80))
+                gRfuLinkStatus->remainLLFrameSizeParent += 3 + (u8)r3->send.payloadSize;
+            else
+                gRfuLinkStatus->remainLLFrameSizeChild[slotStatusIndex] += 2 + (u8)r3->send.payloadSize;
+            gRfuLinkStatus->sendSlotUNIFlag &= ~r3->send.bmSlot;
+        }
+        CpuFill16(0, &r3->send, sizeof(struct UNISend));
+    }
+    if (connTypeFlag & TYPE_UNI_RECV)
+    {
+        CpuFill16(0, &gRfuSlotStatusUNI[slotStatusIndex]->recv, sizeof(struct UNIRecv));
+    }
+    REG_IME = r10;
+    return 0;
+}
+
+u16 rfu_setRecvBuffer(u8 connType, u8 slotNo, void *buffer, u32 buffSize)
+{
+    if (slotNo >= RFU_CHILD_MAX)
+        return ERR_SLOT_NO;
+    if (connType & TYPE_NI)
+    {
+        gRfuSlotStatusNI[slotNo]->recvBuffer = buffer;
+        gRfuSlotStatusNI[slotNo]->recvBufferSize = buffSize;
+    }
+    else if (!(connType & TYPE_UNI))
+    {
+        return ERR_COMM_TYPE;
+    }
+    else
+    {
+        gRfuSlotStatusUNI[slotNo]->recvBuffer = buffer;
+        gRfuSlotStatusUNI[slotNo]->recvBufferSize = buffSize;
+    }
+    return 0;
+}
+
+u16 rfu_NI_setSendData(u8 bmSendSlot, u8 subFrameSize, const void *src, u32 size)
+{
+    return rfu_STC_setSendData_org(32, bmSendSlot, subFrameSize, src, size);
+}
+
+u16 rfu_UNI_setSendData(u8 bmSendSlot, const void *src, u8 size)
+{
+    u8 subFrameSize;
+
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        subFrameSize = size + 3;
+    else
+        subFrameSize = size + 2;
+    return rfu_STC_setSendData_org(16, bmSendSlot, subFrameSize, src, 0);
+}
+
+u16 rfu_NI_CHILD_setSendGameName(u8 slotNo, u8 subFrameSize)
+{
+    return rfu_STC_setSendData_org(64, 1 << slotNo, subFrameSize, &gRfuLinkStatus->my.serialNo, 26);
+}
+
+static u16 rfu_STC_setSendData_org(u8 r6, u8 bmSendSlot, u8 subFrameSize, const void *src, u32 sp28)
+{
+    u8 r2, r0;
+    u8 r4;
+    u8 *r9;
+    u8 r5;
+    u8 i;
+    u16 sp04;
+    struct RfuSlotStatusUNI *r1;
+    struct RfuSlotStatusNI *r12;
+
+    if (gRfuLinkStatus->parentChild == MODE_NEUTRAL)
+        return ERR_MODE_NOT_CONNECTED;
+    if (!(bmSendSlot & 0xF))
+        return ERR_SLOT_NO;
+    if (((gRfuLinkStatus->connSlotFlag | gRfuLinkStatus->linkLossSlotFlag) & bmSendSlot) != bmSendSlot)
+        return ERR_SLOT_NOT_CONNECTED;
+    if (r6 & 0x10)
+        r0 = gRfuLinkStatus->sendSlotUNIFlag;
+    else
+        r0 = gRfuLinkStatus->sendSlotNIFlag;
+    if (r0 & bmSendSlot)
+        return ERR_SLOT_BUSY;
+    for (r2 = 0; r2 < RFU_CHILD_MAX && !((bmSendSlot >> r2) & 1); ++r2)
+        ;
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        r9 = &gRfuLinkStatus->remainLLFrameSizeParent;
+    else if (gRfuLinkStatus->parentChild == MODE_CHILD)
+        r9 = &gRfuLinkStatus->remainLLFrameSizeChild[r2];
+    r4 = llsf_struct[gRfuLinkStatus->parentChild].unk00;
+    if (subFrameSize > *r9 || subFrameSize <= r4)
+        return ERR_SUBFRAME_SIZE;
+    sp04 = REG_IME;
+    REG_IME = 0;
+    r5 = r6 & 0x20;
+    if (r5 || r6 == 0x40)
+    {
+        u8 *r1; // a hack to swap instructions
+
+        r12 = gRfuSlotStatusNI[r2];
+        r1 = NULL;
+        r12->send.errorCode = 0;
+        *r12->send.now_p = r1 = &r12->send.dataType;
+        r12->send.remainSize = 7;
+        r12->send.bmSlotOrg = bmSendSlot;
+        r12->send.bmSlot = bmSendSlot;
+        r12->send.payloadSize = subFrameSize - r4;
+        if (r5 != 0)
+            *r1 = 0;
+        else
+            *r1 = 1;
+        r12->send.dataSize = sp28;
+        r12->send.src = src;
+        r12->send.ack = 0;
+        r12->send.phase = 0;
+    #ifndef NONMATCHING // to fix r2, r3, r4, r5 register roulette
+        asm("":::"r2");
+    #endif
+        for (i = 0; i < WINDOW_COUNT; ++i)
+        {
+            r12->send.recvAckFlag[i] = 0;
+            r12->send.n[i] = 1;
+        }
+        for (r2 = 0; r2 < RFU_CHILD_MAX; ++r2)
+            if ((bmSendSlot >> r2) & 1)
+                gRfuSlotStatusNI[r2]->send.failCounter = 0;
+        gRfuLinkStatus->sendSlotNIFlag |= bmSendSlot;
+        *r9 -= subFrameSize;
+        r12->send.state = SLOT_STATE_SEND_START;
+    }
+    else if (r6 & 0x10)
+    {
+        r1 = gRfuSlotStatusUNI[r2];
+        r1->send.bmSlot = bmSendSlot;
+        r1->send.src = src;
+        r1->send.payloadSize = subFrameSize - r4;
+        *r9 -= subFrameSize;
+        r1->send.state = SLOT_STATE_SEND_UNI;
+        gRfuLinkStatus->sendSlotUNIFlag |= bmSendSlot;
+    }
+    REG_IME = sp04;
+    return 0;
+}
+
+u16 rfu_changeSendTarget(u8 connType, u8 slotStatusIndex, u8 bmNewTgtSlot)
+{
+    struct RfuSlotStatusNI *r5;
+    u16 r8;
+    u8 r2;
+
+    if (slotStatusIndex >= RFU_CHILD_MAX)
+        return ERR_SLOT_NO;
+    if (connType == 0x20)
+    {
+        r5 = gRfuSlotStatusNI[slotStatusIndex];
+        if ((r5->send.state & SLOT_BUSY_FLAG)
+         && (r5->send.state & SLOT_SEND_FLAG))
+        {
+            connType = bmNewTgtSlot ^ r5->send.bmSlot;
+            
+            if (!(connType & bmNewTgtSlot))
+            {
+                if (connType)
+                {
+                    r8 = REG_IME;
+                    REG_IME = 0;
+                    for (r2 = 0; r2 < RFU_CHILD_MAX; ++r2)
+                    {
+                        if ((connType >> r2) & 1)
+                            gRfuSlotStatusNI[r2]->send.failCounter = 0;
+                    }
+                    gRfuLinkStatus->sendSlotNIFlag &= ~connType;
+                    r5->send.bmSlot = bmNewTgtSlot;
+                    if (r5->send.bmSlot == 0)
+                    {
+                        rfu_STC_releaseFrame(slotStatusIndex, 0, &r5->send);
+                        r5->send.state = SLOT_STATE_SEND_FAILED;
+                    }
+                    REG_IME = r8;
+                }
+            }
+            else
+            {
+                return ERR_SLOT_TARGET;
+            }
+        }
+        else
+        {
+            return ERR_SLOT_NOT_SENDING;
+        }
+    }
+    else
+    {
+        if (connType == 16)
+        {
+            s32 r3;
+
+            if (gRfuSlotStatusUNI[slotStatusIndex]->send.state != SLOT_STATE_SEND_UNI)
+                return ERR_SLOT_NOT_SENDING;
+            for (r3 = 0, r2 = 0; r2 < RFU_CHILD_MAX; ++r2)
+                if (r2 != slotStatusIndex)
+                    r3 |= gRfuSlotStatusUNI[r2]->send.bmSlot;
+            if (bmNewTgtSlot & r3)
+                return ERR_SLOT_TARGET;
+            r8 = REG_IME;
+            REG_IME = 0;
+            gRfuLinkStatus->sendSlotUNIFlag &= ~gRfuSlotStatusUNI[slotStatusIndex]->send.bmSlot;
+            gRfuLinkStatus->sendSlotUNIFlag |= bmNewTgtSlot;
+            gRfuSlotStatusUNI[slotStatusIndex]->send.bmSlot = bmNewTgtSlot;
+            REG_IME = r8;
+        }
+        else
+        {
+            return ERR_COMM_TYPE;
+        }
+    }
+    return 0;
+}
+
+u16 rfu_NI_stopReceivingData(u8 slotStatusIndex)
+{
+    struct NIComm *r5;
+    u16 r4, r1;
+
+    if (slotStatusIndex >= RFU_CHILD_MAX)
+        return ERR_SLOT_NO;
+    r5 = &gRfuSlotStatusNI[slotStatusIndex]->recv;
+    r4 = REG_IME;
+    ++r4; --r4; // fix r4, r5 register swap
+    REG_IME = 0;
+    if (gRfuSlotStatusNI[slotStatusIndex]->recv.state & SLOT_BUSY_FLAG)
+    {
+        if (gRfuSlotStatusNI[slotStatusIndex]->recv.state == SLOT_STATE_RECV_LAST)
+            gRfuSlotStatusNI[slotStatusIndex]->recv.state = SLOT_STATE_RECV_SUCCESS_AND_SENDSIDE_UNKNOWN;
+        else
+            gRfuSlotStatusNI[slotStatusIndex]->recv.state = SLOT_STATE_RECV_FAILED;
+        gRfuLinkStatus->recvSlotNIFlag &= ~(1 << slotStatusIndex);
+        rfu_STC_releaseFrame(slotStatusIndex, 1, r5);
+    }
+    REG_IME = r4;
     return 0;
-}*/
+}
+
+u16 rfu_UNI_changeAndReadySendData(u8 slotStatusIndex, const void *src, u8 size)
+{
+    struct UNISend *r4;
+    u8 *r6;
+    u16 r1;
+    u8 r3_;
+
+    if (slotStatusIndex >= RFU_CHILD_MAX)
+        return ERR_SLOT_NO;
+    r4 = &gRfuSlotStatusUNI[slotStatusIndex]->send;
+    if (r4->state != SLOT_STATE_SEND_UNI)
+        return ERR_SLOT_NOT_SENDING;
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+    {
+        r6 = &gRfuLinkStatus->remainLLFrameSizeParent;
+        r3_ = gRfuLinkStatus->remainLLFrameSizeParent + (u8)r4->payloadSize;
+    }
+    else
+    {
+        r6 = &gRfuLinkStatus->remainLLFrameSizeChild[slotStatusIndex];
+        r3_ = gRfuLinkStatus->remainLLFrameSizeChild[slotStatusIndex] + (u8)r4->payloadSize;
+    }
+    if (r3_ < size)
+        return ERR_SUBFRAME_SIZE;
+    r1 = REG_IME;
+    REG_IME = 0;
+    r4->src = src;
+    *r6 = r3_ - size;
+    r4->payloadSize = size;
+    r4->dataReadyFlag = 1;
+    REG_IME = r1;
+    return 0;
+}
+
+void rfu_UNI_readySendData(u8 slotStatusIndex)
+{
+    if (slotStatusIndex < RFU_CHILD_MAX)
+    {
+        if (gRfuSlotStatusUNI[slotStatusIndex]->send.state == SLOT_STATE_SEND_UNI)
+            gRfuSlotStatusUNI[slotStatusIndex]->send.dataReadyFlag = 1;
+    }
+}
+
+void rfu_UNI_clearRecvNewDataFlag(u8 slotStatusIndex)
+{
+    if (slotStatusIndex < RFU_CHILD_MAX)
+        gRfuSlotStatusUNI[slotStatusIndex]->recv.newDataFlag = 0;
+}
+
+void rfu_REQ_sendData(bool8 clockChangeFlag)
+{
+    if (gRfuLinkStatus->parentChild != MODE_NEUTRAL)
+    {
+        if (gRfuLinkStatus->parentChild == MODE_PARENT
+         && !(gRfuLinkStatus->sendSlotNIFlag | gRfuLinkStatus->recvSlotNIFlag | gRfuLinkStatus->sendSlotUNIFlag))
+        {
+            if (gRfuStatic->commExistFlag)
+            {
+                gRfuStatic->emberCount = 16;
+                gRfuStatic->nullFrameCount = 0;
+            }
+            if (gRfuStatic->emberCount)
+                --gRfuStatic->emberCount;
+            else
+                ++gRfuStatic->nullFrameCount;
+            if (gRfuStatic->emberCount
+             || !(gRfuStatic->nullFrameCount & 0xF))
+            {
+                gRfuFixed->LLFBuffer[0] = 1;
+                gRfuFixed->LLFBuffer[4] = 0xFF;
+                STWI_set_Callback_M(rfu_CB_sendData3);
+                if (!clockChangeFlag)
+                    STWI_send_DataTxREQ(gRfuFixed->LLFBuffer, 1);
+                else
+                    STWI_send_DataTxAndChangeREQ(gRfuFixed->LLFBuffer, 1);
+                return;
+            }
+        }
+        else
+        {
+            if (!gRfuLinkStatus->LLFReadyFlag)
+                rfu_constructSendLLFrame();
+            if (gRfuLinkStatus->LLFReadyFlag)
+            {
+                STWI_set_Callback_M(rfu_CB_sendData);
+                if (clockChangeFlag)
+                {
+                    STWI_send_DataTxAndChangeREQ(gRfuFixed->LLFBuffer, gRfuStatic->totalPacketSize + 4);
+                    return;
+                }
+                STWI_send_DataTxREQ(gRfuFixed->LLFBuffer, gRfuStatic->totalPacketSize + 4);
+            }
+        }
+        if (clockChangeFlag)
+        {
+            if (gRfuLinkStatus->parentChild == MODE_PARENT)
+            {
+                if (gSTWIStatus->callbackS != NULL)
+                    gSTWIStatus->callbackS(39);
+            }
+            else
+            {
+                STWI_set_Callback_M(rfu_CB_sendData2);
+                STWI_send_MS_ChangeREQ();
+            }
+        }
+    }
+}
+
+static void rfu_CB_sendData(__attribute__((unused)) u8 r0, u16 r7)
+{
+    u8 r6;
+    struct NIComm *r4;
+
+    if (r7 == 0)
+    {
+        for (r6 = 0; r6 < RFU_CHILD_MAX; ++r6)
+        {
+            if (gRfuSlotStatusUNI[r6]->send.dataReadyFlag)
+                gRfuSlotStatusUNI[r6]->send.dataReadyFlag = 0;
+            r4 = &gRfuSlotStatusNI[r6]->send;
+            if (r4->state == SLOT_STATE_SEND_NULL)
+            {
+                rfu_STC_releaseFrame(r6, 0, r4);
+                gRfuLinkStatus->sendSlotNIFlag &= ~r4->bmSlot;
+                if (r4->dataType == 1)
+                    gRfuLinkStatus->getNameFlag |= 1 << r6;
+                r4->state = SLOT_STATE_SEND_SUCCESS;
+            }
+        }
+    }
+    gRfuLinkStatus->LLFReadyFlag = 0;
+    rfu_STC_REQ_callback(36, r7);
+}
+
+static void rfu_CB_sendData2(__attribute__((unused)) u8 r0, u16 r1)
+{
+    rfu_STC_REQ_callback(36, r1);
+}
+
+static void rfu_CB_sendData3(u8 r0, u16 r1)
+{
+    if (r1 != 0)
+        rfu_STC_REQ_callback(36, r1);
+    else if (r0 == 0xFF)
+        rfu_STC_REQ_callback(0xFF, 0);
+}
+
+static void rfu_constructSendLLFrame(void)
+{
+    u32 r8, r5;
+    u8 r6;
+    u8 *sp00;
+    struct RfuSlotStatusNI *r2;
+
+    if (gRfuLinkStatus->parentChild != MODE_NEUTRAL
+     && gRfuLinkStatus->sendSlotNIFlag | gRfuLinkStatus->recvSlotNIFlag | gRfuLinkStatus->sendSlotUNIFlag)
+    {
+        gRfuLinkStatus->LLFReadyFlag = 0;
+        r8 = 0;
+        sp00 = (u8 *)&gRfuFixed->LLFBuffer[1];
+        for (r6 = 0; r6 < RFU_CHILD_MAX; ++r6)
+        {
+            r5 = 0;
+            if (gRfuSlotStatusNI[r6]->send.state & SLOT_BUSY_FLAG)
+                r5 = rfu_STC_NI_constructLLSF(r6, &sp00, &gRfuSlotStatusNI[r6]->send);
+            if (gRfuSlotStatusNI[r6]->recv.state & SLOT_BUSY_FLAG)
+                r5 += rfu_STC_NI_constructLLSF(r6, &sp00, &gRfuSlotStatusNI[r6]->recv);
+            if (gRfuSlotStatusUNI[r6]->send.state == SLOT_STATE_SEND_UNI)
+                r5 += rfu_STC_UNI_constructLLSF(r6, &sp00);
+            if (r5 != 0)
+            {
+                if (gRfuLinkStatus->parentChild == MODE_PARENT)
+                    r8 += r5;
+                else
+                    r8 |= r5 << (5 * r6 + 8);
+            }
+        }
+        if (r8 != 0)
+        {
+            while ((u32)sp00 & 3)
+                *sp00++ = 0;
+            gRfuFixed->LLFBuffer[0] = r8;
+            if (gRfuLinkStatus->parentChild == MODE_CHILD)
+            {
+                u8 *r0 = sp00 - offsetof(struct RfuFixed, LLFBuffer[1]);
+                
+                // Does the volatile qualifier make sense? 
+                // It's the same as: 
+                // asm("":::"memory");
+                r8 = r0 - *(u8 *volatile *)&gRfuFixed;
+            }
+        }
+        gRfuStatic->totalPacketSize = r8;
+    }
+}
+
+static u16 rfu_STC_NI_constructLLSF(u8 r10, u8 **r12, struct NIComm *r4)
+{
+    u16 r5;
+    u32 sp00;
+    u8 i;
+    u8 *r2;
+    const struct LLSFStruct *r8 = &llsf_struct[gRfuLinkStatus->parentChild];
+
+    if (r4->state == SLOT_STATE_SENDING)
+    {
+        while (r4->now_p[r4->phase] >= (const u8 *)r4->src + r4->dataSize)
+        {
+            ++r4->phase;
+            if (r4->phase == 4)
+                r4->phase = 0;
+        }
+    }
+    if (r4->state & SLOT_RECV_FLAG)
+    {
+        r5 = 0;
+    }
+    else if (r4->state == SLOT_STATE_SENDING)
+    {
+        if (r4->now_p[r4->phase] + r4->payloadSize > (const u8 *)r4->src + r4->dataSize)
+            r5 = (const u8 *)r4->src + r4->dataSize - r4->now_p[r4->phase];
+        else
+            r5 = r4->payloadSize;
+    }
+    else
+    {
+        if ((u32)r4->remainSize >= r4->payloadSize)
+            r5 = r4->payloadSize;
+        else
+            r5 = r4->remainSize;
+    }
+    sp00 = (r4->state & 0xF) << r8->unk03
+         | r4->ack << r8->unk04
+         | r4->phase << r8->unk05
+         | r4->n[r4->phase] << r8->unk06
+         | r5;
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        sp00 |= r4->bmSlot << 18;
+    r2 = (u8 *)&sp00;
+    for (i = 0; i < r8->unk00; ++i)
+        *(*r12)++ = *r2++;
+    if (r5 != 0)
+    {
+        const u8 *sp04 = r4->now_p[r4->phase];
+
+        gRfuFixed->fastCopyPtr(&sp04, r12, r5);
+    }
+    if (r4->state == SLOT_STATE_SENDING)
+    {
+        ++r4->phase;
+        if (r4->phase == 4)
+            r4->phase = 0;
+    }
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        gRfuLinkStatus->LLFReadyFlag = 1;
+    else
+        gRfuLinkStatus->LLFReadyFlag |= 1 << r10;
+    return r5 + r8->unk00;
+}
+
+static u16 rfu_STC_UNI_constructLLSF(u8 r8, u8 **r6)
+{
+    const struct LLSFStruct *r5;
+    const u8 *sp04;
+    u32 sp00;
+    u8 *r2;
+    u8 i;
+    struct UNISend *r4 = &gRfuSlotStatusUNI[r8]->send;
+
+    if (!r4->dataReadyFlag || !r4->bmSlot)
+        return 0;
+    r5 = &llsf_struct[gRfuLinkStatus->parentChild];
+    sp00 = (r4->state & 0xF) << r5->unk03
+         | r4->payloadSize;
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        sp00 |= r4->bmSlot << 18;
+    r2 = (u8 *)&sp00;
+    for (i = 0; i < r5->unk00; ++i)
+        *(*r6)++ = *r2++;
+    sp04 = r4->src;
+    gRfuFixed->fastCopyPtr(&sp04, r6, r4->payloadSize);
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        gRfuLinkStatus->LLFReadyFlag = 16;
+    else
+        gRfuLinkStatus->LLFReadyFlag |= 16 << r8;
+    return r5->unk00 + r4->payloadSize;
+}
+
+void rfu_REQ_recvData(void)
+{
+    if (gRfuLinkStatus->parentChild != MODE_NEUTRAL)
+    {
+        gRfuStatic->commExistFlag = gRfuLinkStatus->sendSlotNIFlag | gRfuLinkStatus->recvSlotNIFlag | gRfuLinkStatus->sendSlotUNIFlag;
+        gRfuStatic->recvErrorFlag = 0;
+        STWI_set_Callback_M(rfu_CB_recvData);
+        STWI_send_DataRxREQ();
+    }
+}
+
+static void rfu_CB_recvData(u8 r9, u16 r7)
+{
+    u8 r6;
+    struct RfuSlotStatusNI *r4;
+    struct NIComm *r5;
+
+    if (r7 == 0 && gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[1])
+    {
+        gRfuStatic->NIEndRecvFlag = 0;
+        if (gRfuLinkStatus->parentChild == MODE_PARENT)
+            rfu_STC_PARENT_analyzeRecvPacket();
+        else
+            rfu_STC_CHILD_analyzeRecvPacket();
+        for (r6 = 0; r6 < RFU_CHILD_MAX; ++r6)
+        {
+            r4 = gRfuSlotStatusNI[r6];
+            if (r4->recv.state == SLOT_STATE_RECV_LAST && !((gRfuStatic->NIEndRecvFlag >> r6) & 1))
+            {
+                r5 = &r4->recv;
+                if (r5->dataType == 1)
+                    gRfuLinkStatus->getNameFlag |= 1 << r6;
+                rfu_STC_releaseFrame(r6, 1, r5);
+                gRfuLinkStatus->recvSlotNIFlag &= ~r5->bmSlot;
+                r4->recv.state = SLOT_STATE_RECV_SUCCESS;
+            }
+        }
+        if (gRfuStatic->recvErrorFlag)
+            r7 = gRfuStatic->recvErrorFlag | ERR_DATA_RECV;
+    }
+    rfu_STC_REQ_callback(r9, r7);
+}
+
+static void rfu_STC_PARENT_analyzeRecvPacket(void)
+{
+    u32 r3;
+    u8 r5;
+    u8 sp[4];
+    u8 *r6;
+
+    r3 = gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket32.data[0] >> 8;
+    for (r5 = 0; r5 < NELEMS(sp); ++r5)
+    {
+        sp[r5] = r3 & 0x1F;
+        r3 >>= 5;
+        if (sp[r5] == 0)
+            gRfuStatic->NIEndRecvFlag |= 1 << r5;
+    }
+    r6 = &gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[8];
+    for (r5 = 0; r5 < NELEMS(sp); ++r5)
+    {
+        if (sp[r5])
+        {
+            u8 *r4 = &sp[r5];
+
+            do
+            {
+                u8 r0 = rfu_STC_analyzeLLSF(r5, r6, *r4);
+
+                r6 += r0;
+                *r4 -= r0;
+            } while (!(*r4 & 0x80) && (*r4));
+        }
+    }
+}
+
+static void rfu_STC_CHILD_analyzeRecvPacket(void)
+{
+    u16 r4;
+    u8 *r5;
+    u16 r0;
+
+    r4 = *(u16 *)&gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[4] & 0x7F;
+    r5 = &gRfuFixed->STWIBuffer->rxPacketAlloc.rfuPacket8.data[8];
+    if (r4 == 0)
+        gRfuStatic->NIEndRecvFlag = 15;
+    do
+    {
+        if (r4 == 0)
+            break;
+        r0 = rfu_STC_analyzeLLSF(0, r5, r4);
+        r5 += r0;
+        r4 -= r0;
+    } while (!(r4 & 0x8000));
+}
+
+static u16 rfu_STC_analyzeLLSF(u8 r12, const u8 *r7, u16 r3)
+{
+    struct RfuLocalStruct sp00;
+    const struct LLSFStruct *r6;
+    u32 r5;
+    u8 r4;
+    u32 r0;
+    u16 r10;
+
+    r6 = &llsf_struct[~gRfuLinkStatus->parentChild & (MODE_NEUTRAL & MODE_PARENT)];
+    if (r3 < r6->unk00)
+        return r3;
+    r5 = 0;
+    for (r4 = 0; r4 < r6->unk00; ++r4)
+        r5 |= *r7++ << 8 * r4;
+    sp00.unk00 = (r5 >> r6->unk01) & r6->unk07;
+    sp00.unk01 = (r5 >> r6->unk02) & r6->unk08;
+    sp00.unk02 = (r5 >> r6->unk03) & r6->unk09;
+    sp00.unk03 = (r5 >> r6->unk04) & r6->unk0A;
+    sp00.unk04 = (r5 >> r6->unk05) & r6->unk0B;
+    sp00.unk05 = (r5 >> r6->unk06) & r6->unk0C;
+    sp00.unk06 = (r5  & r6->unk0E) & r5;
+    r10 = sp00.unk06 + r6->unk00;
+    if (sp00.unk00 == 0)
+    {
+        if (gRfuLinkStatus->parentChild == MODE_PARENT)
+        {
+            if ((gRfuLinkStatus->connSlotFlag >> r12) & 1)
+            {
+                if (sp00.unk02 == 4)
+                {
+                    rfu_STC_UNI_receive(r12, &sp00, r7);
+                }
+                else if (sp00.unk03 == 0)
+                {
+                    rfu_STC_NI_receive_Receiver(r12, &sp00, r7);
+                }
+                else
+                {
+                    for (r4 = 0; r4 < RFU_CHILD_MAX; ++r4)
+                        if (((gRfuSlotStatusNI[r4]->send.bmSlot >> r12) & 1)
+                         && ((gRfuLinkStatus->sendSlotNIFlag >> r12) & 1))
+                            break;
+                    if (r4 <= 3)
+                        rfu_STC_NI_receive_Sender(r4, r12, &sp00, r7);
+                }
+            }
+        }
+        else
+        {
+            s32 r5 = gRfuLinkStatus->connSlotFlag & sp00.unk01;
+
+            if (r5)
+            {
+                for (r4 = 0; r4 < RFU_CHILD_MAX; ++r4)
+                {
+                    if ((r5 >> r4) & 1)
+                    {
+                        if (sp00.unk02 == 4)
+                            rfu_STC_UNI_receive(r4, &sp00, r7);
+                        else if (sp00.unk03 == 0)
+                            rfu_STC_NI_receive_Receiver(r4, &sp00, r7);
+                        else if ((gRfuLinkStatus->sendSlotNIFlag >> r4) & 1)
+                            rfu_STC_NI_receive_Sender(r4, r4, &sp00, r7);
+                    }
+                }
+            }
+        }
+    }
+    return r10;
+}
+
+static void rfu_STC_UNI_receive(u8 r7, const struct RfuLocalStruct *r6, const u8 *sp00)
+{
+    u8 *sp04;
+    u32 r2;
+    struct RfuSlotStatusUNI *r3 = gRfuSlotStatusUNI[r7];
+    struct UNIRecv *r5 = &r3->recv;
+
+    r5->errorCode = 0;
+    if (gRfuSlotStatusUNI[r7]->recvBufferSize < r6->unk06)
+    {
+        r3->recv.state = SLOT_STATE_RECV_IGNORE;
+        r5->errorCode = ERR_RECV_BUFF_OVER;
+    }
+    else
+    { 
+        if (r5->dataBlockFlag)
+        {
+            if (r5->newDataFlag)
+            {
+                r5->errorCode = ERR_RECV_UNK;
+                goto _081E2F0E;
+            }
+        }
+        else
+        {
+            if (r5->newDataFlag)
+                r5->errorCode = ERR_RECV_DATA_OVERWRITED;
+        }
+        r5->state = SLOT_STATE_RECEIVING;
+        r2 = r5->dataSize = r6->unk06;
+        sp04 = gRfuSlotStatusUNI[r7]->recvBuffer;
+        gRfuFixed->fastCopyPtr(&sp00, &sp04, r2);
+        r5->newDataFlag = 1;
+        r5->state = 0;
+    }
+_081E2F0E:
+    if (r5->errorCode)
+        gRfuStatic->recvErrorFlag |= 16 << r7;
+}
+
+static void rfu_STC_NI_receive_Sender(u8 r0, u8 r10, const struct RfuLocalStruct *r6, const u8 *r3)
+{
+    struct NIComm *r12 = &gRfuSlotStatusNI[r0]->send;
+    u16 r9 = r12->state;
+    u8 sp00 = r12->n[r6->unk04];
+    u8 *r8;
+    u8 r4;
+    u16 r2;
+
+    if ((r6->unk02 == 2 && r9 == SLOT_STATE_SENDING)
+     || (r6->unk02 == 1 && r9 == SLOT_STATE_SEND_START)
+     || (r6->unk02 == 3 && r9 == SLOT_STATE_SEND_LAST))
+    {
+        if (r12->n[r6->unk04] == r6->unk05)
+            r12->recvAckFlag[r6->unk04] |= 1 << r10;
+    }
+    if ((r12->recvAckFlag[r6->unk04] & r12->bmSlot) == r12->bmSlot)
+    {
+        r12->n[r6->unk04] = (r12->n[r6->unk04] + 1) & 3;
+        r12->recvAckFlag[r6->unk04] = 0;
+        if ((u16)(r12->state + ~SLOT_STATE_SEND_NULL) <= 1)
+        {
+            if (r12->state == SLOT_STATE_SEND_START)
+                r12->now_p[r6->unk04] += r12->payloadSize;
+            else
+                r12->now_p[r6->unk04] += r12->payloadSize << 2;
+            r12->remainSize -= r12->payloadSize;
+            if (r12->remainSize != 0)
+                if (r12->remainSize >= 0)
+                    goto _081E30AE;
+            // Above is a hack to avoid optimization over comparison. 
+            // rfu_STC_NI_constructLLSF uses this field as u32. 
+            // It's equivalent to the following condition: 
+            // if (r12->remainSize == 0 || r12->remainSize < 0)
+            {
+                r12->phase = 0;
+                if (r12->state == SLOT_STATE_SEND_START)
+                {
+                    for (r4 = 0; r4 < WINDOW_COUNT; ++r4)
+                    {
+                        r12->n[r4] = 1;
+                        r12->now_p[r4] = r12->src + r12->payloadSize * r4;
+                    }
+                    r12->remainSize = r12->dataSize;
+                    r12->state = SLOT_STATE_SENDING;
+                }
+                else
+                {
+                    r12->n[0] = 0;
+                    r12->remainSize = 0;
+                    r12->state = SLOT_STATE_SEND_LAST;
+                }
+            }
+        _081E30AE:
+        }
+        else if (r12->state == SLOT_STATE_SEND_LAST)
+        {
+            r12->state = SLOT_STATE_SEND_NULL;
+        }
+    }
+    if (r12->state != r9
+     || r12->n[r6->unk04] != sp00
+     || (r12->recvAckFlag[r6->unk04] >> r10) & 1)
+    {
+        r2 = REG_IME;
+        REG_IME = 0;
+        gRfuStatic->recvRenewalFlag |= 16 << r10;
+        gRfuSlotStatusNI[r10]->send.failCounter = 0;
+        REG_IME = r2;
+    }
+}
+
+static void rfu_STC_NI_receive_Receiver(u8 r8, const struct RfuLocalStruct *r6, const u8 *sp00)
+{
+    u16 r2;
+    u32 r7 = 0;
+    struct RfuSlotStatusNI *r4 = gRfuSlotStatusNI[r8];
+    struct NIComm *r5 = &r4->recv;
+    u16 r9 = r4->recv.state;
+    u8 r10 = r4->recv.n[r6->unk04];
+
+    if (r6->unk02 == 3)
+    {
+        gRfuStatic->NIEndRecvFlag |= 1 << r8;
+        if (r4->recv.state == SLOT_STATE_RECEIVING)
+        {
+            r4->recv.phase = 0;
+            r4->recv.n[0] = 0;
+            r4->recv.state = SLOT_STATE_RECV_LAST;
+        }
+    }
+    else if (r6->unk02 == 2)
+    {
+        if (r9 == SLOT_STATE_RECV_START && !r5->remainSize)
+            rfu_STC_NI_initSlot_asRecvDataEntity(r8, r5);
+        if (r5->state == SLOT_STATE_RECEIVING)
+            r7 = 1;
+    }
+    else if (r6->unk02 == 1)
+    {
+        if (r9 == SLOT_STATE_RECV_START)
+        {
+            r7 = 1;
+        }
+        else
+        {
+            rfu_STC_NI_initSlot_asRecvControllData(r8, r5);
+            if (r4->recv.state != SLOT_STATE_RECV_START)
+                return;
+            r7 = 1;
+        }
+    }
+    if (r7 != 0)
+    {
+        if (r6->unk05 == ((r5->n[r6->unk04] + 1) & 3))
+        {
+            gRfuFixed->fastCopyPtr(&sp00, (u8 **)&r5->now_p[r6->unk04], r6->unk06);
+            if (r5->state == SLOT_STATE_RECEIVING)
+                r5->now_p[r6->unk04] += 3 * r5->payloadSize;
+            r5->remainSize -= r6->unk06;
+            r5->n[r6->unk04] = r6->unk05;
+        }
+    }
+    if (r5->errorCode == 0)
+    {
+        r5->phase = r6->unk04;
+        if (r5->state != r9 || r5->n[r6->unk04] != r10 || r5->n[r6->unk04] == r6->unk05)
+        {
+            r2 = REG_IME;
+            REG_IME = 0;
+            gRfuStatic->recvRenewalFlag |= 1 << r8;
+            r5->failCounter = 0;
+            REG_IME = r2;
+        }
+    }
+}
+
+static void rfu_STC_NI_initSlot_asRecvControllData(u8 r4, struct NIComm *r2)
+{
+    u8 *r1;
+    u32 r5;
+    u8 r6;
+
+    if (gRfuLinkStatus->parentChild == MODE_PARENT)
+    {
+        r5 = 3;
+        r1 = &gRfuLinkStatus->remainLLFrameSizeParent;
+    }
+    else
+    {
+        r5 = 2;
+        r1 = &gRfuLinkStatus->remainLLFrameSizeChild[r4];
+    }
+    r6 = 1 << r4;
+    if (r2->state == 0)
+    {
+        if (*r1 < r5)
+        {
+            r2->state = SLOT_STATE_RECV_IGNORE;
+            r2->errorCode = ERR_RECV_REPLY_SUBFRAME_SIZE;
+            gRfuStatic->recvErrorFlag |= r6;
+        }
+        else
+        {
+            r2->errorCode = 0;
+            *r1 -= r5;
+            r2->now_p[0] = &r2->dataType;
+            r2->remainSize = 7;
+            r2->ack = 1;
+            r2->payloadSize = 0;
+            r2->bmSlot = r6;
+            r2->state = SLOT_STATE_RECV_START;
+            gRfuLinkStatus->recvSlotNIFlag |= r6;
+        }
+    }
+}
+
+static void rfu_STC_NI_initSlot_asRecvDataEntity(u8 r5, struct NIComm *r4)
+{
+    u8 r1, r3;
+
+    if (r4->dataType == 1)
+    {
+        r4->now_p[0] = (void *)&gRfuLinkStatus->partner[r5].serialNo;
+    }
+    else
+    {
+        if (r4->dataSize > gRfuSlotStatusNI[r5]->recvBufferSize)
+        {
+            r1 = 1 << r5;
+            gRfuStatic->recvErrorFlag |= r1;
+            gRfuLinkStatus->recvSlotNIFlag &= ~r1;
+            r4->errorCode = ERR_RECV_BUFF_OVER;
+            r4->state = SLOT_STATE_RECV_FAILED;
+            rfu_STC_releaseFrame(r5, 1, r4);
+            return;
+        }
+        r4->now_p[0] = gRfuSlotStatusNI[r5]->recvBuffer;
+    }
+    for (r3 = 0; r3 < WINDOW_COUNT; ++r3)
+    {
+        r4->n[r3] = 0;
+        r4->now_p[r3] = &r4->now_p[0][r4->payloadSize * r3];
+    }
+    r4->remainSize = r4->dataSize;
+    r4->state = SLOT_STATE_RECEIVING;
+}
+
+static void rfu_NI_checkCommFailCounter(void)
+{
+    u16 r12;
+    u32 r7;
+    u8 r2, r3;
+
+    if (gRfuLinkStatus->sendSlotNIFlag | gRfuLinkStatus->recvSlotNIFlag)
+    {
+        r12 = REG_IME;
+        REG_IME = 0;
+        r7 = gRfuStatic->recvRenewalFlag >> 4;
+        for (r3 = 0; r3 < RFU_CHILD_MAX; ++r3)
+        {
+            r2 = 1 << r3;
+            if (gRfuLinkStatus->sendSlotNIFlag & r2
+             && !(gRfuStatic->recvRenewalFlag & r2))
+                ++gRfuSlotStatusNI[r3]->send.failCounter;
+            if (gRfuLinkStatus->recvSlotNIFlag & r2
+             && !(r7 & r2))
+                ++gRfuSlotStatusNI[r3]->recv.failCounter;
+        }
+        gRfuStatic->recvRenewalFlag = 0;
+        REG_IME = r12;
+    }
+}
+
+void rfu_REQ_noise(void)
+{
+    STWI_set_Callback_M(rfu_STC_REQ_callback);
+    STWI_send_TestModeREQ(1, 0);
+}
diff --git a/src/librfu_sio32id.c b/src/librfu_sio32id.c
new file mode 100644
index 000000000..f5d652348
--- /dev/null
+++ b/src/librfu_sio32id.c
@@ -0,0 +1,167 @@
+#include "librfu.h"
+
+static void Sio32IDIntr(void);
+static void Sio32IDInit(void);
+static s32 Sio32IDMain(void);
+
+//struct RfuSIO32Id gRfuSIO32Id;
+
+//static const u16 Sio32ConnectionData[] = { 0x494e, 0x544e, 0x4e45, 0x4f44 }; // NINTENDO
+//static const char Sio32IDLib_Var[] = "Sio32ID_030820";
+
+extern const u16 Sio32ConnectionData[];
+extern const char Sio32IDLib_Var[];
+
+s32 AgbRFU_checkID(u8 r5)
+{
+    u16 r8;
+    vu16 *r4;
+    s32 r6;
+
+    if (REG_IME == 0)
+        return -1;
+    r8 = REG_IE;
+    gSTWIStatus->state = 10;
+    STWI_set_Callback_ID(Sio32IDIntr);
+    Sio32IDInit();
+    r4 = &REG_TMCNT_L(gSTWIStatus->timerSelect);
+    r5 *= 8;
+    while (--r5 != 0xFF)
+    {
+        r6 = Sio32IDMain();
+        if (r6 != 0)
+            break;
+        r4[1] = 0;
+        r4[0] = 0;
+        r4[1] = TIMER_1024CLK | TIMER_ENABLE;
+        while (r4[0] < 32)
+            ;
+        r4[1] = 0;
+        r4[0] = 0;
+    }
+    REG_IME = 0;
+    REG_IE = r8;
+    REG_IME = 1;
+    gSTWIStatus->state = 0;
+    STWI_set_Callback_ID(NULL);
+    return r6;
+}
+
+static void Sio32IDInit(void)
+{
+    REG_IME = 0;
+    REG_IE &= ~((8 << gSTWIStatus->timerSelect) | INTR_FLAG_SERIAL);
+    REG_IME = 1;
+    REG_RCNT = 0;
+    REG_SIOCNT = SIO_32BIT_MODE;
+    REG_SIOCNT |= SIO_INTR_ENABLE | SIO_ENABLE;
+    CpuFill32(0, &gRfuSIO32Id, sizeof(struct RfuSIO32Id));
+    REG_IF = INTR_FLAG_SERIAL;
+}
+
+static s32 Sio32IDMain(void)
+{
+    u8 r12;
+
+    switch (r12 = gRfuSIO32Id.unk1)
+    {
+    case 0:
+        gRfuSIO32Id.unk0 = 1;
+        REG_SIOCNT |= SIO_38400_BPS;
+        REG_IME = r12;
+        REG_IE |= INTR_FLAG_SERIAL;
+        REG_IME = 1;
+        gRfuSIO32Id.unk1 = 1;
+        *(vu8 *)&REG_SIOCNT |= SIO_ENABLE;
+        break;
+    case 1:
+        if (gRfuSIO32Id.unkA == 0)
+        {
+            if (gRfuSIO32Id.unk0 == 1)
+            {
+                if (gRfuSIO32Id.unk2 == 0)
+                {
+                    REG_IME = gRfuSIO32Id.unk2;
+                    REG_SIOCNT |= SIO_ENABLE;
+                    REG_IME = r12;
+                }
+            }
+            else if (gRfuSIO32Id.unk4 != 0x8001 && !gRfuSIO32Id.unk2)
+            {
+                REG_IME = gRfuSIO32Id.unk2;
+                REG_IE &= ~INTR_FLAG_SERIAL;
+                REG_IME = r12;
+                REG_SIOCNT = gRfuSIO32Id.unk2;
+                REG_SIOCNT = SIO_32BIT_MODE;
+                REG_IF = INTR_FLAG_SERIAL;
+                REG_SIOCNT |= SIO_INTR_ENABLE | SIO_ENABLE;
+                REG_IME = gRfuSIO32Id.unk2;
+                REG_IE |= INTR_FLAG_SERIAL;
+                REG_IME = r12;
+            }
+            break;
+        }
+        else
+        {
+            gRfuSIO32Id.unk1 = 2;
+            // fallthrough
+        }
+    default:
+        return gRfuSIO32Id.unkA;
+    }
+    return 0;
+}
+
+static void Sio32IDIntr(void)
+{
+    u32 r5;
+    u16 r0;
+#ifndef NONMATCHING
+    register u32 r1 asm("r1");
+    register u16 r0_ asm("r0");
+#else
+    u32 r1;
+    u16 r0_;
+#endif
+
+    r5 = REG_SIODATA32;
+    if (gRfuSIO32Id.unk0 != 1)
+        REG_SIOCNT |= SIO_ENABLE;
+    r1 = 16 * gRfuSIO32Id.unk0; // to handle side effect of inline asm
+    r1 = (r5 << r1) >> 16;
+    r5 = (r5 << 16 * (1 - gRfuSIO32Id.unk0)) >> 16;
+    if (gRfuSIO32Id.unkA == 0)
+    {
+        if (r1 == gRfuSIO32Id.unk6)
+        {
+            if (gRfuSIO32Id.unk2 > 3)
+            {
+                gRfuSIO32Id.unkA = r5;
+            }
+            else if (r1 == (u16)~gRfuSIO32Id.unk4)
+            {
+                r0_ = ~gRfuSIO32Id.unk6;
+                if (r5 == r0_)
+                    ++gRfuSIO32Id.unk2;
+            }
+        }
+        else
+        {
+            gRfuSIO32Id.unk2 = gRfuSIO32Id.unkA;
+        }
+    }
+    if (gRfuSIO32Id.unk2 < 4)
+        gRfuSIO32Id.unk4 = *(gRfuSIO32Id.unk2 + Sio32ConnectionData);
+    else
+        gRfuSIO32Id.unk4 = 0x8001;
+    gRfuSIO32Id.unk6 = ~r5;
+    REG_SIODATA32 = (gRfuSIO32Id.unk4 << 16 * (1 - gRfuSIO32Id.unk0))
+                  + (gRfuSIO32Id.unk6 << 16 * gRfuSIO32Id.unk0);
+    if (gRfuSIO32Id.unk0 == 1 && (gRfuSIO32Id.unk2 || r5 == 0x494E))
+    {
+        for (r0 = 0; r0 < 600; ++r0)
+            ;
+        if (gRfuSIO32Id.unkA == 0)
+            REG_SIOCNT |= SIO_ENABLE;
+    }
+}