mirror of
https://github.com/isometimes/rpi4-osdev
synced 2024-09-19 21:32:58 +00:00
87 lines
1.5 KiB
ArmAsm
87 lines
1.5 KiB
ArmAsm
#include "boot.h"
|
|
|
|
.section ".text.boot"
|
|
|
|
.globl _start
|
|
_start:
|
|
ldr x0, =SCTLR_VALUE_MMU_DISABLED
|
|
msr sctlr_el1, x0
|
|
|
|
ldr x0, =LOCAL_CONTROL
|
|
str wzr, [x0]
|
|
mov w1, 0x80000000
|
|
str w1, [x0, #(LOCAL_PRESCALER - LOCAL_CONTROL)]
|
|
|
|
ldr x0, =OSC_FREQ // Sort out the timer
|
|
msr cntfrq_el0, x0
|
|
msr cntvoff_el2, xzr
|
|
|
|
ldr x0, =HCR_VALUE
|
|
msr hcr_el2, x0
|
|
|
|
ldr x0, =SCR_VALUE
|
|
msr scr_el3, x0
|
|
|
|
ldr x0, =SPSR_VALUE
|
|
msr spsr_el3, x0
|
|
|
|
adr x0, in_el2
|
|
msr elr_el3, x0
|
|
|
|
eret
|
|
in_el2:
|
|
mrs x6, mpidr_el1
|
|
and x6, x6,#0xFF // Check processor id
|
|
cbz x6, primary_cpu // Hang for all non-primary CPU
|
|
|
|
adr x5, spin_cpu0
|
|
proc_hang:
|
|
wfe
|
|
ldr x4, [x5, x6, lsl #3]
|
|
cbz x4, proc_hang
|
|
|
|
mov x0, #0
|
|
str x0, [x5, x6, lsl #3] // Zero the address again
|
|
|
|
ldr x1, =__test_stack // Get ourselves a fresh stack
|
|
mov sp, x1
|
|
boot_kernel:
|
|
mov x1, #0
|
|
mov x2, #0
|
|
mov x3, #0
|
|
br x4
|
|
b proc_hang
|
|
primary_cpu:
|
|
ldr x1, =__bss_start
|
|
ldr w2, =__bss_size
|
|
memzero:
|
|
cbz w2, startup
|
|
str xzr, [x1], #8
|
|
sub w2, w2, #1
|
|
cbnz w2, memzero
|
|
startup:
|
|
mov sp, #LOW_MEMORY
|
|
bl main
|
|
b proc_hang // should never come here
|
|
|
|
.ltorg
|
|
|
|
.org 0xd8
|
|
.globl spin_cpu0
|
|
spin_cpu0:
|
|
.quad 0
|
|
|
|
.org 0xe0
|
|
.globl spin_cpu1
|
|
spin_cpu1:
|
|
.quad 0
|
|
|
|
.org 0xe8
|
|
.globl spin_cpu2
|
|
spin_cpu2:
|
|
.quad 0
|
|
|
|
.org 0xf0
|
|
.globl spin_cpu3
|
|
spin_cpu3:
|
|
.quad 0
|