GodMode9/arm11/source/main.c

#include <cpu.h>
#include <pxi.h>
#include <gic.h>
#include <gpulcd.h>
#include <vram.h>
#include <types.h>

vu32 *entrypoint = (vu32*)0x1FFFFFFC;

void PXI_IRQHandler(void)
{
    // char pxi_buf[PXI_MAXBUFLEN] = {0};
    u32 pxi_args[PXI_FIFO_LEN]  = {0};
    u8 pxi_cmd;

    pxi_cmd = PXI_GetRemote();
    switch (pxi_cmd) {
    default:
        break;

    case PXI_SCREENINIT:
    {
        GPU_Init();
        GPU_PSCFill(VRAM_START, VRAM_END, 0);
        GPU_SetFramebuffers((u32[]){VRAM_TOP_LA, VRAM_TOP_LB,
                                    VRAM_TOP_RA, VRAM_TOP_RB,
                                    VRAM_BOT_A,  VRAM_BOT_B});

        GPU_SetFramebufferMode(0, PDC_RGB24);
        GPU_SetFramebufferMode(1, PDC_RGB24);

        PXI_SetRemote(PXI_BUSY);
        break;
    }

    case PXI_BRIGHTNESS:
    {
        PXI_RecvArray(pxi_args, 1);
        PXI_SetRemote(PXI_BUSY);
        LCD_SetBrightness(0, pxi_args[0]);
        LCD_SetBrightness(1, pxi_args[0]);
        break;
    }

    /* New CMD template:
    case CMD_ID:
    {
        <var declarations/assignments>
        <receive args from PXI FIFO>
        <if necessary, copy stuff to pxi_buf>
        PXI_SetRemote(PXI_BUSY);
        <execute the command>
        break;
    }
    */
    }

    PXI_SetRemote(PXI_READY);
    return;
}

vu16 *CFG11_MPCORE_CLKCNT = (vu16*)(0x10141300);
vu16 *CFG11_SOCINFO = (vu16*)(0x10140FFC);

void main(void)
{
    u32 entry;

    if ((*CFG11_SOCINFO & 2) && (!(*CFG11_MPCORE_CLKCNT & 1))) {
        GIC_Reset();
        GIC_SetIRQ(88, NULL);
        CPU_EnableIRQ();
        *CFG11_MPCORE_CLKCNT = 0x8001;
        do {
            asm("wfi\n\t");
        } while(!(*CFG11_MPCORE_CLKCNT & 0x8000));
        CPU_DisableIRQ();
    }

    PXI_Reset();
    GIC_Reset();
    GIC_SetIRQ(IRQ_PXI_SYNC, PXI_IRQHandler);
    PXI_EnableIRQ();
    CPU_EnableIRQ();

    PXI_SetRemote(PXI_READY);

    *entrypoint = 0;
    while((entry=*entrypoint) == 0);

    CPU_DisableIRQ();
    PXI_DisableIRQ();
    PXI_Reset();
    GIC_Reset();

    ((void (*)())(entry))();
}