Luma3DS-3GX/exceptions/arm9/source/mainHandler.c

/*
*   mainHandler.c
*       by TuxSH
*
*   This is part of Luma3DS, see LICENSE.txt for details
*/

#include "i2c.h"
#include "handlers.h"

#define FINAL_BUFFER    0x25000000

#define REG_DUMP_SIZE   (4*17)
#define CODE_DUMP_SIZE  48

void __attribute__((noreturn)) mainHandler(u32 regs[REG_DUMP_SIZE / 4], u32 type)
{
    ExceptionDumpHeader dumpHeader;
    
    u32 registerDump[REG_DUMP_SIZE / 4];
    u8 codeDump[CODE_DUMP_SIZE];
    
    dumpHeader.magic[0] = 0xDEADC0DE;
    dumpHeader.magic[1] = 0xDEADCAFE;
    dumpHeader.versionMajor = 1;
    dumpHeader.versionMinor = 1;
    
    dumpHeader.processor = 9;
    dumpHeader.core = 0;
    dumpHeader.type = type;
    
    dumpHeader.registerDumpSize = REG_DUMP_SIZE;
    dumpHeader.codeDumpSize = CODE_DUMP_SIZE;
    dumpHeader.additionalDataSize = 0;

    //Dump registers
    //Current order of saved regs: cpsr, pc, r8-r14, r0-r7
    u32 cpsr = regs[0];
    u32 pc   = regs[1] - ((type < 3) ? (((cpsr & 0x20) != 0 && type == 1) ? 2 : 4) : 8);

    registerDump[15] = pc;
    registerDump[16] = cpsr;
    for(u32 i = 0; i < 7; i++) registerDump[8 + i]  = regs[2 + i];
    for(u32 i = 0; i < 8; i++) registerDump[i] = regs[9 + i]; 

    dumpHeader.stackDumpSize = 0x1000 - (registerDump[13] & 0xfff);
    dumpHeader.totalSize = sizeof(ExceptionDumpHeader) + dumpHeader.registerDumpSize + dumpHeader.codeDumpSize + dumpHeader.stackDumpSize;
    
    //Dump code
    vu8 *instr = (vu8 *)pc + ((cpsr & 0x20) ? 2 : 4) - dumpHeader.codeDumpSize; //Doesn't work well on 32-bit Thumb instructions, but it isn't much of a problem
    for(u32 i = 0; i < dumpHeader.codeDumpSize; i++)
        codeDump[i] = instr[i];
        
    //Copy header (actually optimized by the compiler), register dump and code dump
    vu32 *final = (vu32 *)FINAL_BUFFER;
    *(ExceptionDumpHeader *)final = dumpHeader;
    final += sizeof(ExceptionDumpHeader) / 4;
    
    for(u32 i = 0; i < dumpHeader.registerDumpSize / 4; i++)
        *final++ = registerDump[i];
    
    for(u32 i = 0; i < dumpHeader.codeDumpSize / 4; i++)
        *final++ = *((u32 *)codeDump + i);
        
    //Dump stack in place
    vu32 *sp = (vu32 *)registerDump[13];
    for(u32 i = 0; i < dumpHeader.stackDumpSize / 4; i++)
        *final++ = sp[i];

    ((void (*)())0xFFFF0830)(); //Ensure that all memory transfers have completed and that the data cache has been flushed
    i2cWriteRegister(I2C_DEV_MCU, 0x20, 1 << 2); //Reboot
    while(1);
}