155 lines
2.9 KiB
C
155 lines
2.9 KiB
C
#include <3ds/types.h>
|
|
#include <3ds/srv.h>
|
|
#include <3ds/svc.h>
|
|
#include <3ds/gpu/gx.h>
|
|
#include <3ds/services/apt.h>
|
|
#include <3ds/services/gsp.h>
|
|
#include <3ds/services/hid.h>
|
|
|
|
#include "costable.h"
|
|
|
|
u8* gspHeap;
|
|
u32* gxCmdBuf;
|
|
|
|
u8 currentBuffer;
|
|
u8* topLeftFramebuffers[2];
|
|
|
|
Handle gspEvent, gspSharedMemHandle;
|
|
|
|
void gspGpuInit()
|
|
{
|
|
gspInit();
|
|
|
|
GSPGPU_AcquireRight(NULL, 0x0);
|
|
GSPGPU_SetLcdForceBlack(NULL, 0x0);
|
|
|
|
//set subscreen to blue
|
|
u32 regData=0x01FF0000;
|
|
GSPGPU_WriteHWRegs(NULL, 0x202A04, ®Data, 4);
|
|
|
|
//grab main left screen framebuffer addresses
|
|
GSPGPU_ReadHWRegs(NULL, 0x400468, (u32*)&topLeftFramebuffers, 8);
|
|
|
|
//convert PA to VA (assuming FB in VRAM)
|
|
topLeftFramebuffers[0]+=0x7000000;
|
|
topLeftFramebuffers[1]+=0x7000000;
|
|
|
|
//setup our gsp shared mem section
|
|
u8 threadID;
|
|
svcCreateEvent(&gspEvent, 0x0);
|
|
GSPGPU_RegisterInterruptRelayQueue(NULL, gspEvent, 0x1, &gspSharedMemHandle, &threadID);
|
|
svcMapMemoryBlock(gspSharedMemHandle, 0x10002000, 0x3, 0x10000000);
|
|
|
|
//map GSP heap
|
|
svcControlMemory((u32*)&gspHeap, 0x0, 0x0, 0x2000000, 0x10003, 0x3);
|
|
|
|
//wait until we can write stuff to it
|
|
svcWaitSynchronization(gspEvent, 0x55bcb0);
|
|
|
|
//GSP shared mem : 0x2779F000
|
|
gxCmdBuf=(u32*)(0x10002000+0x800+threadID*0x200);
|
|
|
|
currentBuffer=0;
|
|
}
|
|
|
|
void gspGpuExit()
|
|
{
|
|
GSPGPU_UnregisterInterruptRelayQueue(NULL);
|
|
|
|
//unmap GSP shared mem
|
|
svcUnmapMemoryBlock(gspSharedMemHandle, 0x10002000);
|
|
svcCloseHandle(gspSharedMemHandle);
|
|
svcCloseHandle(gspEvent);
|
|
|
|
gspExit();
|
|
|
|
//free GSP heap
|
|
svcControlMemory((u32*)&gspHeap, (u32)gspHeap, 0x0, 0x2000000, MEMOP_FREE, 0x0);
|
|
}
|
|
|
|
void swapBuffers()
|
|
{
|
|
u32 regData;
|
|
GSPGPU_ReadHWRegs(NULL, 0x400478, (u32*)®Data, 4);
|
|
regData^=1;
|
|
currentBuffer=regData&1;
|
|
GSPGPU_WriteHWRegs(NULL, 0x400478, (u32*)®Data, 4);
|
|
}
|
|
|
|
void copyBuffer()
|
|
{
|
|
//copy topleft FB
|
|
u8 copiedBuffer=currentBuffer^1;
|
|
u8* bufAdr=&gspHeap[0x46500*copiedBuffer];
|
|
GSPGPU_FlushDataCache(NULL, bufAdr, 0x46500);
|
|
|
|
GX_RequestDma(gxCmdBuf, (u32*)bufAdr, (u32*)topLeftFramebuffers[copiedBuffer], 0x46500);
|
|
}
|
|
|
|
s32 pcCos(u16 v)
|
|
{
|
|
return costable[v&0x1FF];
|
|
}
|
|
|
|
u32 cnt;
|
|
|
|
void renderEffect()
|
|
{
|
|
u8* bufAdr=&gspHeap[0x46500*currentBuffer];
|
|
|
|
int i, j;
|
|
for(i=1;i<400;i++)
|
|
{
|
|
for(j=1;j<240;j++)
|
|
{
|
|
u32 v=(j+i*240)*3;
|
|
bufAdr[v]=(pcCos(i+cnt)+4096)/32;
|
|
bufAdr[v+1]=(pcCos(j-256+cnt)+4096)/64;
|
|
bufAdr[v+2]=(pcCos(i+128-cnt)+4096)/32;
|
|
}
|
|
}
|
|
cnt++;
|
|
}
|
|
|
|
int main()
|
|
{
|
|
srvInit();
|
|
|
|
aptInit(APPID_APPLICATION);
|
|
|
|
gspGpuInit();
|
|
|
|
hidInit(NULL);
|
|
|
|
APP_STATUS status;
|
|
while((status=aptGetStatus())!=APP_EXITING)
|
|
{
|
|
if(status==APP_RUNNING)
|
|
{
|
|
u32 PAD=hidSharedMem[7];
|
|
|
|
u32 regData=PAD|0x01000000;
|
|
GSPGPU_WriteHWRegs(NULL, 0x202A04, (u32*)®Data, 4);
|
|
|
|
renderEffect();
|
|
swapBuffers();
|
|
copyBuffer();
|
|
}
|
|
else if(status == APP_SUSPENDING)
|
|
{
|
|
aptReturnToMenu();
|
|
}
|
|
else if(status == APP_SLEEPMODE)
|
|
{
|
|
aptWaitStatusEvent();
|
|
}
|
|
svcSleepThread(16666666);
|
|
}
|
|
|
|
hidExit();
|
|
gspGpuExit();
|
|
aptExit();
|
|
svcExitProcess();
|
|
return 0;
|
|
}
|