mirror of https://github.com/n64decomp/sm64.git
64 lines
2.0 KiB
C
64 lines
2.0 KiB
C
#include "libultra_internal.h"
|
|
#include "PR/os.h"
|
|
#include "piint.h"
|
|
|
|
#include "macros.h"
|
|
|
|
#define OS_PI_MGR_MESG_BUFF_SIZE 1
|
|
|
|
OSDevMgr __osPiDevMgr = { 0 };
|
|
|
|
#if defined(VERSION_EU) || defined(VERSION_SH) || defined(VERSION_CN)
|
|
OSPiHandle *__osPiTable = NULL;
|
|
#endif
|
|
|
|
#if defined(VERSION_SH) || defined(VERSION_CN)
|
|
OSPiHandle *__osCurrentHandle[2] = { &__Dom1SpeedParam, &__Dom2SpeedParam };
|
|
#endif
|
|
|
|
FORCE_BSS OSThread piMgrThread;
|
|
FORCE_BSS u32 piMgrStack[0x400]; // stack bottom
|
|
FORCE_BSS OSMesgQueue piEventQueue;
|
|
FORCE_BSS OSMesg piEventBuf[OS_PI_MGR_MESG_BUFF_SIZE + 1];
|
|
|
|
extern u32 gOsPiAccessQueueCreated;
|
|
extern OSMesgQueue gOsPiMessageQueue;
|
|
void __osDevMgrMain(void *);
|
|
|
|
void osCreatePiManager(OSPri pri, OSMesgQueue *cmdQ, OSMesg *cmdBuf, s32 cmdMsgCnt) {
|
|
u32 int_disabled;
|
|
OSPri newPri;
|
|
OSPri currentPri;
|
|
|
|
if (!__osPiDevMgr.active) {
|
|
osCreateMesgQueue(cmdQ, cmdBuf, cmdMsgCnt);
|
|
osCreateMesgQueue(&piEventQueue, &piEventBuf[0], OS_PI_MGR_MESG_BUFF_SIZE);
|
|
if (!gOsPiAccessQueueCreated) {
|
|
__osPiCreateAccessQueue();
|
|
} // what is this constant geez
|
|
osSetEventMesg(OS_EVENT_PI, &piEventQueue, (void *) 0x22222222);
|
|
newPri = -1;
|
|
currentPri = osGetThreadPri(NULL);
|
|
if (currentPri < pri) {
|
|
newPri = currentPri;
|
|
osSetThreadPri(NULL, pri);
|
|
}
|
|
int_disabled = __osDisableInt();
|
|
__osPiDevMgr.active = TRUE;
|
|
__osPiDevMgr.thread = &piMgrThread;
|
|
__osPiDevMgr.cmdQueue = cmdQ;
|
|
__osPiDevMgr.evtQueue = &piEventQueue;
|
|
__osPiDevMgr.acsQueue = &gOsPiMessageQueue;
|
|
__osPiDevMgr.dma = osPiRawStartDma;
|
|
#if defined(VERSION_EU) || defined(VERSION_SH) || defined(VERSION_CN)
|
|
__osPiDevMgr.edma = osEPiRawStartDma;
|
|
#endif
|
|
osCreateThread(&piMgrThread, 0, __osDevMgrMain, (void *) &__osPiDevMgr, &piMgrStack[0x400], pri);
|
|
osStartThread(&piMgrThread);
|
|
__osRestoreInt(int_disabled);
|
|
if (newPri != -1) {
|
|
osSetThreadPri(NULL, newPri);
|
|
}
|
|
}
|
|
}
|