mirror of
https://github.com/zeldaret/oot.git
synced 2025-06-07 17:11:50 +00:00
6d56b1b8e0
* Cleanup includes in header files * include libc headers without libc/ prefix * fix * fix2 * fix3 * fix4 * some bss lol * bss * fix
84 lines
2.1 KiB
C
84 lines
2.1 KiB
C
#include "ultra64/asm.h"
|
|
#include "ultra64/leo.h"
|
|
#include "ultra64/leoappli.h"
|
|
#include "ultra64/leodrive.h"
|
|
#include "stdint.h"
|
|
#include "attributes.h"
|
|
|
|
#include "ultra64.h"
|
|
|
|
s32 LeoCJCreateLeoManager(s32 comPri, s32 intPri, OSMesg* cmdBuf, s32 cmdMsgCnt) {
|
|
OSPiHandle* driveRomHandle;
|
|
UNUSED OSPiHandle* leoDiskHandle;
|
|
volatile LEOCmdInquiry cmdBlockInq;
|
|
volatile LEOCmd cmdBlockID;
|
|
LEODiskID thisID;
|
|
u32 stat;
|
|
u32 data;
|
|
|
|
if (__leoActive) {
|
|
return LEO_ERROR_GOOD;
|
|
}
|
|
|
|
if (!LeoDriveExist()) {
|
|
return LEO_ERROR_DEVICE_COMMUNICATION_FAILURE;
|
|
}
|
|
|
|
leoDiskHandle = osLeoDiskInit();
|
|
driveRomHandle = osDriveRomInit();
|
|
__leoActive = true;
|
|
|
|
__osSetHWIntrRoutine(OS_INTR_CART, __osLeoInterrupt, (u8*)STACK_TOP(leoDiskStack) - FRAMESZ(SZREG * NARGSAVE));
|
|
leoInitialize(comPri, intPri, cmdBuf, cmdMsgCnt);
|
|
|
|
if (osResetType == 1) { // NMI
|
|
__leoSetReset();
|
|
}
|
|
|
|
cmdBlockInq.header.command = 2;
|
|
cmdBlockInq.header.reserve1 = 0;
|
|
cmdBlockInq.header.control = 0;
|
|
cmdBlockInq.header.reserve3 = 0;
|
|
leoCommand((void*)&cmdBlockInq);
|
|
|
|
{
|
|
volatile s32 dummy = (uintptr_t)&cmdBlockInq & 0xFFFFFF;
|
|
|
|
while (dummy > 0) {
|
|
dummy -= ((uintptr_t)__leoSetReset & 0xFFFFFF) | 0x403DF4;
|
|
}
|
|
}
|
|
|
|
while (cmdBlockInq.header.status == 8) {}
|
|
|
|
if (cmdBlockInq.header.status != 0) {
|
|
return GET_ERROR(cmdBlockInq);
|
|
}
|
|
|
|
__leoVersion.driver = cmdBlockInq.version;
|
|
__leoVersion.drive = 6;
|
|
__leoVersion.deviceType = cmdBlockInq.devType;
|
|
__leoVersion.nDevices = cmdBlockInq.devNum;
|
|
|
|
stat = __leoVersion.driver & 0xF;
|
|
if (stat == 4) {
|
|
LEO_country_code = 0;
|
|
} else if ((stat == 3) || (stat == 1)) {
|
|
volatile u32 dummy;
|
|
|
|
osEPiReadIo(driveRomHandle, 0x9FF00, &data);
|
|
data = (data & 0xFF000000) >> 24;
|
|
dummy = 0x3ED98F23;
|
|
if (data != 0xC3) {
|
|
while (true) {}
|
|
}
|
|
|
|
dummy *= data;
|
|
dummy -= (uintptr_t)&cmdBlockInq;
|
|
LEO_country_code = 0xE848D316;
|
|
} else {
|
|
while (true) {}
|
|
}
|
|
|
|
return LEO_ERROR_GOOD;
|
|
}
|