rvtr/ctr_firmware
1
Fork 0
mirror of https://github.com/rvtr/ctr_firmware.git synced 2025-10-31 07:51:08 -04:00
Code Issues Actions Packages Projects Releases Wiki Activity

r11,r12はFIQではバンクレジスタになるためCPUモード間の受け渡しはr0,r1へ変更。

Browse Source 
git-svn-id: file:///Volumes/Transfer/gigaleak_20231201/2020-09-30%20-%20paladin.7z/paladin/ctr_firmware@226 b871894f-2f95-9b40-918c-086798483c85
This commit is contained in:
nakasima 2009-01-28 08:30:54 +00:00
parent 98ee8bfa67
commit e728496b11
2 changed files with 60 additions and 59 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

56
trunk/bootrom/build/libraries/init/common/crt0_excp.c
View File

@ -220,10 +220,10 @@ asm void i_stupDAbtVeneer( void )
asm void i_stupSwiSemihosting( void )
{
// 割り込み禁止
mrs r12, cpsr
orr r12, r12, #(HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
msr cpsr_fsxc, r12
ldmfd sp!, {r11, r12, lr}
mrs r1, cpsr
orr r1, r1, #(HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
msr cpsr_fsxc, r1
ldmfd sp!, {r0-r1, lr}
add sp, sp, #12
msr cpsr_fsxc, #(HW_PSR_SVC_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
// SVCモード
@ -255,45 +255,45 @@ asm void i_stupSwiHandler( void )
// 呼び出し元のモード
sub sp, sp, #12
stmfd sp!, {r11, r12, lr} // このタイミングでデータアボートハンドラがSWIを使用するとSVCレジスタは復帰不能
add r12, sp, #24 // 呼び出し元のスタック内へ確保したSPSR_svc、LR_svc用スタックアドレスをコピー
stmfd sp!, {r0-r1, lr} // このタイミングでデータアボートハンドラがSWIを使用するとSVCレジスタは復帰不能
add r1, sp, #24 // 呼び出し元のスタック内へ確保したSPSR_svc、LR_svc用スタックアドレスをコピー
msr cpsr_fsxc, #(HW_PSR_SVC_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
// SVCモード
mov sp, r12 // ※SP_svc
mov r12, lr
mrs r11, spsr
stmfd sp!, {r11, lr} // SPSR_svc、LR_svcを退避
mov sp, r1 // ※SP_svc
mov r1, lr
mrs r0, spsr
stmfd sp!, {r0, lr} // SPSR_svc、LR_svcを退避
// 割り込み状態継承
and r11, r11, #(HW_PSR_CPU_MODE_MASK | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
and r0, r0, #(HW_PSR_CPU_MODE_MASK | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
// ユーザモードならシステムモードへ
tst r11, #HW_PSR_SYS_MODE ^ HW_PSR_USR_MODE
orreq r11, r11, #HW_PSR_SYS_MODE
msr cpsr_fsxc, r11
tst r0, #HW_PSR_SYS_MODE ^ HW_PSR_USR_MODE
orreq r0, r0, #HW_PSR_SYS_MODE
msr cpsr_fsxc, r0
// 呼び出し元のモード
ldrh r11, [r12, #-2] // システムコールNo取得
mov r11, r11, lsl #1
and r11, r11, #SVC_ID_PREMASK<<SVC_ID_SHIFT
ldrh r0, [r1, #-2] // システムコールNo取得
mov r0, r0, lsl #1
and r0, r0, #SVC_ID_PREMASK<<SVC_ID_SHIFT
cmp r11, #(SVC_ID_SEMIHOST_ARM & SVC_ID_PREMASK)<<SVC_ID_SHIFT // SVC_ID_SEMIHOST_ARM = 0x12
cmpne r11, #(SVC_ID_SEMIHOST_THUMB & SVC_ID_PREMASK)<<SVC_ID_SHIFT // SVC_ID_SEMIHOST_THUMB = 0xab
cmp r0, #(SVC_ID_SEMIHOST_ARM & SVC_ID_PREMASK)<<SVC_ID_SHIFT // SVC_ID_SEMIHOST_ARM = 0x12
cmpne r0, #(SVC_ID_SEMIHOST_THUMB & SVC_ID_PREMASK)<<SVC_ID_SHIFT // SVC_ID_SEMIHOST_THUMB = 0xab
beq i_stupSwiSemihosting
adr r12, SWI_Table // システムコールアドレス 取得
ldrh r11, [r12, r11]
adr r1, SWI_Table // システムコールアドレス（2バイトテーブル）取得
ldrh r0, [r1, r0]
ldr r12, =HW_BROM
orr r12, r11, r12
ldr r1, =HW_BROM
orr r0, r0, r1
blx r12
blx r0
swi_return
// 割り込み禁止
mrs r12, cpsr
orr r12, r12, #(HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
msr cpsr_fsxc, r12
ldmfd sp!, {r11, r12, lr}
mrs r1, cpsr
orr r1, r1, #(HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
msr cpsr_fsxc, r1
ldmfd sp!, {r0-r1, lr}
add sp, sp, #12
msr cpsr_fsxc, #(HW_PSR_SVC_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
// SVCモード

63
trunk/bootrom/build/libraries/os/common/os_exception.c
View File

@ -75,13 +75,13 @@ asm void i_osUndefInstHandler( void )
// アボート発生元のモード
sub sp, sp, #12
stmfd sp!, {r0, r12, lr}
add r12, sp, #24 // 呼び出し元のスタック内へ確保したSPSR_und、LR_und用スタックアドレスをコピー
stmfd sp!, {r0-r1, lr}
add r1, sp, #24 // 呼び出し元のスタック内へ確保したSPSR_und、LR_und用スタックアドレスをコピー
msr cpsr_fsxc, #(HW_PSR_UNDEF_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
// UNDEFモード
mov sp, r12 // ※SP_und
mov r12, lr
mov sp, r1 // ※SP_und
mov r1, lr
mrs r0, spsr
stmfd sp!, {r0, lr} // SPSR_und、LR_undを退避
@ -105,26 +105,27 @@ asm void i_osUndefInstHandler( void )
// アボート発生元のモード
tst r0, #HW_PSR_THUMB_STATE
subne r12, r12, #2 // Thumb code return address
subeq r12, r12, #4 // ARM code return address
subne r1, r1, #2 // Thumb code return address
subeq r1, r1, #4 // ARM code return address
ldr r0, [r12, #0] // called from ARM
mov r12, r0, lsl #4
sub r12, r12, #0xC0000000
cmp r12, #0x30000000
ldr r0, [r1, #0] // called from ARM
mov r1, r0, lsl #4
sub r1, r1, #0xC0000000
cmp r1, #0x30000000
bhs i_osUndefInstTerminate
adr r12, i_osUndefCPHandlerTable
and r0, r0, #0x00000F00
adr lr, i_return
ldr pc, [r12, r0, lsr #8-2]
adr r1, i_osUndefCPHandlerTable
and r0, r0, #0x00000F00
ldr r0, [r1, r0, lsr #8-2]
blx r0
i_return
// 割り込み禁止
mrs r12, cpsr
orr r12, r12, #(HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
msr cpsr_fsxc, r12
ldmfd sp!, {r0, r12, lr}
mrs r1, cpsr
orr r1, r1, #(HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
msr cpsr_fsxc, r1
ldmfd sp!, {r0-r1, lr}
add sp, sp, #12
msr cpsr_fsxc, #(HW_PSR_UNDEF_MODE | HW_PSR_IRQ_DISABLE | HW_PSR_FIQ_DISABLE)
// UNDEFモード
@ -157,23 +158,23 @@ i_osUndefCPHandlerTable
asm void i_osUndefInstHandlerVFP( void )
{
// VFP enable
fmrx r12, fpexc
tst r12, #HW_FPEXC_VFP_ENABLE
fmrx r1, fpexc
tst r1, #HW_FPEXC_VFP_ENABLE
LSYM(1)
bne BSYM(1) // Error
mov r0, #(HW_FPEXC_EXCEPTION_STATE | HW_FPEXC_FPINST2_VALID)
bic r12, r12, r0
orr r12, r12, #HW_FPEXC_VFP_ENABLE
fmxr fpexc, r12
ldr r12, =(HW_FPSCR_ROUND_NEAR_MODE << HW_FPSCR_ROUND_MODE_SFT \
| HW_FPSCR_VEC_LENGTH_1 << HW_FPSCR_VEC_LENGTH_SFT \
| HW_FPSCR_VEC_STRIDE_1 << HW_FPSCR_VEC_STRIDE_SFT \
| HW_FPSCR_DZE_ENABLE \
| HW_FPSCR_DEFAULT_NAN_MODE \
| HW_FPSCR_FLASH_TO_ZERO_MODE \
)
fmxr fpscr, r12
bic r1, r1, r0
orr r1, r1, #HW_FPEXC_VFP_ENABLE
fmxr fpexc, r1
ldr r1, =(HW_FPSCR_ROUND_NEAR_MODE << HW_FPSCR_ROUND_MODE_SFT \
| HW_FPSCR_VEC_LENGTH_1 << HW_FPSCR_VEC_LENGTH_SFT \
| HW_FPSCR_VEC_STRIDE_1 << HW_FPSCR_VEC_STRIDE_SFT \
| HW_FPSCR_DZE_ENABLE \
| HW_FPSCR_DEFAULT_NAN_MODE \
| HW_FPSCR_FLASH_TO_ZERO_MODE \
)
fmxr fpscr, r1
bx lr
}