GodMode9/arm9/source/start.s
2017-11-17 19:37:45 +01:00

162 lines
3.7 KiB
ArmAsm

.section .text.start
.align 4
.arm
#include <arm.h>
#include <brf.h>
#include <entrypoints.h>
.global _start
_start:
@ Disable interrupts
mrs r4, cpsr
orr r4, r4, #(SR_IRQ | SR_FIQ)
msr cpsr_c, r4
@ Preserve boot registers
mov r8, r0
mov r9, r1
mov r10, r2
mov r11, r3
@ Clear bss
ldr r0, =__bss_start
ldr r1, =__bss_end
mov r2, #0
.LBSS_Clear:
cmp r0, r1
strlo r2, [r0], #4
blo .LBSS_Clear
ldr r0, =BRF_WB_INV_DCACHE
blx r0 @ Writeback & Invalidate Data Cache
ldr r0, =BRF_INVALIDATE_ICACHE
blx r0 @ Invalidate Instruction Cache
@ Disable caches / DTCM / MPU
ldr r1, =(CR_ENABLE_MPU | CR_ENABLE_DCACHE | CR_ENABLE_ICACHE | \
CR_ENABLE_DTCM)
ldr r2, =(CR_ENABLE_ITCM)
mrc p15, 0, r0, c1, c0, 0
bic r0, r1
orr r0, r2
mcr p15, 0, r0, c1, c0, 0
@ Give full access to defined memory regions
ldr r0, =0x33333333
mcr p15, 0, r0, c5, c0, 2 @ write data access
mcr p15, 0, r0, c5, c0, 3 @ write instruction access
@ Set MPU regions and cache settings
ldr lr, =__mpu_regions
ldmia lr, {r0-r7}
mov lr, #0b00101000
mcr p15, 0, r0, c6, c0, 0
mcr p15, 0, r1, c6, c1, 0
mcr p15, 0, r2, c6, c2, 0
mcr p15, 0, r3, c6, c3, 0
mcr p15, 0, r4, c6, c4, 0
mcr p15, 0, r5, c6, c5, 0
mcr p15, 0, r6, c6, c6, 0
mcr p15, 0, r7, c6, c7, 0
mcr p15, 0, lr, c3, c0, 0 @ Write bufferable
mcr p15, 0, lr, c2, c0, 0 @ Data cacheable
mcr p15, 0, lr, c2, c0, 1 @ Inst cacheable
@ Enable DTCM
ldr r0, =0x3000800A
mcr p15, 0, r0, c9, c1, 0 @ set the DTCM Region Register
@ Fix SDMC mounting
mov r0, #0x10000000
mov r1, #0x340
str r1, [r0, #0x20]
@ Install exception handlers
ldr r0, =XRQ_Start
ldr r1, =XRQ_End
ldr r2, =0x00000000
.LXRQ_Install:
cmp r0, r1
ldrlo r3, [r0], #4
strlo r3, [r2], #4
blo .LXRQ_Install
@ Enable caches / DTCM / select low exception vectors
ldr r1, =(CR_ALT_VECTORS | CR_DISABLE_TBIT)
ldr r2, =(CR_ENABLE_MPU | CR_ENABLE_DCACHE | CR_ENABLE_ICACHE | \
CR_ENABLE_DTCM | CR_CACHE_RROBIN)
mrc p15, 0, r0, c1, c0, 0
bic r0, r1
orr r0, r2
mcr p15, 0, r0, c1, c0, 0
@ Switch to system mode, disable interrupts, setup application stack
msr cpsr_c, #(SR_SYS_MODE | SR_IRQ | SR_FIQ)
ldr sp, =__stack_top
@ Check entrypoints
@ b9s
ldr r3, =0xBEEF
lsl r2, r10, #16
lsr r2, r2, #16
cmp r2, r3
moveq r0, r8
moveq r1, r9
moveq r2, #(ENTRY_B9S)
beq .Lboot_main
@ ntrboot
ldr r4, =0x1FFFE00C
ldr r5, =0x1FFFE010
ldrd r6, r7, [r5]
orr r6, r6, r7
cmp r6, #0
ldreqb r6, [r4, #1]
ldreqb r7, [r4, #3]
cmpeq r6, #0
cmpeq r7, #2
moveq r0, #0
moveq r1, #0
moveq r2, #(ENTRY_NTRBOOT)
beq .Lboot_main
@ nandboot
ldrd r6, r7, [r5]
orr r6, r6, r7
cmp r6, #0
beq .Lentrycheck_firmboot_end
ldrb r6, [r4, #0]
cmp r6, #0
moveq r0, #0
moveq r1, #0
moveq r2, #(ENTRY_NANDBOOT)
beq .Lboot_main
.Lentrycheck_firmboot_end:
@ Unknown
mov r0, #0
mov r1, #0
mov r2, #(ENTRY_UNKNOWN)
.Lboot_main:
ldr r3, =main
mov lr, #0
bx r3
__mpu_regions:
.word 0xFFFF001F @ FFFF0000 64k | bootrom (unprotected / protected)
.word 0x3000801B @ 30008000 16k | dtcm
.word 0x00000035 @ 00000000 128M | itcm (+ mirrors)
.word 0x08000029 @ 08000000 2M | arm9 mem (O3DS / N3DS)
.word 0x10000029 @ 10000000 2M | io mem (ARM9 / first 2MB)
.word 0x20000037 @ 20000000 256M | fcram (O3DS / N3DS)
.word 0x1FF00027 @ 1FF00000 1M | dsp / axi wram
.word 0x1800002D @ 18000000 8M | vram (+ 2MB)