ユーザモードとシステムモードのみVFPを使用可能に。

git-svn-id: file:///Volumes/Transfer/gigaleak_20231201/2020-09-30%20-%20paladin.7z/paladin/ctr_firmware@144 b871894f-2f95-9b40-918c-086798483c85
This commit is contained in:
nakasima 2008-12-25 12:01:35 +00:00
parent f4f2ed0cfc
commit 4345604172

View File

@ -58,21 +58,29 @@ void osInitException( void )
*---------------------------------------------------------------------------*/
ASM void i_osUndefInstHandler( void )
{
// change into previous mode
mrs sp, spsr
orr sp, sp, #HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE
msr cpsr_fsxc, sp
// change into system mode
msr cpsr_fsxc, #HW_PSR_SYS_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE
stmfd sp!, {r0, r12, lr, pc} // push to previous mode stack (8byte alignment)
// get LR and SPSR into UNDEF mode
// get LR and SPSR of UNDEF mode
msr cpsr_fsxc, #HW_PSR_UNDEF_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE
mov r12, lr
mrs r0, spsr
// change into previous mode
orr sp, r0, #HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE
msr cpsr_fsxc, sp
tst r0, #HW_PSR_THUMB_STATE
bne i_osUndefInstTerminate
tst r0, #HW_PSR_JAVA_STATE
bne i_osUndefInstTerminate
// permit for only system and user mode to use VFP
and lr, r0, #HW_PSR_CPU_MODE_MASK
cmp lr, #HW_PSR_SYS_MODE
cmpne lr, #HW_PSR_USR_MODE
bne i_osUndefInstTerminate
// change into system mode
msr cpsr_fsxc, #HW_PSR_SYS_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE
tst r0, #HW_PSR_THUMB_STATE
subne r12, r12, #2 // Thumb code return address
@ -83,12 +91,6 @@ ASM void i_osUndefInstHandler( void )
adr lr, i_return
tst r0, #HW_PSR_THUMB_STATE
bne i_osUndefInstTerminate
tst r0, #HW_PSR_JAVA_STATE
bne i_osUndefInstTerminate
ldr r0, [r12, #0] // called from ARM
mov r12, r0, lsl #4
sub r12, r12, #0xC0000000
@ -101,6 +103,7 @@ ASM void i_osUndefInstHandler( void )
i_return
ldmfd sp!, {r0-r3} // pop spsr
// restore into previous mode
msr cpsr_fsxc, r0
ldmfd sp!, {r0, r12, lr, pc} // pop from USR stack