diff options
Diffstat (limited to 'arm9/lib/src')
-rw-r--r-- | arm9/lib/src/FS_rom.c | 18 | ||||
-rw-r--r-- | arm9/lib/src/FX_mtx33.c | 42 | ||||
-rw-r--r-- | arm9/lib/src/FX_mtx43.c | 48 | ||||
-rw-r--r-- | arm9/lib/src/FX_vec.c | 54 | ||||
-rw-r--r-- | arm9/lib/src/GX_g3imm.c | 2 | ||||
-rw-r--r-- | arm9/lib/src/GX_g3x.c | 38 | ||||
-rw-r--r-- | arm9/lib/src/OS_arena.c | 26 | ||||
-rw-r--r-- | arm9/lib/src/OS_emulator.c | 6 | ||||
-rw-r--r-- | arm9/lib/src/OS_init.c | 18 | ||||
-rw-r--r-- | arm9/lib/src/OS_interrupt.c | 2 | ||||
-rw-r--r-- | arm9/lib/src/OS_protectionUnit.c | 21 | ||||
-rw-r--r-- | arm9/lib/src/OS_reset.c | 6 | ||||
-rw-r--r-- | arm9/lib/src/OS_system.c | 14 | ||||
-rw-r--r-- | arm9/lib/src/OS_tcm.c | 2 | ||||
-rw-r--r-- | arm9/lib/src/OS_terminate_proc.c | 4 |
15 files changed, 166 insertions, 135 deletions
diff --git a/arm9/lib/src/FS_rom.c b/arm9/lib/src/FS_rom.c index 4160e3b1..09098dfe 100644 --- a/arm9/lib/src/FS_rom.c +++ b/arm9/lib/src/FS_rom.c @@ -26,18 +26,20 @@ ARM_FUNC FSResult FSi_ReadRomCallback(FSArchive * p_arc, void * dst, u32 src, u3 ARM_FUNC FSResult FSi_WriteDummyCallback(FSArchive * p_arc, const void *src, u32 dst, u32 len) { +#pragma unused(p_arc, src, dst, len) return FS_RESULT_FAILURE; } ARM_FUNC FSResult FSi_RomArchiveProc(FSFile * p_arc, FSCommandType cmd) { +#pragma unused(p_arc) switch (cmd) { case FS_COMMAND_ACTIVATE: - CARD_LockRom(fsi_card_lock_id); + CARD_LockRom((u16)fsi_card_lock_id); return FS_RESULT_SUCCESS; case FS_COMMAND_IDLE: - CARD_UnlockRom(fsi_card_lock_id); + CARD_UnlockRom((u16)fsi_card_lock_id); return FS_RESULT_SUCCESS; case FS_COMMAND_WRITEFILE: return FS_RESULT_UNSUPPORTED; @@ -48,11 +50,13 @@ ARM_FUNC FSResult FSi_RomArchiveProc(FSFile * p_arc, FSCommandType cmd) ARM_FUNC FSResult FSi_ReadDummyCallback(FSArchive *p_arc, void *dst, u32 src, u32 len) { +#pragma unused (p_arc, dst, src, len) return FS_RESULT_FAILURE; } ARM_FUNC FSResult FSi_EmptyArchiveProc(FSFile *p_file, FSCommandType cmd) { +#pragma unused(p_file, cmd) return FS_RESULT_UNSUPPORTED; } @@ -68,7 +72,7 @@ ARM_FUNC void FSi_InitRom(u32 default_dma_no) CARD_Init(); FS_InitArchive(&fsi_arc_rom); - FS_RegisterArchiveName(&fsi_arc_rom, "rom", 3); + (void)FS_RegisterArchiveName(&fsi_arc_rom, "rom", 3); if (MB_IsMultiBootChild()) { @@ -77,7 +81,7 @@ ARM_FUNC void FSi_InitRom(u32 default_dma_no) fsi_ovt7.offset = (u32)~0; fsi_ovt7.length = 0; FS_SetArchiveProc(&fsi_arc_rom, FSi_EmptyArchiveProc, (u32)FS_ARCHIVE_PROC_ALL); - FS_LoadArchive(&fsi_arc_rom, 0x00000000, 0, 0, 0, 0, FSi_ReadDummyCallback, FSi_WriteDummyCallback); + (void)FS_LoadArchive(&fsi_arc_rom, 0x00000000, 0, 0, 0, 0, FSi_ReadDummyCallback, FSi_WriteDummyCallback); } else { @@ -95,7 +99,7 @@ ARM_FUNC void FSi_InitRom(u32 default_dma_no) } else { - FS_LoadArchive(&fsi_arc_rom, 0x00000000, + (void)FS_LoadArchive(&fsi_arc_rom, 0x00000000, fat->offset, fat->length, fnt->offset, fnt->length, FSi_ReadRomCallback, FSi_WriteDummyCallback); @@ -110,8 +114,8 @@ ARM_FUNC u32 FS_SetDefaultDMA(u32 dma_no) BOOL bak_stat = FS_SuspendArchive(&fsi_arc_rom); fsi_default_dma_no = dma_no; if (bak_stat) - FS_ResumeArchive(&fsi_arc_rom); - OS_RestoreInterrupts(bak_psr); + (void)FS_ResumeArchive(&fsi_arc_rom); + (void)OS_RestoreInterrupts(bak_psr); return bak_dma_no; } diff --git a/arm9/lib/src/FX_mtx33.c b/arm9/lib/src/FX_mtx33.c index 90beddba..86169ea0 100644 --- a/arm9/lib/src/FX_mtx33.c +++ b/arm9/lib/src/FX_mtx33.c @@ -3,15 +3,15 @@ #include "fx.h" ARM_FUNC void MTX_ScaleApply33(struct Mtx33 *mtx, struct Mtx33 *dst, fx32 x, fx32 y, fx32 z){ - dst->_[0] = ((fx64)x * mtx->_[0]) >> FX32_INT_SHIFT; - dst->_[1] = ((fx64)x * mtx->_[1]) >> FX32_INT_SHIFT; - dst->_[2] = ((fx64)x * mtx->_[2]) >> FX32_INT_SHIFT; - dst->_[3] = ((fx64)y * mtx->_[3]) >> FX32_INT_SHIFT; - dst->_[4] = ((fx64)y * mtx->_[4]) >> FX32_INT_SHIFT; - dst->_[5] = ((fx64)y * mtx->_[5]) >> FX32_INT_SHIFT; - dst->_[6] = ((fx64)z * mtx->_[6]) >> FX32_INT_SHIFT; - dst->_[7] = ((fx64)z * mtx->_[7]) >> FX32_INT_SHIFT; - dst->_[8] = ((fx64)z * mtx->_[8]) >> FX32_INT_SHIFT; + dst->_[0] = (fx32)(((fx64)x * mtx->_[0]) >> FX32_INT_SHIFT); + dst->_[1] = (fx32)(((fx64)x * mtx->_[1]) >> FX32_INT_SHIFT); + dst->_[2] = (fx32)(((fx64)x * mtx->_[2]) >> FX32_INT_SHIFT); + dst->_[3] = (fx32)(((fx64)y * mtx->_[3]) >> FX32_INT_SHIFT); + dst->_[4] = (fx32)(((fx64)y * mtx->_[4]) >> FX32_INT_SHIFT); + dst->_[5] = (fx32)(((fx64)y * mtx->_[5]) >> FX32_INT_SHIFT); + dst->_[6] = (fx32)(((fx64)z * mtx->_[6]) >> FX32_INT_SHIFT); + dst->_[7] = (fx32)(((fx64)z * mtx->_[7]) >> FX32_INT_SHIFT); + dst->_[8] = (fx32)(((fx64)z * mtx->_[8]) >> FX32_INT_SHIFT); } ARM_FUNC void MTX_Concat33(struct Mtx33 *a, struct Mtx33 *b, struct Mtx33 *c){ @@ -28,30 +28,30 @@ ARM_FUNC void MTX_Concat33(struct Mtx33 *a, struct Mtx33 *b, struct Mtx33 *c){ a0 = a->_[0]; a1 = a->_[1]; a2 = a->_[2]; - dst->_[0] = (((fx64)a0 * b->_[0] + (fx64)a1 * b->_[3] + (fx64)a2 * b->_[6] ) >> FX32_INT_SHIFT); - dst->_[1] = (((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); + dst->_[0] = (fx32)(((fx64)a0 * b->_[0] + (fx64)a1 * b->_[3] + (fx64)a2 * b->_[6] ) >> FX32_INT_SHIFT); + dst->_[1] = (fx32)(((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); b0 = b->_[2]; b1 = b->_[5]; b2 = b->_[8]; - dst->_[2] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[2] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); a0 = a->_[3]; a1 = a->_[4]; a2 = a->_[5]; - dst->_[5] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); - dst->_[4] = (((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); + dst->_[5] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[4] = (fx32)(((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); b0 = b->_[0]; b1 = b->_[3]; b2 = b->_[6]; - dst->_[3] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[3] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); a0 = a->_[6]; a1 = a->_[7]; a2 = a->_[8]; - dst->_[6] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); - dst->_[7] = (((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); + dst->_[6] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[7] = (fx32)(((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); b0 = b->_[2]; b1 = b->_[5]; b2 = b->_[8]; - dst->_[8] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[8] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); if (dst == &temp) *c = temp; @@ -62,9 +62,9 @@ ARM_FUNC void MTX_MultVec33(struct Vecx32 *vec, struct Mtx33 *mtx, struct Vecx32 x = vec->x; y = vec->y; z = vec->z; - dst->x = ((fx64)x * mtx->_[0] + (fx64)y * mtx->_[3] + (fx64)z * mtx->_[6]) >> FX32_INT_SHIFT; - dst->y = ((fx64)x * mtx->_[1] + (fx64)y * mtx->_[4] + (fx64)z * mtx->_[7]) >> FX32_INT_SHIFT; - dst->z = ((fx64)x * mtx->_[2] + (fx64)y * mtx->_[5] + (fx64)z * mtx->_[8]) >> FX32_INT_SHIFT; + dst->x = (fx32)(((fx64)x * mtx->_[0] + (fx64)y * mtx->_[3] + (fx64)z * mtx->_[6]) >> FX32_INT_SHIFT); + dst->y = (fx32)(((fx64)x * mtx->_[1] + (fx64)y * mtx->_[4] + (fx64)z * mtx->_[7]) >> FX32_INT_SHIFT); + dst->z = (fx32)(((fx64)x * mtx->_[2] + (fx64)y * mtx->_[5] + (fx64)z * mtx->_[8]) >> FX32_INT_SHIFT); } ARM_FUNC asm void MTX_Identity33_(struct Mtx33 *mtx){ diff --git a/arm9/lib/src/FX_mtx43.c b/arm9/lib/src/FX_mtx43.c index 96ab4062..693dddff 100644 --- a/arm9/lib/src/FX_mtx43.c +++ b/arm9/lib/src/FX_mtx43.c @@ -2,6 +2,8 @@ #include "main.h" #include "fx.h" +void MI_Copy48B(void *src, void *dst); + ARM_FUNC void MTX_ScaleApply43(struct Mtx43 *mtx, struct Mtx43 *dst, fx32 x, fx32 y, fx32 z){ //this works because matrices are indexed columns first @@ -21,21 +23,21 @@ ARM_FUNC fx32 MTX_Inverse43(struct Mtx43 *mtx, struct Mtx43 *inv){ else dst = inv; //subdeterminants - det0 = ((fx64)mtx->_[4] * mtx->_[8] - (fx64)mtx->_[5] * mtx->_[7] + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT; - det1 = ((fx64)mtx->_[3] * mtx->_[8] - (fx64)mtx->_[5] * mtx->_[6] + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT; - det2 = ((fx64)mtx->_[3] * mtx->_[7] - (fx64)mtx->_[4] * mtx->_[6] + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT; + det0 = (fx32)(((fx64)mtx->_[4] * mtx->_[8] - (fx64)mtx->_[5] * mtx->_[7] + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT); + det1 = (fx32)(((fx64)mtx->_[3] * mtx->_[8] - (fx64)mtx->_[5] * mtx->_[6] + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT); + det2 = (fx32)(((fx64)mtx->_[3] * mtx->_[7] - (fx64)mtx->_[4] * mtx->_[6] + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT); //matrix determinant - det = ((fx64)mtx->_[0] * det0 - (fx64)mtx->_[1] * det1 + (fx64)mtx->_[2] * det2 + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT; + det = (fx32)(((fx64)mtx->_[0] * det0 - (fx64)mtx->_[1] * det1 + (fx64)mtx->_[2] * det2 + (fx64)(1 << (FX32_INT_SHIFT - 1))) >> FX32_INT_SHIFT); if (det == 0) return -1; //not invertible FX_InvAsync(det); - var0 = ((fx64)mtx->_[1] * mtx->_[8] - (fx64)mtx->_[7] * mtx->_[2]) >> FX32_INT_SHIFT; - var1 = ((fx64)mtx->_[1] * mtx->_[5] - (fx64)mtx->_[4] * mtx->_[2]) >> FX32_INT_SHIFT; - var2 = ((fx64)mtx->_[0] * mtx->_[8] - (fx64)mtx->_[6] * mtx->_[2]) >> FX32_INT_SHIFT; - var3 = ((fx64)mtx->_[0] * mtx->_[5] - (fx64)mtx->_[3] * mtx->_[2]) >> FX32_INT_SHIFT; + var0 = (fx32)(((fx64)mtx->_[1] * mtx->_[8] - (fx64)mtx->_[7] * mtx->_[2]) >> FX32_INT_SHIFT); + var1 = (fx32)(((fx64)mtx->_[1] * mtx->_[5] - (fx64)mtx->_[4] * mtx->_[2]) >> FX32_INT_SHIFT); + var2 = (fx32)(((fx64)mtx->_[0] * mtx->_[8] - (fx64)mtx->_[6] * mtx->_[2]) >> FX32_INT_SHIFT); + var3 = (fx32)(((fx64)mtx->_[0] * mtx->_[5] - (fx64)mtx->_[3] * mtx->_[2]) >> FX32_INT_SHIFT); fx32 ret = FX_GetDivResult(); dst->_[0] = (fx32)(((fx64)ret * det0) >> FX32_INT_SHIFT); @@ -73,36 +75,36 @@ ARM_FUNC void MTX_Concat43(struct Mtx43 *a, struct Mtx43 *b, struct Mtx43 *c){ a0 = a->_[0]; a1 = a->_[1]; a2 = a->_[2]; - dst->_[0] = (((fx64)a0 * b->_[0] + (fx64)a1 * b->_[3] + (fx64)a2 * b->_[6] ) >> FX32_INT_SHIFT); - dst->_[1] = (((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); + dst->_[0] = (fx32)(((fx64)a0 * b->_[0] + (fx64)a1 * b->_[3] + (fx64)a2 * b->_[6] ) >> FX32_INT_SHIFT); + dst->_[1] = (fx32)(((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); b0 = b->_[2]; b1 = b->_[5]; b2 = b->_[8]; - dst->_[2] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[2] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); a0 = a->_[3]; a1 = a->_[4]; a2 = a->_[5]; - dst->_[5] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); - dst->_[4] = (((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); + dst->_[5] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[4] = (fx32)(((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); b0 = b->_[0]; b1 = b->_[3]; b2 = b->_[6]; - dst->_[3] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[3] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); a0 = a->_[6]; a1 = a->_[7]; a2 = a->_[8]; - dst->_[6] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); - dst->_[7] = (((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); + dst->_[6] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[7] = (fx32)(((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7] ) >> FX32_INT_SHIFT); b0 = b->_[2]; b1 = b->_[5]; b2 = b->_[8]; - dst->_[8] = (((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); + dst->_[8] = (fx32)(((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT); a0 = a->_[9]; a1 = a->_[10]; a2 = a->_[11]; - dst->_[11] = ((((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT) + b->_[11]); - dst->_[10] = ((((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7]) >> FX32_INT_SHIFT) + b->_[10]); - dst->_[9] = ((((fx64)a0 * b->_[0] + (fx64)a1 * b->_[3] + (fx64)a2 * b->_[6]) >> FX32_INT_SHIFT) + b->_[9]); + dst->_[11] = (fx32)((((fx64)a0 * b0 + (fx64)a1 * b1 + (fx64)a2 * b2) >> FX32_INT_SHIFT) + b->_[11]); + dst->_[10] = (fx32)((((fx64)a0 * b->_[1] + (fx64)a1 * b->_[4] + (fx64)a2 * b->_[7]) >> FX32_INT_SHIFT) + b->_[10]); + dst->_[9] = (fx32)((((fx64)a0 * b->_[0] + (fx64)a1 * b->_[3] + (fx64)a2 * b->_[6]) >> FX32_INT_SHIFT) + b->_[9]); if (dst == &temp) *c = temp; } @@ -112,11 +114,11 @@ ARM_FUNC void MTX_MultVec43(struct Vecx32 *vec, struct Mtx43 *mtx, struct Vecx32 x = vec->x; y = vec->y; z = vec->z; - dst->x = ((fx64)x * mtx->_[0] + (fx64)y * mtx->_[3] + (fx64)z * mtx->_[6]) >> FX32_INT_SHIFT; + dst->x = (fx32)(((fx64)x * mtx->_[0] + (fx64)y * mtx->_[3] + (fx64)z * mtx->_[6]) >> FX32_INT_SHIFT); dst->x += mtx->_[9]; - dst->y = ((fx64)x * mtx->_[1] + (fx64)y * mtx->_[4] + (fx64)z * mtx->_[7]) >> FX32_INT_SHIFT; + dst->y = (fx32)(((fx64)x * mtx->_[1] + (fx64)y * mtx->_[4] + (fx64)z * mtx->_[7]) >> FX32_INT_SHIFT); dst->y += mtx->_[10]; - dst->z = ((fx64)x * mtx->_[2] + (fx64)y * mtx->_[5] + (fx64)z * mtx->_[8]) >> FX32_INT_SHIFT; + dst->z = (fx32)(((fx64)x * mtx->_[2] + (fx64)y * mtx->_[5] + (fx64)z * mtx->_[8]) >> FX32_INT_SHIFT); dst->z += mtx->_[11]; } diff --git a/arm9/lib/src/FX_vec.c b/arm9/lib/src/FX_vec.c index 95805f33..891b980a 100644 --- a/arm9/lib/src/FX_vec.c +++ b/arm9/lib/src/FX_vec.c @@ -15,13 +15,13 @@ ARM_FUNC void VEC_Subtract(struct Vecx32 *a, struct Vecx32 *b, struct Vecx32 *ds } ARM_FUNC void VEC_Fx16Add(struct Vecx16 *a, struct Vecx16 *b, struct Vecx16 *dst){ - dst->x = a->x + b->x; - dst->y = a->y + b->y; - dst->z = a->z + b->z; + dst->x = (s16)(a->x + b->x); + dst->y = (s16)(a->y + b->y); + dst->z = (s16)(a->z + b->z); } ARM_FUNC fx32 VEC_DotProduct(struct Vecx32 *a, struct Vecx32 *b){ - return ((fx64)a->x * b->x + (fx64)a->y * b->y + (fx64)a->z * b->z + (1 << (FX64_INT_SHIFT - 1))) >> FX64_INT_SHIFT; + return (fx32)(((fx64)a->x * b->x + (fx64)a->y * b->y + (fx64)a->z * b->z + (1 << (FX64_INT_SHIFT - 1))) >> FX64_INT_SHIFT); } ARM_FUNC fx32 VEC_Fx16DotProduct(struct Vecx16 *a, struct Vecx16 *b){ @@ -46,9 +46,9 @@ ARM_FUNC void VEC_Fx16CrossProduct(struct Vecx16 *a, struct Vecx16 *b, struct Ve x = ((a->y * b->z - a->z * b->y + (1 << (FX64_INT_SHIFT - 1))) >> FX64_INT_SHIFT); y = ((a->z * b->x - a->x * b->z + (1 << (FX64_INT_SHIFT - 1))) >> FX64_INT_SHIFT); z = ((a->x * b->y - a->y * b->x + (1 << (FX64_INT_SHIFT - 1))) >> FX64_INT_SHIFT); - dst->x = x; - dst->y = y; - dst->z = z; + dst->x = (fx16)x; + dst->y = (fx16)y; + dst->z = (fx16)z; } ARM_FUNC fx32 VEC_Mag(struct Vecx32 *a){ @@ -56,8 +56,8 @@ ARM_FUNC fx32 VEC_Mag(struct Vecx32 *a){ l2 += (fx64)a->y * a->y; l2 += (fx64)a->z * a->z; reg_CP_SQRTCNT = 0x1; - reg_CP_SQRT_PARAM = l2 * 4; - while (reg_CP_SQRTCNT & 0x8000); //wait for coprocessor to finish + reg_CP_SQRT_PARAM = (u64)(l2 * 4); + while (reg_CP_SQRTCNT & 0x8000) {} //wait for coprocessor to finish return ((fx32)reg_CP_SQRT_RESULT + 1) >> 1; } @@ -68,17 +68,17 @@ ARM_FUNC void VEC_Normalize(struct Vecx32 *a, struct Vecx32 *dst){ //1/sqrt(l) is computed by calculating sqrt(l)*(1/l) reg_CP_DIVCNT = 0x2; reg_CP_DIV_NUMER = 0x0100000000000000; - reg_CP_DIV_DENOM = l2; + reg_CP_DIV_DENOM = (u64)l2; reg_CP_SQRTCNT = 0x1; - reg_CP_SQRT_PARAM = l2 * 4; - while (reg_CP_SQRTCNT & 0x8000); //wait for sqrt to finish - fx32 sqrtresult = reg_CP_SQRT_RESULT; - while (reg_CP_DIVCNT & 0x8000); //wait for division to finish - l2 = reg_CP_DIV_RESULT; + reg_CP_SQRT_PARAM = (u64)(l2 * 4); + while (reg_CP_SQRTCNT & 0x8000) {} //wait for sqrt to finish + fx32 sqrtresult = (fx32)reg_CP_SQRT_RESULT; + while (reg_CP_DIVCNT & 0x8000) {} //wait for division to finish + l2 = (fx64)reg_CP_DIV_RESULT; l2 = sqrtresult * l2; - dst->x = (l2 * a->x + (1LL << (0x2D - 1))) >> 0x2D; - dst->y = (l2 * a->y + (1LL << (0x2D - 1))) >> 0x2D; - dst->z = (l2 * a->z + (1LL << (0x2D - 1))) >> 0x2D; + dst->x = (fx32)((l2 * a->x + (1LL << (0x2D - 1))) >> 0x2D); + dst->y = (fx32)((l2 * a->y + (1LL << (0x2D - 1))) >> 0x2D); + dst->z = (fx32)((l2 * a->z + (1LL << (0x2D - 1))) >> 0x2D); } ARM_FUNC void VEC_Fx16Normalize(struct Vecx16 *a, struct Vecx16 *dst){ @@ -88,17 +88,17 @@ ARM_FUNC void VEC_Fx16Normalize(struct Vecx16 *a, struct Vecx16 *dst){ //1/sqrt(l) is computed by calculating sqrt(l)*(1/l) reg_CP_DIVCNT = 0x2; reg_CP_DIV_NUMER = 0x0100000000000000; - reg_CP_DIV_DENOM = l2; + reg_CP_DIV_DENOM = (u64)l2; reg_CP_SQRTCNT = 0x1; - reg_CP_SQRT_PARAM = l2 * 4; - while (reg_CP_SQRTCNT & 0x8000); //wait for sqrt to finish - fx32 sqrtresult = reg_CP_SQRT_RESULT; - while (reg_CP_DIVCNT & 0x8000); //wait for division to finish - l2 = reg_CP_DIV_RESULT; + reg_CP_SQRT_PARAM = (u64)(l2 * 4); + while (reg_CP_SQRTCNT & 0x8000) {} //wait for sqrt to finish + fx32 sqrtresult = (fx32)reg_CP_SQRT_RESULT; + while (reg_CP_DIVCNT & 0x8000) {} //wait for division to finish + l2 = (fx64)reg_CP_DIV_RESULT; l2 = sqrtresult * l2; - dst->x = (l2 * a->x + (1LL << (0x2D - 1))) >> 0x2D; - dst->y = (l2 * a->y + (1LL << (0x2D - 1))) >> 0x2D; - dst->z = (l2 * a->z + (1LL << (0x2D - 1))) >> 0x2D; + dst->x = (fx16)((l2 * a->x + (1LL << (0x2D - 1))) >> 0x2D); + dst->y = (fx16)((l2 * a->y + (1LL << (0x2D - 1))) >> 0x2D); + dst->z = (fx16)((l2 * a->z + (1LL << (0x2D - 1))) >> 0x2D); } ARM_FUNC void VEC_MultAdd(fx32 factor, struct Vecx32 *a, struct Vecx32 *b, struct Vecx32 *dst){ diff --git a/arm9/lib/src/GX_g3imm.c b/arm9/lib/src/GX_g3imm.c index 579032a6..bacd395a 100644 --- a/arm9/lib/src/GX_g3imm.c +++ b/arm9/lib/src/GX_g3imm.c @@ -2,6 +2,8 @@ #include "main.h" #include "GX.h" +void MI_Copy36B(void *src, void *dst); + ARM_FUNC void G3_LoadMtx43(struct Mtx43 *mtx){ reg_G3X_GXFIFO = 0x17; GX_SendFifo48B(mtx, (void *)®_G3X_GXFIFO); diff --git a/arm9/lib/src/GX_g3x.c b/arm9/lib/src/GX_g3x.c index 31508e06..ed84f58b 100644 --- a/arm9/lib/src/GX_g3x.c +++ b/arm9/lib/src/GX_g3x.c @@ -4,6 +4,8 @@ extern u32 GXi_DmaId; +void MI_Copy36B(void *src, void *dst); + ARM_FUNC asm void GXi_NopClearFifo128_(void *reg){ mov r1, #0x0 mov r2, #0x0 @@ -47,15 +49,15 @@ ARM_FUNC asm void GXi_NopClearFifo128_(void *reg){ ARM_FUNC void G3X_Init(){ G3X_ClearFifo(); reg_G3_END_VTXS = 0x0; - while (reg_G3X_GXSTAT & 0x8000000); //wait for geometry engine to not be busy + while (reg_G3X_GXSTAT & 0x8000000) {} //wait for geometry engine to not be busy reg_G3X_DISP3DCNT = 0x0; reg_G3X_GXSTAT = 0x0; reg_G2_BG0OFS = 0x0; reg_G3X_DISP3DCNT |= 0x2000; reg_G3X_DISP3DCNT |= 0x1000; reg_G3X_DISP3DCNT &= ~0x3002; - reg_G3X_DISP3DCNT = reg_G3X_DISP3DCNT & ~0x3000 | 0x10; - reg_G3X_DISP3DCNT = reg_G3X_DISP3DCNT & (u16)~0x3004; + reg_G3X_DISP3DCNT = (u16)(reg_G3X_DISP3DCNT & ~0x3000 | 0x10); + reg_G3X_DISP3DCNT = (u16)(reg_G3X_DISP3DCNT & (u16)~0x3004); reg_G3X_GXSTAT |= 0x8000; reg_G3X_GXSTAT = reg_G3X_GXSTAT & ~0xC0000000 | 0x80000000; G3X_InitMtxStack(); @@ -72,7 +74,7 @@ ARM_FUNC void G3X_Init(){ } ARM_FUNC void G3X_ResetMtxStack(){ - while (reg_G3X_GXSTAT & 0x8000000); + while (reg_G3X_GXSTAT & 0x8000000) {} reg_G3X_GXSTAT |= 0x8000; reg_G3X_DISP3DCNT |= 0x2000; reg_G3X_DISP3DCNT |= 0x1000; @@ -84,14 +86,14 @@ ARM_FUNC void G3X_ResetMtxStack(){ ARM_FUNC void G3X_ClearFifo(){ GXi_NopClearFifo128_((void *)®_G3X_GXFIFO); - while (reg_G3X_GXSTAT & 0x8000000); + while (reg_G3X_GXSTAT & 0x8000000) {} } ARM_FUNC void G3X_InitMtxStack(){ u32 PV_level, PJ_level; reg_G3X_GXSTAT |= 0x8000; - while (G3X_GetMtxStackLevelPV(&PV_level)); - while (G3X_GetMtxStackLevelPJ(&PJ_level)); + while (G3X_GetMtxStackLevelPV(&PV_level)) {} + while (G3X_GetMtxStackLevelPJ(&PJ_level)) {} reg_G3_MTX_MODE = 0x3; reg_G3_MTX_IDENTITY = 0x0; reg_G3_MTX_MODE = 0x0; @@ -108,8 +110,8 @@ ARM_FUNC void G3X_InitMtxStack(){ ARM_FUNC void G3X_ResetMtxStack_2(){ u32 PV_level, PJ_level; reg_G3X_GXSTAT |= 0x8000; - while (G3X_GetMtxStackLevelPV(&PV_level)); - while (G3X_GetMtxStackLevelPJ(&PJ_level)); + while (G3X_GetMtxStackLevelPV(&PV_level)) {} + while (G3X_GetMtxStackLevelPJ(&PJ_level)) {} reg_G3_MTX_MODE = 0x3; reg_G3_MTX_IDENTITY = 0x0; reg_G3_MTX_MODE = 0x0; @@ -127,20 +129,20 @@ ARM_FUNC void G3X_ResetMtxStack_2(){ ARM_FUNC void G3X_SetFog(u32 enable, u32 alphamode, u32 depth, s32 offset){ if (enable) { - reg_G3X_FOG_OFFSET = offset; - reg_G3X_DISP3DCNT = (reg_G3X_DISP3DCNT &~0x3f40) | (((depth << 0x8)| (alphamode << 0x6)|0x80 )); + reg_G3X_FOG_OFFSET = (u16)offset; + reg_G3X_DISP3DCNT = (u16)((reg_G3X_DISP3DCNT &~0x3f40) | (((depth << 0x8)| (alphamode << 0x6)|0x80 ))); } else { - reg_G3X_DISP3DCNT = reg_G3X_DISP3DCNT & (u16)~0x3080; + reg_G3X_DISP3DCNT = (u16)(reg_G3X_DISP3DCNT & (u16)~0x3080); } } ARM_FUNC u32 G3X_GetClipMtx(struct Mtx44 *dst){ if (reg_G3X_GXSTAT & 0x8000000) { - return -1; + return (u32)-1; } else { @@ -152,7 +154,7 @@ ARM_FUNC u32 G3X_GetClipMtx(struct Mtx44 *dst){ ARM_FUNC u32 G3X_GetVectorMtx(struct Mtx33 *dst){ if (reg_G3X_GXSTAT & 0x8000000) { - return -1; + return (u32)-1; } else { @@ -174,7 +176,7 @@ ARM_FUNC void G3X_SetClearColor(u32 col, u32 alpha, u32 depth, u32 polygon_id, u if (enable_fog) temp |= 0x8000; reg_G3X_CLEAR_COLOR = temp; - reg_G3X_CLEAR_DEPTH = depth; + reg_G3X_CLEAR_DEPTH = (u16)depth; } ARM_FUNC void G3X_InitTable(){ @@ -197,7 +199,7 @@ ARM_FUNC void G3X_InitTable(){ ARM_FUNC u32 G3X_GetMtxStackLevelPV(u32 *level){ if (reg_G3X_GXSTAT & 0x4000) { - return -1; + return (u32)-1; } else { @@ -209,7 +211,7 @@ ARM_FUNC u32 G3X_GetMtxStackLevelPV(u32 *level){ ARM_FUNC u32 G3X_GetMtxStackLevelPJ(u32 *level){ if (reg_G3X_GXSTAT & 0x4000) { - return -1; + return (u32)-1; } else { @@ -221,7 +223,7 @@ ARM_FUNC u32 G3X_GetMtxStackLevelPJ(u32 *level){ ARM_FUNC u32 G3X_GetBoxTestResult(u32 *result){ if (reg_G3X_GXSTAT & 0x1) { - return -1; + return (u32)-1; } else { diff --git a/arm9/lib/src/OS_arena.c b/arm9/lib/src/OS_arena.c index 31796771..9e7d3223 100644 --- a/arm9/lib/src/OS_arena.c +++ b/arm9/lib/src/OS_arena.c @@ -17,7 +17,7 @@ extern void SDK_SECTION_ARENA_DTCM_START(); // TODO: technically this should be extern void SDK_IRQ_STACKSIZE(); // TODO: technically this should be defined in the lcf
extern void SDK_SYS_STACKSIZE(); // TODO: technically this should be defined in the lcf
-ARM_FUNC void OS_InitArena() {
+ARM_FUNC void OS_InitArena(void) {
if (OSi_Initialized) {
return;
}
@@ -42,7 +42,7 @@ ARM_FUNC void OS_InitArena() { OS_SetArenaLo(OS_ARENA_WRAM_MAIN, OS_GetInitArenaLo(OS_ARENA_WRAM_MAIN));
}
-ARM_FUNC void OS_InitArenaEx() {
+ARM_FUNC void OS_InitArenaEx(void) {
OS_SetArenaHi(2, OS_GetInitArenaHi(OS_ARENA_MAINEX));
OS_SetArenaLo(2, OS_GetInitArenaLo(OS_ARENA_MAINEX));
@@ -73,22 +73,22 @@ ARM_FUNC void* OS_GetInitArenaHi(OSArenaId id) { case OS_ARENA_ITCM:
return (void *)HW_ITCM_ARENA_HI_DEFAULT;
case OS_ARENA_DTCM:
- u32 irqStackLo = (u32)HW_DTCM_IRQ_STACK_END - (s32)SDK_IRQ_STACKSIZE;
+ {
+ u32 irqStackLo = (u32) HW_DTCM_IRQ_STACK_END - (s32) SDK_IRQ_STACKSIZE;
u32 sysStackLo;
- if (!(s32)SDK_SYS_STACKSIZE) {
+ if (!(s32) SDK_SYS_STACKSIZE) {
sysStackLo = HW_DTCM;
- if (sysStackLo < (u32)SDK_SECTION_ARENA_DTCM_START) {
- sysStackLo = (u32)SDK_SECTION_ARENA_DTCM_START;
+ if (sysStackLo < (u32) SDK_SECTION_ARENA_DTCM_START) {
+ sysStackLo = (u32) SDK_SECTION_ARENA_DTCM_START;
}
+ } else if ((s32) SDK_SYS_STACKSIZE < 0) {
+ sysStackLo = (u32) SDK_SECTION_ARENA_DTCM_START - (s32) SDK_SYS_STACKSIZE;
+ } else {
+ sysStackLo = irqStackLo - (s32) SDK_SYS_STACKSIZE;
}
- else if ((s32)SDK_SYS_STACKSIZE < 0) {
- sysStackLo = (u32)SDK_SECTION_ARENA_DTCM_START - (s32)SDK_SYS_STACKSIZE;
- }
- else {
- sysStackLo = irqStackLo - (s32)SDK_SYS_STACKSIZE;
- }
- return (void*)sysStackLo;
+ return (void *) sysStackLo;
+ }
case OS_ARENA_SHARED:
return (void *)HW_SHARED_ARENA_HI_DEFAULT;
case OS_ARENA_WRAM_MAIN:
diff --git a/arm9/lib/src/OS_emulator.c b/arm9/lib/src/OS_emulator.c index c138b2bc..e92a7d9d 100644 --- a/arm9/lib/src/OS_emulator.c +++ b/arm9/lib/src/OS_emulator.c @@ -5,13 +5,13 @@ #include "OS_emulator.h" #include "function_target.h" -u32 OSi_ConsoleTypeCache = -1u; //todo fix bss +u32 OSi_ConsoleTypeCache = -1u; -ARM_FUNC BOOL OS_IsRunOnEmulator() { +ARM_FUNC BOOL OS_IsRunOnEmulator(void) { return FALSE; } -ARM_FUNC u32 OS_GetConsoleType() { +ARM_FUNC u32 OS_GetConsoleType(void) { OSi_ConsoleTypeCache = OS_CONSOLE_NITRO | OS_CONSOLE_DEV_CARD | OS_CONSOLE_SIZE_4MB; return OSi_ConsoleTypeCache; diff --git a/arm9/lib/src/OS_init.c b/arm9/lib/src/OS_init.c index a34196f4..e1c7e63a 100644 --- a/arm9/lib/src/OS_init.c +++ b/arm9/lib/src/OS_init.c @@ -5,15 +5,15 @@ #include "function_target.h" #include "OS_init.h" -extern void PXI_Init(); -extern void OS_InitException(); -extern void MI_Init(); -extern void OS_InitVAlarm(); -extern void OSi_InitVramExclusive(); -extern void OS_InitThread(); -extern void CTRDG_Init(); -extern void CARD_Init(); -extern void PM_Init(); +extern void PXI_Init(void); +extern void OS_InitException(void); +extern void MI_Init(void); +extern void OS_InitVAlarm(void); +extern void OSi_InitVramExclusive(void); +extern void OS_InitThread(void); +extern void CTRDG_Init(void); +extern void CARD_Init(void); +extern void PM_Init(void); ARM_FUNC void OS_Init(void) { OS_InitArena(); diff --git a/arm9/lib/src/OS_interrupt.c b/arm9/lib/src/OS_interrupt.c index 76deb069..4692fd54 100644 --- a/arm9/lib/src/OS_interrupt.c +++ b/arm9/lib/src/OS_interrupt.c @@ -11,7 +11,7 @@ extern OSThreadQueue OSi_IrqThreadQueue; -ARM_FUNC void OS_InitIrqTable() { +ARM_FUNC void OS_InitIrqTable(void) { OS_InitThreadQueue(&OSi_IrqThreadQueue); } diff --git a/arm9/lib/src/OS_protectionUnit.c b/arm9/lib/src/OS_protectionUnit.c new file mode 100644 index 00000000..be57dcd6 --- /dev/null +++ b/arm9/lib/src/OS_protectionUnit.c @@ -0,0 +1,21 @@ +// +// Created by red031000 on 2020-05-24. +// + +#include "function_target.h" + +ARM_FUNC asm void OS_EnableProtectionUnit(void) +{ + mrc p15, 0x0, r0, c1, c0, 0x0 + orr r0, r0, #0x1 + mcr p15, 0x0, r0, c1, c0, 0x0 + bx lr +} + +ARM_FUNC asm void OS_DisableProtectionUnit(void) +{ + mrc p15, 0x0, r0, c1, c0, 0x0 + bic r0, r0, #0x1 + mcr p15, 0x0, r0, c1, c0, 0x0 + bx lr +} diff --git a/arm9/lib/src/OS_reset.c b/arm9/lib/src/OS_reset.c index 02498962..e051f6ff 100644 --- a/arm9/lib/src/OS_reset.c +++ b/arm9/lib/src/OS_reset.c @@ -11,15 +11,15 @@ static u16 OSi_IsInitReset = 0; vu16 OSi_IsResetOccurred = 0; -extern void PXI_Init(); +extern void PXI_Init(void); extern u32 PXI_IsCallbackReady(u32 param1, u32 param2); extern void PXI_SetFifoRecvCallback(u32 param1, void* callback); extern u32 PXI_SendWordByFifo(u32 param1, u32 data, u32 param2); extern void CARD_LockRom(u16 lockId); extern void MI_StopDma(u32 dma); -extern void OSi_DoResetSystem(); //in itcm, should technically be in this file +extern void OSi_DoResetSystem(void); //in itcm, should technically be in this file -ARM_FUNC void OS_InitReset() { +ARM_FUNC void OS_InitReset(void) { if (OSi_IsInitReset) { return; } diff --git a/arm9/lib/src/OS_system.c b/arm9/lib/src/OS_system.c index 5379433b..1d257679 100644 --- a/arm9/lib/src/OS_system.c +++ b/arm9/lib/src/OS_system.c @@ -5,7 +5,7 @@ #include "OS_system.h" #include "syscall.h" -ARM_FUNC asm OSIntrMode OS_EnableInterrupts() { +ARM_FUNC asm OSIntrMode OS_EnableInterrupts(void) { mrs r0, cpsr bic r1, r0, #HW_PSR_DISABLE_IRQ msr cpsr_c, r1 @@ -13,7 +13,7 @@ ARM_FUNC asm OSIntrMode OS_EnableInterrupts() { bx lr } -ARM_FUNC asm OSIntrMode OS_DisableInterrupts() { +ARM_FUNC asm OSIntrMode OS_DisableInterrupts(void) { mrs r0, cpsr orr r1, r0, #HW_PSR_DISABLE_IRQ msr cpsr_c, r1 @@ -30,7 +30,7 @@ ARM_FUNC asm OSIntrMode OS_RestoreInterrupts(OSIntrMode state) { bx lr } -ARM_FUNC asm OSIntrMode OS_DisableInterrupts_IrqAndFiq() { +ARM_FUNC asm OSIntrMode OS_DisableInterrupts_IrqAndFiq(void) { mrs r0, cpsr orr r1, r0, #HW_PSR_DISABLE_IRQ_FIQ msr cpsr_c, r1 @@ -47,25 +47,25 @@ ARM_FUNC asm OSIntrMode OS_RestoreInterrupts_IrqAndFiq(OSIntrMode state) { bx lr } -ARM_FUNC asm OSIntrMode OS_GetCpsrIrq() { +ARM_FUNC asm OSIntrMode OS_GetCpsrIrq(void) { mrs r0, cpsr and r0, r0, #HW_PSR_DISABLE_IRQ bx lr } -ARM_FUNC asm OSProcMode OS_GetProcMode() { +ARM_FUNC asm OSProcMode OS_GetProcMode(void) { mrs r0, cpsr and r0, r0, #HW_PSR_CPU_MODE_MASK bx lr } -ARM_FUNC asm void OS_SpinWait() { +ARM_FUNC asm void OS_SpinWait(void) { subs r0, r0, #0x4 bhs OS_SpinWait bx lr } -ARM_FUNC void OS_WaitVBlankIntr() { +ARM_FUNC void OS_WaitVBlankIntr(void) { SVC_WaitByLoop(0x1); OS_WaitIrq(TRUE, OS_IE_V_BLANK); } diff --git a/arm9/lib/src/OS_tcm.c b/arm9/lib/src/OS_tcm.c index 5a168c58..fa06e345 100644 --- a/arm9/lib/src/OS_tcm.c +++ b/arm9/lib/src/OS_tcm.c @@ -5,7 +5,7 @@ #include "OS_tcm.h" #include "function_target.h" -ARM_FUNC asm u32 OS_GetDTCMAddress() { +ARM_FUNC asm u32 OS_GetDTCMAddress(void) { mrc p15, 0x0, r0, c9, c1, 0x0 ldr r1, =OSi_TCM_REGION_BASE_MASK and r0, r0, r1 diff --git a/arm9/lib/src/OS_terminate_proc.c b/arm9/lib/src/OS_terminate_proc.c index eb267c6b..40b015d9 100644 --- a/arm9/lib/src/OS_terminate_proc.c +++ b/arm9/lib/src/OS_terminate_proc.c @@ -7,14 +7,14 @@ #include "function_target.h" #include "OS_system.h" -ARM_FUNC void OS_Terminate() { +ARM_FUNC void OS_Terminate(void) { while (TRUE) { (void)OS_DisableInterrupts(); OS_Halt(); } } -ARM_FUNC asm void OS_Halt() { +ARM_FUNC asm void OS_Halt(void) { mov r0, #0x0 mcr p15, 0x0, r0, c7, c0, 0x4 bx lr |