From 482b42a295a80952cea75a8176183692b8e8d120 Mon Sep 17 00:00:00 2001
From: shinyquagsire23 <mtinc2@gmail.com>
Date: Sat, 21 Oct 2017 13:42:31 -0600
Subject: Split librfu into separate C files in its own directory,
 rfu_initializeAPI matching except for register differences

---
 src/librfu.c      | 788 ------------------------------------------------------
 src/librfu_intr.c |   4 +
 src/librfu_rfu.c  | 109 ++++++++
 src/librfu_stwi.c | 687 +++++++++++++++++++++++++++++++++++++++++++++++
 4 files changed, 800 insertions(+), 788 deletions(-)
 delete mode 100644 src/librfu.c
 create mode 100644 src/librfu_intr.c
 create mode 100644 src/librfu_rfu.c
 create mode 100644 src/librfu_stwi.c

(limited to 'src')

diff --git a/src/librfu.c b/src/librfu.c
deleted file mode 100644
index e647b9178..000000000
--- a/src/librfu.c
+++ /dev/null
@@ -1,788 +0,0 @@
-#include "global.h"
-#include "main.h"
-
-enum
-{
-    RFU_RESET = 0x10,
-    RFU_LINK_STATUS,
-    RFU_VERSION_STATUS,
-    RFU_SYSTEM_STATUS,
-    RFU_SLOT_STATUS,
-    RFU_CONFIG_STATUS,
-    RFU_GAME_CONFIG,
-    RFU_SYSTEM_CONFIG,
-    RFU_UNK18,
-    RFU_SC_START,
-    RFU_SC_POLLING,
-    RFU_SC_END,
-    RFU_SP_START,
-    RFU_SP_POLLING,
-    RFU_SP_END,
-    RFU_CP_START,
-    RFU_CP_POLLING,
-    RFU_CP_END,
-    RFU_UNK22,
-    RFU_UNK23,
-    RFU_DATA_TX,
-    RFU_DATA_TX_AND_CHANGE,
-    RFU_DATA_RX,
-    RFU_MS_CHANGE,
-    RFU_DATA_READY_AND_CHANGE,
-    RFU_DISCONNECTED_AND_CHANGE,
-    RFU_UNK2A,
-    RFU_UNK2B,
-    RFU_UNK2C,
-    RFU_UNK2D,
-    RFU_UNK2E,
-    RFU_UNK2F,
-    RFU_DISCONNECT,
-    RFU_TEST_MODE,
-    RFU_CPR_START,
-    RFU_CPR_POLLING,
-    RFU_CPR_END,
-    RFU_UNK35,
-    RFU_UNK36,
-    RFU_RESUME_RETRANSMIT_AND_CHANGE,
-    RFU_UNK38,
-    RFU_UNK39,
-    RFU_UNK3A,
-    RFU_UNK3B,
-    RFU_UNK3C,
-    RFU_STOP_MODE, //3D
-};
-
-struct RfuPacket8
-{
-    u8 data[0x74];
-};
-
-struct RfuPacket32
-{
-    u32 command;
-    u32 data[0x1C];
-};
-
-union RfuPacket
-{
-    struct RfuPacket32 rfuPacket32;
-    struct RfuPacket8 rfuPacket8;
-};
-
-struct RfuStruct
-{
-    vs32 unk_0;
-    u8 txParams;
-    u8 unk_5;
-    u8 activeCommand;
-    u8 unk_7;
-    u8 unk_8;
-    u8 unk_9;
-    u8 timerSelect;
-    u8 unk_b;
-    int timerState;
-    vu8 timerActive;
-    u8 unk_11;
-    vu16 unk_12;
-    vu8 msMode;
-    u8 unk_15;
-    u8 unk_16;
-    u8 unk_17;
-    void (*callbackM)();
-    void (*callbackS)();
-    u32 callbackID;
-    union RfuPacket *txPacket;
-    union RfuPacket *rxPacket;
-    vu8 unk_2c;
-    u8 padding[3];
-};
-
-struct RfuIntrStruct
-{
-    u8 rxPacketAlloc[0x74];
-    u8 txPacketAlloc[0x74];
-    u8 block1[0x960];
-    u8 block2[0x30];
-};
-
-extern IntrFunc IntrSIO32(void);
-extern struct RfuStruct *gRfuState;
-void STWI_init_Callback_M(void);
-void STWI_init_Callback_S(void);
-void STWI_set_Callback_M(void * callback);
-void STWI_set_Callback_S(void * callback);
-u16 STWI_init(u8 request);
-int STWI_start_Command(void);
-void STWI_intr_timer(void);
-void STWI_set_timer(u8 unk);
-extern void STWI_stop_timer(void);
-int STWI_restart_Command(void);
-int STWI_reset_ClockCounter(void);
-
-void STWI_init_all(struct RfuIntrStruct *interruptStruct, IntrFunc *interrupt, bool8 copyInterruptToRam)
-{
-    // If we're copying our interrupt into RAM, DMA it to block1 and use
-    // block2 for our RfuStruct, otherwise block1 holds the RfuStruct.
-    // interrupt usually is a pointer to gIntrTable[1]
-    if (copyInterruptToRam == TRUE)
-    {
-        *interrupt = (IntrFunc)interruptStruct->block1;
-        DmaCopy16(3, &IntrSIO32, interruptStruct->block1, 0x960);
-        gRfuState = (struct RfuStruct*)interruptStruct->block2;
-    }
-    else
-    {
-        *interrupt = (IntrFunc)IntrSIO32;
-        gRfuState = (struct RfuStruct*)interruptStruct->block1;
-    }
-
-    gRfuState->rxPacket = (union RfuPacket*)interruptStruct->rxPacketAlloc;
-    gRfuState->txPacket = (union RfuPacket*)interruptStruct->txPacketAlloc;
-    gRfuState->msMode = 1;
-    gRfuState->unk_0 = 0;
-    gRfuState->txParams = 0;
-    gRfuState->unk_5 = 0;
-    gRfuState->unk_7 = 0;
-    gRfuState->unk_8 = 0;
-    gRfuState->unk_9 = 0;
-    gRfuState->timerState = 0;
-    gRfuState->timerActive = 0;
-    gRfuState->unk_12 = 0;
-    gRfuState->unk_15 = 0;
-    gRfuState->unk_2c = 0;
-
-    REG_RCNT = 0x100; //TODO: mystery bit?
-    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
-    STWI_init_Callback_M();
-    STWI_init_Callback_S();
-
-    IntrEnable(INTR_FLAG_SERIAL);
-}
-
-void STWI_init_timer(IntrFunc *interrupt, int timerSelect)
-{
-    *interrupt = STWI_intr_timer;
-    gRfuState->timerSelect = timerSelect;
-
-    IntrEnable(INTR_FLAG_TIMER0 << gRfuState->timerSelect);
-}
-
-void AgbRFU_SoftReset(void)
-{
-    vu16 *timerL;
-    vu16 *timerH;
-
-    REG_RCNT = 0x8000;
-    REG_RCNT = 0x80A0; // all these bits are undocumented
-    timerL = &REG_TMCNT_L(gRfuState->timerSelect);
-    timerH = &REG_TMCNT_H(gRfuState->timerSelect);
-    *timerH = 0;
-    *timerL = 0;
-    *timerH = 0x83;
-    while (*timerL <= 0x11)
-        REG_RCNT = 0x80A2;
-    *timerH = 3;
-    REG_RCNT = 0x80A0;
-    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
-
-    gRfuState->unk_0 = 0;
-    gRfuState->txParams = 0;
-    gRfuState->unk_5 = 0;
-    gRfuState->activeCommand = 0;
-    gRfuState->unk_7 = 0;
-    gRfuState->unk_8 = 0;
-    gRfuState->unk_9 = 0;
-    gRfuState->timerState = 0;
-    gRfuState->timerActive = 0;
-    gRfuState->unk_12 = 0;
-    gRfuState->msMode = 1;
-    gRfuState->unk_15 = 0;
-    gRfuState->unk_2c = 0;
-}
-
-void STWI_set_MS_mode(u8 mode)
-{
-    gRfuState->msMode = mode;
-}
-
-u16 STWI_read_status(u8 index)
-{
-    switch (index)
-    {
-    case 0:
-        return gRfuState->unk_12;
-    case 1:
-        return gRfuState->msMode;
-    case 2:
-        return gRfuState->unk_0;
-    case 3:
-        return gRfuState->activeCommand;
-    default:
-        return 0xFFFF;
-    }
-}
-
-void STWI_init_Callback_M(void)
-{
-    STWI_set_Callback_M(0);
-}
-
-void STWI_init_Callback_S(void)
-{
-    STWI_set_Callback_S(0);
-}
-
-void STWI_set_Callback_M(void *callback)
-{
-    gRfuState->callbackM = callback;
-}
-
-void STWI_set_Callback_S(void *callback)
-{
-    gRfuState->callbackS = callback;
-}
-
-void STWI_set_Callback_ID(u32 id)
-{
-    gRfuState->callbackID = id;
-}
-
-u16 STWI_poll_CommandEnd(void)
-{
-    while (gRfuState->unk_2c == TRUE)
-        ;
-    return gRfuState->unk_12;
-}
-
-void STWI_send_ResetREQ(void)
-{
-    if (!STWI_init(RFU_RESET))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_LinkStatusREQ(void)
-{
-    if (!STWI_init(RFU_LINK_STATUS))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_VersionStatusREQ(void)
-{
-    if (!STWI_init(RFU_VERSION_STATUS))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SystemStatusREQ(void)
-{
-    if (!STWI_init(RFU_SYSTEM_STATUS))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SlotStatusREQ(void)
-{
-    if (!STWI_init(RFU_SLOT_STATUS))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_ConfigStatusREQ(void)
-{
-    if (!STWI_init(RFU_CONFIG_STATUS))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_GameConfigREQ(u8 * unk1, u8 *data)
-{
-    u8 *packetBytes;
-    int i;
-
-    if (!STWI_init(RFU_GAME_CONFIG))
-    {
-        gRfuState->txParams = 6;
-
-        //TODO: what is unk1
-        packetBytes = gRfuState->txPacket->rfuPacket8.data;
-        packetBytes += sizeof(u32);
-        *(u16*)packetBytes = *(u16*)unk1;
-
-        packetBytes += sizeof(u16);
-        unk1 += sizeof(u16);
-
-        for (i = 0; i < 14; i++)
-        {
-            *packetBytes = *unk1;
-            packetBytes++;
-            unk1++;
-        }
-
-        for (i = 0; i < 8; i++)
-        {
-            *packetBytes = *data;
-            packetBytes++;
-            data++;
-        }
-
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SystemConfigREQ(u16 unk1, u8 unk2, u8 unk3)
-{
-    if (!STWI_init(RFU_SYSTEM_CONFIG))
-    {
-        u8 *packetBytes;
-        
-        gRfuState->txParams = 1;
-
-        packetBytes = gRfuState->txPacket->rfuPacket8.data;
-        packetBytes += sizeof(u32);
-
-        *packetBytes++ = unk3;
-        *packetBytes++ = unk2;
-        *(u16*)packetBytes = unk1;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SC_StartREQ(void)
-{
-    if (!STWI_init(RFU_SC_START))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SC_PollingREQ(void)
-{
-    if (!STWI_init(RFU_SC_POLLING))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SC_EndREQ(void)
-{
-    if (!STWI_init(RFU_SC_END))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SP_StartREQ(void)
-{
-    if (!STWI_init(RFU_SP_START))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SP_PollingREQ(void)
-{
-    if (!STWI_init(RFU_SP_POLLING))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_SP_EndREQ(void)
-{
-    if (!STWI_init(RFU_SP_END))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_CP_StartREQ(u16 unk1)
-{
-    if (!STWI_init(RFU_CP_START))
-    {
-        gRfuState->txParams = 1;
-        gRfuState->txPacket->rfuPacket32.data[0] = unk1;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_CP_PollingREQ(void)
-{
-    if (!STWI_init(RFU_CP_POLLING))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_CP_EndREQ(void)
-{
-    if (!STWI_init(RFU_CP_END))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_DataTxREQ(void *in, u8 size)
-{
-    if (!STWI_init(RFU_DATA_TX))
-    {
-        u8 txParams = (size / sizeof(u32));
-        if (size & (sizeof(u32) - 1))
-            txParams += 1;
-            
-        gRfuState->txParams = txParams;
-        CpuCopy32(in, gRfuState->txPacket->rfuPacket32.data, gRfuState->txParams * sizeof(u32));
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_DataTxAndChangeREQ(void *in, u8 size)
-{
-    if (!STWI_init(RFU_DATA_TX_AND_CHANGE))
-    {
-        u8 txParams = (size / sizeof(u32));
-        if (size & (sizeof(u32) - 1))
-            txParams += 1;
-
-        gRfuState->txParams = txParams;
-        CpuCopy32(in, gRfuState->txPacket->rfuPacket32.data, gRfuState->txParams * sizeof(u32));
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_DataRxREQ(void)
-{
-    if (!STWI_init(RFU_DATA_RX))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_MS_ChangeREQ(void)
-{
-    if (!STWI_init(RFU_MS_CHANGE))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_DataReadyAndChangeREQ(u8 unk)
-{
-    if (!STWI_init(RFU_DATA_READY_AND_CHANGE))
-    {
-        if (!unk)
-        {
-            gRfuState->txParams = 0;
-        }
-        else
-        {
-            u8 *packetBytes;
-
-            gRfuState->txParams = 1;
-
-            packetBytes = gRfuState->txPacket->rfuPacket8.data;
-            packetBytes += sizeof(u32);
-
-            *packetBytes++ = unk;
-            *packetBytes++ = 0;
-            *packetBytes++ = 0;
-            *packetBytes = 0;
-        }
-
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_DisconnectedAndChangeREQ(u8 unk0, u8 unk1)
-{
-    if (!STWI_init(RFU_DISCONNECTED_AND_CHANGE))
-    {
-        u8 *packetBytes;
-
-        gRfuState->txParams = 1;
-
-        packetBytes = gRfuState->txPacket->rfuPacket8.data;
-        packetBytes += sizeof(u32);
-
-        *packetBytes++ = unk0;
-        *packetBytes++ = unk1;
-        *packetBytes++ = 0;
-        *packetBytes = 0;
-
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_ResumeRetransmitAndChangeREQ(void)
-{
-    if (!STWI_init(RFU_RESUME_RETRANSMIT_AND_CHANGE))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_DisconnectREQ(u8 unk)
-{
-    if (!STWI_init(RFU_DISCONNECT))
-    {
-        gRfuState->txParams = 1;
-        gRfuState->txPacket->rfuPacket32.data[0] = unk;
-
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_TestModeREQ(u8 unk0, u8 unk1)
-{
-    if (!STWI_init(RFU_TEST_MODE))
-    {
-        gRfuState->txParams = 1;
-        gRfuState->txPacket->rfuPacket32.data[0] = unk0 | (unk1 << 8);
-
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_CPR_StartREQ(u16 unk0, u16 unk1, u8 unk2)
-{
-    u32 *packetData;
-    u32 arg1;
-    
-    if (!STWI_init(RFU_CPR_START))
-    {
-        gRfuState->txParams = 2;
-        
-        arg1 = unk1 | (unk0 << 16);
-        packetData = gRfuState->txPacket->rfuPacket32.data;
-        packetData[0] = arg1;
-        packetData[1] = unk2;
-
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_CPR_PollingREQ(void)
-{
-    if (!STWI_init(RFU_CPR_POLLING))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_CPR_EndREQ(void)
-{
-    if (!STWI_init(RFU_CPR_END))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_send_StopModeREQ(void)
-{
-    if (!STWI_init(RFU_STOP_MODE))
-    {
-        gRfuState->txParams = 0;
-        STWI_start_Command();
-    }
-}
-
-void STWI_intr_timer(void)
-{
-    switch (gRfuState->timerState)
-    {
-        //TODO: Make an enum for these
-        case 2:
-            gRfuState->timerActive = 1;
-            STWI_set_timer(50);
-            break;
-        case 1:
-        case 4:
-            STWI_stop_timer();
-            STWI_restart_Command();
-            break;
-        case 3:
-            gRfuState->timerActive = 1;
-            STWI_stop_timer();
-            STWI_reset_ClockCounter();
-            if (gRfuState->callbackM)
-                gRfuState->callbackM(255, 0);
-            break;
-    }
-}
-
-void STWI_set_timer(u8 unk)
-{
-    vu16 *timerL;
-    vu16 *timerH;
-
-    timerL = &REG_TMCNT_L(gRfuState->timerSelect);
-    timerH = &REG_TMCNT_H(gRfuState->timerSelect);
-    REG_IME = 0;
-    switch (unk)
-    {
-        case 50:
-            *timerL = 0xFCCB;
-            gRfuState->timerState = 1;
-            break;
-        case 80:
-            *timerL = 0xFAE0;
-            gRfuState->timerState = 2;
-            break;
-        case 100:
-            *timerL = 0xF996;
-            gRfuState->timerState = 3;
-            break;
-        case 130:
-            *timerL = 0xF7AD;
-            gRfuState->timerState = 4;
-            break;
-    }
-    *timerH = TIMER_ENABLE | TIMER_INTR_ENABLE | TIMER_1024CLK;
-    REG_IF = INTR_FLAG_TIMER0 << gRfuState->timerSelect;
-    REG_IME = 1;
-}
-
-void STWI_stop_timer(void)
-{
-    gRfuState->timerState = 0;
-    
-    REG_TMCNT_L(gRfuState->timerSelect) = 0;
-    REG_TMCNT_H(gRfuState->timerSelect) = 0;
-}
-
-u16 STWI_init(u8 request)
-{
-    if (!REG_IME)
-    {
-        gRfuState->unk_12 = 6;
-        if (gRfuState->callbackM)
-            gRfuState->callbackM(request, gRfuState->unk_12);
-        return TRUE;
-    }
-    else if (gRfuState->unk_2c == TRUE)
-    {
-        gRfuState->unk_12 = 2;
-        gRfuState->unk_2c = FALSE;
-        if (gRfuState->callbackM)
-            gRfuState->callbackM(request, gRfuState->unk_12);
-        return TRUE;
-    }
-    else if(!gRfuState->msMode)
-    {
-        gRfuState->unk_12 = 4;
-        if (gRfuState->callbackM)
-            gRfuState->callbackM(request, gRfuState->unk_12, gRfuState);
-        return TRUE;
-    }
-    else
-    {
-        gRfuState->unk_2c = TRUE;
-        gRfuState->activeCommand = request;
-        gRfuState->unk_0 = 0;
-        gRfuState->txParams = 0;
-        gRfuState->unk_5 = 0;
-        gRfuState->unk_7 = 0;
-        gRfuState->unk_8 = 0;
-        gRfuState->unk_9 = 0;
-        gRfuState->timerState = 0;
-        gRfuState->timerActive = 0;
-        gRfuState->unk_12 = 0;
-        gRfuState->unk_15 = 0;
-        
-        REG_RCNT = 0x100;
-        REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
-        return FALSE;
-    }
-}
-
-int STWI_start_Command()
-{
-    u16 imeTemp;
-    
-    // Yes, it matters that it's casted to a u32...
-    *(u32*)gRfuState->txPacket->rfuPacket8.data = 0x99660000 | (gRfuState->txParams << 8) | gRfuState->activeCommand;
-    REG_SIODATA32 = gRfuState->txPacket->rfuPacket32.command;
-    
-    gRfuState->unk_0 = 0;
-    gRfuState->unk_5 = 1;
-    
-    imeTemp = REG_IME;
-    REG_IME = 0;
-    REG_IE |= (INTR_FLAG_TIMER0 << gRfuState->timerSelect);
-    REG_IE |= INTR_FLAG_SERIAL;
-    REG_IME = imeTemp;
-    
-    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_MULTI_BUSY | SIO_115200_BPS;
-    
-    return 0;
-}
-
-int STWI_restart_Command(void)
-{
-    if (gRfuState->unk_15 <= 1)
-    {
-        gRfuState->unk_15++;
-        STWI_start_Command();
-    }
-    else
-    {
-        if (gRfuState->activeCommand == RFU_MS_CHANGE || gRfuState->activeCommand == RFU_DATA_TX_AND_CHANGE || gRfuState->activeCommand == RFU_UNK35 || gRfuState->activeCommand == RFU_RESUME_RETRANSMIT_AND_CHANGE)
-        {
-            gRfuState->unk_12 = 1;
-            gRfuState->unk_2c = 0;
-            
-            if (gRfuState->callbackM)
-                gRfuState->callbackM(gRfuState->activeCommand, gRfuState->unk_12);
-        }
-        else
-        {
-            gRfuState->unk_12 = 1;
-            gRfuState->unk_2c = 0;
-            
-            if (gRfuState->callbackM)
-                gRfuState->callbackM(gRfuState->activeCommand, gRfuState->unk_12);
-            
-            gRfuState->unk_0 = 4; //TODO: what's 4
-        }
-    }
-    
-    return 0;
-}
-
-int STWI_reset_ClockCounter()
-{
-    gRfuState->unk_0 = 5; //TODO: what is 5
-    gRfuState->txParams = 0;
-    gRfuState->unk_5 = 0;
-    REG_SIODATA32 = (1 << 31);
-    REG_SIOCNT = 0;
-    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
-    REG_SIOCNT = (SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS) + 0x7F;
-    
-    return 0;
-}
diff --git a/src/librfu_intr.c b/src/librfu_intr.c
new file mode 100644
index 000000000..bdf8b072a
--- /dev/null
+++ b/src/librfu_intr.c
@@ -0,0 +1,4 @@
+#include "global.h"
+#include "main.h"
+
+//TODO: decompile asm/librfu_intr.s to here
diff --git a/src/librfu_rfu.c b/src/librfu_rfu.c
new file mode 100644
index 000000000..cf3fe12ad
--- /dev/null
+++ b/src/librfu_rfu.c
@@ -0,0 +1,109 @@
+#include "global.h"
+#include "main.h"
+
+#include "librfu.h"
+
+struct RfuUnk1
+{
+    u8 unk_0[0x14];
+    u32 unk_14;
+    u32 unk_18;
+    struct RfuIntrStruct unk_1c;
+};
+
+struct RfuUnk2
+{
+    u8 unk_0[0x68];
+    u32 unk_68;
+    u32 unk_6c;
+    u8 unk_70[0x70];
+};
+
+struct RfuUnk3
+{
+    u32 unk_0;
+    u32 unk_4;
+    u8 unk_8[0xD4];
+    u32 unk_dc;
+};
+
+extern u32 *gUnknown_03007890;
+extern u32 *gUnknown_03007894;
+extern struct RfuUnk3* gUnknown_03007898;
+extern struct RfuUnk2* gUnknown_03007880[4];
+extern struct RfuUnk1* gUnknown_03007870[4];
+extern void* sub_82E53F4;
+extern void rfu_STC_clearAPIVariables(void);
+
+// Nonmatching, only register differences
+/*u16 rfu_initializeAPI(u32 *unk0, u16 unk1, IntrFunc *interrupt, bool8 copyInterruptToRam)
+{
+    u16 i;
+    u16 *v13;
+    u16 *v12;
+    u16 num;
+
+    if (((u32)unk0 & 0xF000000) == 0x2000000 && copyInterruptToRam)
+    {
+        return 2;
+    }
+    
+    if ((u32)unk0 & 3)
+        return 2;
+    
+    // Nintendo pls, just use a ternary for once
+    if (copyInterruptToRam)
+    {
+        // An assert/debug print may have existed before, ie
+        // printf("%s %u < %u", "somefile.c:12345", unk1, num)
+        // to push this into r3?
+        num = 0xe64;
+        if (unk1 < num)
+            return 1;
+    }
+
+    if (copyInterruptToRam == FALSE)
+    {
+        num = 0x504; // same as above, this should be r3 not r0
+        if (unk1 < num)
+            return 1;
+    }
+    gUnknown_03007890 = unk0;
+    gUnknown_03007894 = unk0 + (0xB4 / sizeof(u32));
+    gUnknown_03007898 = (struct RfuUnk3*)(unk0 + (0xDC / sizeof(u32)));
+    gUnknown_03007880[0] = (struct RfuUnk2*)(unk0 + (0x1BC / sizeof(u32)));
+    gUnknown_03007870[0] = (struct RfuUnk1*)(unk0 + (0x37C / sizeof(u32)));
+
+    for (i = 1; i < 4; i++, num)
+    {
+        gUnknown_03007880[i] = (struct RfuUnk2*)&gUnknown_03007880[i-1]->unk_70;
+        gUnknown_03007870[i] = (struct RfuUnk1*)&gUnknown_03007870[i-1]->unk_1c;
+    }
+    
+    gUnknown_03007898->unk_dc = (u32)&gUnknown_03007870[3]->unk_1c;
+    STWI_init_all(&gUnknown_03007870[3]->unk_1c, interrupt, copyInterruptToRam);
+    rfu_STC_clearAPIVariables();
+
+    for (i = 0; i < 4; i++)
+    {
+        gUnknown_03007880[i]->unk_68 = 0;
+        gUnknown_03007880[i]->unk_6c = 0;
+        gUnknown_03007870[i]->unk_14 = 0;
+        gUnknown_03007870[i]->unk_18 = 0;
+    }
+
+    // Not matching, register differences
+    v12 = (u16*)((u32)&sub_82E53F4 & ~1);
+    v13 = (u16*)gUnknown_03007898->unk_8;
+        
+    for (i = 47; i != 0xFFFF; i--)
+    {
+        *v13 = *v12;
+        ++v12;
+        ++v13;
+    }
+        
+    gUnknown_03007898->unk_4 = (u32)(&gUnknown_03007898->unk_8[1]);
+        
+    return 0;
+}*/
diff --git a/src/librfu_stwi.c b/src/librfu_stwi.c
new file mode 100644
index 000000000..21d38bb38
--- /dev/null
+++ b/src/librfu_stwi.c
@@ -0,0 +1,687 @@
+#include "global.h"
+#include "librfu.h"
+
+extern IntrFunc IntrSIO32(void);
+
+extern void STWI_stop_timer(void);
+
+void STWI_init_Callback_M(void);
+void STWI_init_Callback_S(void);
+void STWI_set_Callback_M(void * callback);
+void STWI_set_Callback_S(void * callback);
+u16 STWI_init(u8 request);
+int STWI_start_Command(void);
+void STWI_intr_timer(void);
+void STWI_set_timer(u8 unk);
+
+int STWI_restart_Command(void);
+int STWI_reset_ClockCounter(void);
+
+void STWI_init_all(struct RfuIntrStruct *interruptStruct, IntrFunc *interrupt, bool8 copyInterruptToRam)
+{
+    // If we're copying our interrupt into RAM, DMA it to block1 and use
+    // block2 for our RfuStruct, otherwise block1 holds the RfuStruct.
+    // interrupt usually is a pointer to gIntrTable[1]
+    if (copyInterruptToRam == TRUE)
+    {
+        *interrupt = (IntrFunc)interruptStruct->block1;
+        DmaCopy16(3, &IntrSIO32, interruptStruct->block1, 0x960);
+        gRfuState = (struct RfuStruct*)interruptStruct->block2;
+    }
+    else
+    {
+        *interrupt = (IntrFunc)IntrSIO32;
+        gRfuState = (struct RfuStruct*)interruptStruct->block1;
+    }
+
+    gRfuState->rxPacket = (union RfuPacket*)interruptStruct->rxPacketAlloc;
+    gRfuState->txPacket = (union RfuPacket*)interruptStruct->txPacketAlloc;
+    gRfuState->msMode = 1;
+    gRfuState->unk_0 = 0;
+    gRfuState->txParams = 0;
+    gRfuState->unk_5 = 0;
+    gRfuState->unk_7 = 0;
+    gRfuState->unk_8 = 0;
+    gRfuState->unk_9 = 0;
+    gRfuState->timerState = 0;
+    gRfuState->timerActive = 0;
+    gRfuState->unk_12 = 0;
+    gRfuState->unk_15 = 0;
+    gRfuState->unk_2c = 0;
+
+    REG_RCNT = 0x100; //TODO: mystery bit?
+    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
+    STWI_init_Callback_M();
+    STWI_init_Callback_S();
+
+    IntrEnable(INTR_FLAG_SERIAL);
+}
+
+void STWI_init_timer(IntrFunc *interrupt, int timerSelect)
+{
+    *interrupt = STWI_intr_timer;
+    gRfuState->timerSelect = timerSelect;
+
+    IntrEnable(INTR_FLAG_TIMER0 << gRfuState->timerSelect);
+}
+
+void AgbRFU_SoftReset(void)
+{
+    vu16 *timerL;
+    vu16 *timerH;
+
+    REG_RCNT = 0x8000;
+    REG_RCNT = 0x80A0; // all these bits are undocumented
+    timerL = &REG_TMCNT_L(gRfuState->timerSelect);
+    timerH = &REG_TMCNT_H(gRfuState->timerSelect);
+    *timerH = 0;
+    *timerL = 0;
+    *timerH = 0x83;
+    while (*timerL <= 0x11)
+        REG_RCNT = 0x80A2;
+    *timerH = 3;
+    REG_RCNT = 0x80A0;
+    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
+
+    gRfuState->unk_0 = 0;
+    gRfuState->txParams = 0;
+    gRfuState->unk_5 = 0;
+    gRfuState->activeCommand = 0;
+    gRfuState->unk_7 = 0;
+    gRfuState->unk_8 = 0;
+    gRfuState->unk_9 = 0;
+    gRfuState->timerState = 0;
+    gRfuState->timerActive = 0;
+    gRfuState->unk_12 = 0;
+    gRfuState->msMode = 1;
+    gRfuState->unk_15 = 0;
+    gRfuState->unk_2c = 0;
+}
+
+void STWI_set_MS_mode(u8 mode)
+{
+    gRfuState->msMode = mode;
+}
+
+u16 STWI_read_status(u8 index)
+{
+    switch (index)
+    {
+    case 0:
+        return gRfuState->unk_12;
+    case 1:
+        return gRfuState->msMode;
+    case 2:
+        return gRfuState->unk_0;
+    case 3:
+        return gRfuState->activeCommand;
+    default:
+        return 0xFFFF;
+    }
+}
+
+void STWI_init_Callback_M(void)
+{
+    STWI_set_Callback_M(0);
+}
+
+void STWI_init_Callback_S(void)
+{
+    STWI_set_Callback_S(0);
+}
+
+void STWI_set_Callback_M(void *callback)
+{
+    gRfuState->callbackM = callback;
+}
+
+void STWI_set_Callback_S(void *callback)
+{
+    gRfuState->callbackS = callback;
+}
+
+void STWI_set_Callback_ID(u32 id)
+{
+    gRfuState->callbackID = id;
+}
+
+u16 STWI_poll_CommandEnd(void)
+{
+    while (gRfuState->unk_2c == TRUE)
+        ;
+    return gRfuState->unk_12;
+}
+
+void STWI_send_ResetREQ(void)
+{
+    if (!STWI_init(RFU_RESET))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_LinkStatusREQ(void)
+{
+    if (!STWI_init(RFU_LINK_STATUS))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_VersionStatusREQ(void)
+{
+    if (!STWI_init(RFU_VERSION_STATUS))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SystemStatusREQ(void)
+{
+    if (!STWI_init(RFU_SYSTEM_STATUS))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SlotStatusREQ(void)
+{
+    if (!STWI_init(RFU_SLOT_STATUS))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_ConfigStatusREQ(void)
+{
+    if (!STWI_init(RFU_CONFIG_STATUS))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_GameConfigREQ(u8 * unk1, u8 *data)
+{
+    u8 *packetBytes;
+    int i;
+
+    if (!STWI_init(RFU_GAME_CONFIG))
+    {
+        gRfuState->txParams = 6;
+
+        //TODO: what is unk1
+        packetBytes = gRfuState->txPacket->rfuPacket8.data;
+        packetBytes += sizeof(u32);
+        *(u16*)packetBytes = *(u16*)unk1;
+
+        packetBytes += sizeof(u16);
+        unk1 += sizeof(u16);
+
+        for (i = 0; i < 14; i++)
+        {
+            *packetBytes = *unk1;
+            packetBytes++;
+            unk1++;
+        }
+
+        for (i = 0; i < 8; i++)
+        {
+            *packetBytes = *data;
+            packetBytes++;
+            data++;
+        }
+
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SystemConfigREQ(u16 unk1, u8 unk2, u8 unk3)
+{
+    if (!STWI_init(RFU_SYSTEM_CONFIG))
+    {
+        u8 *packetBytes;
+        
+        gRfuState->txParams = 1;
+
+        packetBytes = gRfuState->txPacket->rfuPacket8.data;
+        packetBytes += sizeof(u32);
+
+        *packetBytes++ = unk3;
+        *packetBytes++ = unk2;
+        *(u16*)packetBytes = unk1;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SC_StartREQ(void)
+{
+    if (!STWI_init(RFU_SC_START))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SC_PollingREQ(void)
+{
+    if (!STWI_init(RFU_SC_POLLING))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SC_EndREQ(void)
+{
+    if (!STWI_init(RFU_SC_END))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SP_StartREQ(void)
+{
+    if (!STWI_init(RFU_SP_START))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SP_PollingREQ(void)
+{
+    if (!STWI_init(RFU_SP_POLLING))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_SP_EndREQ(void)
+{
+    if (!STWI_init(RFU_SP_END))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_CP_StartREQ(u16 unk1)
+{
+    if (!STWI_init(RFU_CP_START))
+    {
+        gRfuState->txParams = 1;
+        gRfuState->txPacket->rfuPacket32.data[0] = unk1;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_CP_PollingREQ(void)
+{
+    if (!STWI_init(RFU_CP_POLLING))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_CP_EndREQ(void)
+{
+    if (!STWI_init(RFU_CP_END))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_DataTxREQ(void *in, u8 size)
+{
+    if (!STWI_init(RFU_DATA_TX))
+    {
+        u8 txParams = (size / sizeof(u32));
+        if (size & (sizeof(u32) - 1))
+            txParams += 1;
+            
+        gRfuState->txParams = txParams;
+        CpuCopy32(in, gRfuState->txPacket->rfuPacket32.data, gRfuState->txParams * sizeof(u32));
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_DataTxAndChangeREQ(void *in, u8 size)
+{
+    if (!STWI_init(RFU_DATA_TX_AND_CHANGE))
+    {
+        u8 txParams = (size / sizeof(u32));
+        if (size & (sizeof(u32) - 1))
+            txParams += 1;
+
+        gRfuState->txParams = txParams;
+        CpuCopy32(in, gRfuState->txPacket->rfuPacket32.data, gRfuState->txParams * sizeof(u32));
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_DataRxREQ(void)
+{
+    if (!STWI_init(RFU_DATA_RX))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_MS_ChangeREQ(void)
+{
+    if (!STWI_init(RFU_MS_CHANGE))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_DataReadyAndChangeREQ(u8 unk)
+{
+    if (!STWI_init(RFU_DATA_READY_AND_CHANGE))
+    {
+        if (!unk)
+        {
+            gRfuState->txParams = 0;
+        }
+        else
+        {
+            u8 *packetBytes;
+
+            gRfuState->txParams = 1;
+
+            packetBytes = gRfuState->txPacket->rfuPacket8.data;
+            packetBytes += sizeof(u32);
+
+            *packetBytes++ = unk;
+            *packetBytes++ = 0;
+            *packetBytes++ = 0;
+            *packetBytes = 0;
+        }
+
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_DisconnectedAndChangeREQ(u8 unk0, u8 unk1)
+{
+    if (!STWI_init(RFU_DISCONNECTED_AND_CHANGE))
+    {
+        u8 *packetBytes;
+
+        gRfuState->txParams = 1;
+
+        packetBytes = gRfuState->txPacket->rfuPacket8.data;
+        packetBytes += sizeof(u32);
+
+        *packetBytes++ = unk0;
+        *packetBytes++ = unk1;
+        *packetBytes++ = 0;
+        *packetBytes = 0;
+
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_ResumeRetransmitAndChangeREQ(void)
+{
+    if (!STWI_init(RFU_RESUME_RETRANSMIT_AND_CHANGE))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_DisconnectREQ(u8 unk)
+{
+    if (!STWI_init(RFU_DISCONNECT))
+    {
+        gRfuState->txParams = 1;
+        gRfuState->txPacket->rfuPacket32.data[0] = unk;
+
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_TestModeREQ(u8 unk0, u8 unk1)
+{
+    if (!STWI_init(RFU_TEST_MODE))
+    {
+        gRfuState->txParams = 1;
+        gRfuState->txPacket->rfuPacket32.data[0] = unk0 | (unk1 << 8);
+
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_CPR_StartREQ(u16 unk0, u16 unk1, u8 unk2)
+{
+    u32 *packetData;
+    u32 arg1;
+    
+    if (!STWI_init(RFU_CPR_START))
+    {
+        gRfuState->txParams = 2;
+        
+        arg1 = unk1 | (unk0 << 16);
+        packetData = gRfuState->txPacket->rfuPacket32.data;
+        packetData[0] = arg1;
+        packetData[1] = unk2;
+
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_CPR_PollingREQ(void)
+{
+    if (!STWI_init(RFU_CPR_POLLING))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_CPR_EndREQ(void)
+{
+    if (!STWI_init(RFU_CPR_END))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_send_StopModeREQ(void)
+{
+    if (!STWI_init(RFU_STOP_MODE))
+    {
+        gRfuState->txParams = 0;
+        STWI_start_Command();
+    }
+}
+
+void STWI_intr_timer(void)
+{
+    switch (gRfuState->timerState)
+    {
+        //TODO: Make an enum for these
+        case 2:
+            gRfuState->timerActive = 1;
+            STWI_set_timer(50);
+            break;
+        case 1:
+        case 4:
+            STWI_stop_timer();
+            STWI_restart_Command();
+            break;
+        case 3:
+            gRfuState->timerActive = 1;
+            STWI_stop_timer();
+            STWI_reset_ClockCounter();
+            if (gRfuState->callbackM)
+                gRfuState->callbackM(255, 0);
+            break;
+    }
+}
+
+void STWI_set_timer(u8 unk)
+{
+    vu16 *timerL;
+    vu16 *timerH;
+
+    timerL = &REG_TMCNT_L(gRfuState->timerSelect);
+    timerH = &REG_TMCNT_H(gRfuState->timerSelect);
+    REG_IME = 0;
+    switch (unk)
+    {
+        case 50:
+            *timerL = 0xFCCB;
+            gRfuState->timerState = 1;
+            break;
+        case 80:
+            *timerL = 0xFAE0;
+            gRfuState->timerState = 2;
+            break;
+        case 100:
+            *timerL = 0xF996;
+            gRfuState->timerState = 3;
+            break;
+        case 130:
+            *timerL = 0xF7AD;
+            gRfuState->timerState = 4;
+            break;
+    }
+    *timerH = TIMER_ENABLE | TIMER_INTR_ENABLE | TIMER_1024CLK;
+    REG_IF = INTR_FLAG_TIMER0 << gRfuState->timerSelect;
+    REG_IME = 1;
+}
+
+void STWI_stop_timer(void)
+{
+    gRfuState->timerState = 0;
+    
+    REG_TMCNT_L(gRfuState->timerSelect) = 0;
+    REG_TMCNT_H(gRfuState->timerSelect) = 0;
+}
+
+u16 STWI_init(u8 request)
+{
+    if (!REG_IME)
+    {
+        gRfuState->unk_12 = 6;
+        if (gRfuState->callbackM)
+            gRfuState->callbackM(request, gRfuState->unk_12);
+        return TRUE;
+    }
+    else if (gRfuState->unk_2c == TRUE)
+    {
+        gRfuState->unk_12 = 2;
+        gRfuState->unk_2c = FALSE;
+        if (gRfuState->callbackM)
+            gRfuState->callbackM(request, gRfuState->unk_12);
+        return TRUE;
+    }
+    else if(!gRfuState->msMode)
+    {
+        gRfuState->unk_12 = 4;
+        if (gRfuState->callbackM)
+            gRfuState->callbackM(request, gRfuState->unk_12, gRfuState);
+        return TRUE;
+    }
+    else
+    {
+        gRfuState->unk_2c = TRUE;
+        gRfuState->activeCommand = request;
+        gRfuState->unk_0 = 0;
+        gRfuState->txParams = 0;
+        gRfuState->unk_5 = 0;
+        gRfuState->unk_7 = 0;
+        gRfuState->unk_8 = 0;
+        gRfuState->unk_9 = 0;
+        gRfuState->timerState = 0;
+        gRfuState->timerActive = 0;
+        gRfuState->unk_12 = 0;
+        gRfuState->unk_15 = 0;
+        
+        REG_RCNT = 0x100;
+        REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
+        return FALSE;
+    }
+}
+
+int STWI_start_Command()
+{
+    u16 imeTemp;
+    
+    // Yes, it matters that it's casted to a u32...
+    *(u32*)gRfuState->txPacket->rfuPacket8.data = 0x99660000 | (gRfuState->txParams << 8) | gRfuState->activeCommand;
+    REG_SIODATA32 = gRfuState->txPacket->rfuPacket32.command;
+    
+    gRfuState->unk_0 = 0;
+    gRfuState->unk_5 = 1;
+    
+    imeTemp = REG_IME;
+    REG_IME = 0;
+    REG_IE |= (INTR_FLAG_TIMER0 << gRfuState->timerSelect);
+    REG_IE |= INTR_FLAG_SERIAL;
+    REG_IME = imeTemp;
+    
+    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_MULTI_BUSY | SIO_115200_BPS;
+    
+    return 0;
+}
+
+int STWI_restart_Command(void)
+{
+    if (gRfuState->unk_15 <= 1)
+    {
+        gRfuState->unk_15++;
+        STWI_start_Command();
+    }
+    else
+    {
+        if (gRfuState->activeCommand == RFU_MS_CHANGE || gRfuState->activeCommand == RFU_DATA_TX_AND_CHANGE || gRfuState->activeCommand == RFU_UNK35 || gRfuState->activeCommand == RFU_RESUME_RETRANSMIT_AND_CHANGE)
+        {
+            gRfuState->unk_12 = 1;
+            gRfuState->unk_2c = 0;
+            
+            if (gRfuState->callbackM)
+                gRfuState->callbackM(gRfuState->activeCommand, gRfuState->unk_12);
+        }
+        else
+        {
+            gRfuState->unk_12 = 1;
+            gRfuState->unk_2c = 0;
+            
+            if (gRfuState->callbackM)
+                gRfuState->callbackM(gRfuState->activeCommand, gRfuState->unk_12);
+            
+            gRfuState->unk_0 = 4; //TODO: what's 4
+        }
+    }
+    
+    return 0;
+}
+
+int STWI_reset_ClockCounter()
+{
+    gRfuState->unk_0 = 5; //TODO: what is 5
+    gRfuState->txParams = 0;
+    gRfuState->unk_5 = 0;
+    REG_SIODATA32 = (1 << 31);
+    REG_SIOCNT = 0;
+    REG_SIOCNT = SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS;
+    REG_SIOCNT = (SIO_INTR_ENABLE | SIO_32BIT_MODE | SIO_115200_BPS) + 0x7F;
+    
+    return 0;
+}
-- 
cgit v1.2.3