parent
174e0da3b6
commit
cc936ded35
@ -0,0 +1,99 @@
|
|||||||
|
# TODO rewrite in Rust, use crate cortex-a
|
||||||
|
|
||||||
|
.section .text.boot
|
||||||
|
|
||||||
|
.global _start
|
||||||
|
_start:
|
||||||
|
# read cpu affinity, start core 0, halt rest
|
||||||
|
mrs x1, mpidr_el1
|
||||||
|
and x1, x1, #3
|
||||||
|
cbz x1, setup
|
||||||
|
|
||||||
|
halt:
|
||||||
|
# core affinity != 0, halt it
|
||||||
|
wfe
|
||||||
|
b halt
|
||||||
|
|
||||||
|
setup:
|
||||||
|
# store the desired EL1 stack pointer in x1
|
||||||
|
adr x1, _start
|
||||||
|
|
||||||
|
# read the current exception level into x0 (ref: C5.2.1)
|
||||||
|
mrs x0, CurrentEL
|
||||||
|
and x0, x0, #0b1100
|
||||||
|
lsr x0, x0, #2
|
||||||
|
|
||||||
|
switch_to_el2:
|
||||||
|
# switch to EL2 if we're in EL3. otherwise switch to EL1
|
||||||
|
cmp x0, #2
|
||||||
|
beq switch_to_el1
|
||||||
|
|
||||||
|
# set-up SCR_EL3 (bits 0, 4, 5, 7, 8, 10) (A53: 4.3.42)
|
||||||
|
mov x0, #0x5b1
|
||||||
|
msr scr_el3, x0
|
||||||
|
|
||||||
|
# set-up SPSR_EL3 (bits 0, 3, 6, 7, 8, 9) (ref: C5.2.20)
|
||||||
|
mov x0, #0x3c9
|
||||||
|
msr spsr_el3, x0
|
||||||
|
|
||||||
|
# switch
|
||||||
|
adr x0, switch_to_el1
|
||||||
|
msr elr_el3, x0
|
||||||
|
|
||||||
|
eret
|
||||||
|
|
||||||
|
switch_to_el1:
|
||||||
|
# switch to EL1 if we're not already in EL1. otherwise continue with start
|
||||||
|
cmp x0, #1
|
||||||
|
beq set_stack
|
||||||
|
|
||||||
|
# set the stack-pointer for EL1
|
||||||
|
msr sp_el1, x1
|
||||||
|
|
||||||
|
# set-up HCR_EL2, enable AArch64 in EL1 (bits 1, 31) (ref: D10.2.45)
|
||||||
|
mov x0, #0x0002
|
||||||
|
movk x0, #0x8000, lsl #16
|
||||||
|
msr hcr_el2, x0
|
||||||
|
|
||||||
|
# Set SCTLR to known state (RES1: 11, 20, 22, 23, 28, 29) (ref: D10.2.100)
|
||||||
|
mov x0, #0x0800
|
||||||
|
movk x0, #0x30d0, lsl #16
|
||||||
|
msr sctlr_el1, x0
|
||||||
|
|
||||||
|
# set-up SPSR_EL2 (bits 0, 2, 6, 7, 8, 9) (ref: C5.2.19)
|
||||||
|
mov x0, #0x3c5
|
||||||
|
msr spsr_el2, x0
|
||||||
|
|
||||||
|
# enable CNTP for EL1/EL0 (ref: D7.5.2, D7.5.13)
|
||||||
|
# NOTE: This doesn't actually enable the counter stream.
|
||||||
|
mrs x0, cnthctl_el2
|
||||||
|
orr x0, x0, #3
|
||||||
|
msr cnthctl_el2, x0
|
||||||
|
msr cntvoff_el2, xzr
|
||||||
|
|
||||||
|
# switch
|
||||||
|
adr x0, set_stack
|
||||||
|
msr elr_el2, x0
|
||||||
|
|
||||||
|
eret
|
||||||
|
|
||||||
|
set_stack:
|
||||||
|
# set the current stack pointer
|
||||||
|
mov sp, x1
|
||||||
|
|
||||||
|
zero_bss:
|
||||||
|
# load the start address and number of bytes in BSS section
|
||||||
|
ldr x1, =__bss_start
|
||||||
|
ldr x2, =__bss_length
|
||||||
|
|
||||||
|
zero_bss_loop:
|
||||||
|
# zero out the BSS section, 64-bits at a time
|
||||||
|
cbz x2, go_kmain
|
||||||
|
str xzr, [x1], #8
|
||||||
|
sub x2, x2, #8
|
||||||
|
cbnz x2, zero_bss_loop
|
||||||
|
|
||||||
|
go_kmain:
|
||||||
|
# jump to rust_main, which shouldn't return. halt if it does
|
||||||
|
bl rust_main
|
||||||
|
b halt
|
@ -0,0 +1,39 @@
|
|||||||
|
ENTRY(_start)
|
||||||
|
|
||||||
|
SECTIONS {
|
||||||
|
. = 0x80000; /* Raspbery Pi 3 Aarch64 (kernel8.img) load address */
|
||||||
|
|
||||||
|
/* start of the binary */
|
||||||
|
_start = .;
|
||||||
|
|
||||||
|
.text : {
|
||||||
|
KEEP(*(.text.boot)) /* from boot.S */
|
||||||
|
*(.text .text.* .gnu.linkonce.t*)
|
||||||
|
}
|
||||||
|
|
||||||
|
.rodata : {
|
||||||
|
*(.rodata .rodata.* .gnu.linkonce.r*)
|
||||||
|
}
|
||||||
|
|
||||||
|
.data : {
|
||||||
|
*(.data .data.* .gnu.linkonce.d*)
|
||||||
|
}
|
||||||
|
|
||||||
|
.bss (NOLOAD) : {
|
||||||
|
. = ALIGN(32);
|
||||||
|
__bss_start = .;
|
||||||
|
*(.bss .bss.*)
|
||||||
|
*(COMMON)
|
||||||
|
. = ALIGN(8);
|
||||||
|
__bss_end = .;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* end of the binary */
|
||||||
|
_end = ALIGN(8);
|
||||||
|
|
||||||
|
/* number of bytes in BSS section and complete binary */
|
||||||
|
__bss_length = (__bss_end - __bss_start);
|
||||||
|
__binary_length = (_end - _start);
|
||||||
|
|
||||||
|
/DISCARD/ : { *(.comment) *(.gnu*) *(.note*) *(.eh_frame*) }
|
||||||
|
}
|
@ -0,0 +1,3 @@
|
|||||||
|
target remote :1234
|
||||||
|
break rust_main
|
||||||
|
continue
|
Loading…
Reference in new issue