mirror of
https://github.com/fincs/FeOS.git
synced 2025-06-19 03:25:33 -04:00
a53ba81701
- Fake module structure simplified into two big blocks: FEOSKRNL - Platform-"independent" FeOS API FEOSDSHW - DS-specific FeOS API - FeOS_ prefix replaced by NT-like function categories: Ke - General kernel functions Ldr - Module loading Io - Input/output DS - DS-specific functions - Console mode IO region block lifted - many SWI thunks removed - Module export table is now searched using binary search - Kernel iprintf() is overriden to save space - Major code cleanup and reorganization
65 lines
1.3 KiB
C
65 lines
1.3 KiB
C
#include "feos.h"
|
|
#include "feosfifo.h"
|
|
|
|
static int suspendMode = MODE_NORMAL;
|
|
|
|
int DSSetSuspendMode(int mode)
|
|
{
|
|
if (mode == MODE_GET) return suspendMode;
|
|
sassert(mode >= 0 && mode < MODE_COUNT, ERRSTR_INVALIDPARAM);
|
|
|
|
int oldMode = suspendMode;
|
|
suspendMode = mode;
|
|
return oldMode;
|
|
}
|
|
|
|
static volatile u16 oldPowerCnt;
|
|
volatile bool inHeadphoneSleep = false;
|
|
|
|
static void altSystemSleep()
|
|
{
|
|
oldPowerCnt = REG_POWERCNT;
|
|
REG_POWERCNT = oldPowerCnt &~ BIT(0); // turn LCD off
|
|
|
|
FeOSFifoMsg msg;
|
|
msg.type = FEOS_ARM7_HEADPHONE_SLEEP;
|
|
fifoSendDatamsg(FIFO_FEOS, sizeof(msg), (void*)&msg);
|
|
inHeadphoneSleep = true;
|
|
}
|
|
|
|
static void FeOSAddrHandler(void* addr, void* user_data)
|
|
{
|
|
switch ((int)addr)
|
|
{
|
|
case (int)FEOS_ARM9_WAKEUP_ADDR:
|
|
{
|
|
REG_POWERCNT = oldPowerCnt;
|
|
inHeadphoneSleep = false;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void __real_systemValueHandler(u32 value, void* data);
|
|
void __wrap_systemValueHandler(u32 value, void* data)
|
|
{
|
|
if (value != PM_REQ_SLEEP)
|
|
{
|
|
__real_systemValueHandler(value, data);
|
|
return;
|
|
}
|
|
|
|
switch (suspendMode)
|
|
{
|
|
case MODE_DISABLED: return;
|
|
case MODE_NORMAL: systemSleep(); return;
|
|
case MODE_HEADPHONES: altSystemSleep(); return;
|
|
default: sassert(false, "Invalid suspend mode");
|
|
}
|
|
}
|
|
|
|
void installFeOSFIFO()
|
|
{
|
|
fifoSetAddressHandler(FIFO_FEOS, FeOSAddrHandler, NULL);
|
|
}
|