1#![no_std]
8
9use core::arch::naked_asm;
10use core::slice;
11
12use sel4_panicking_env::abort;
13use sel4_phdrs::{PT_SEL4_RESET_REGIONS, locate_phdrs};
14use sel4_stack::{Stack, StackBottom};
15
16use sel4_phdrs_patched as _;
17
18#[repr(C)]
19#[derive(Debug)]
20struct RegionMeta {
21 dst_vaddr: usize,
22 dst_size: usize,
23 src_vaddr: usize,
24 src_size: usize,
25}
26
27unsafe fn reset_memory(regions: &'static [RegionMeta]) {
28 for meta in regions {
29 let dst = unsafe { slice::from_raw_parts_mut(meta.dst_vaddr as *mut u8, meta.dst_size) };
30 let (dst_data, dst_zero) = dst.split_at_mut(meta.src_size);
31 if meta.src_vaddr != 0 {
32 let src =
33 unsafe { slice::from_raw_parts_mut(meta.src_vaddr as *mut u8, meta.src_size) };
34 dst_data.copy_from_slice(src);
35 }
36 dst_zero.fill(0);
37 }
38}
39
40unsafe fn get_regions() -> &'static [RegionMeta] {
41 unsafe {
42 let phdr = locate_phdrs()
43 .unwrap_or_else(|err| abort!("{err}"))
44 .find_by_type(PT_SEL4_RESET_REGIONS)
45 .unwrap_or_else(|| abort!("missing PT_SEL4_RESET_REGIONS program header"));
46 slice::from_raw_parts(
47 phdr.p_vaddr as *const _,
48 phdr.p_memsz / size_of::<RegionMeta>(),
49 )
50 }
51}
52
53unsafe extern "C" {
56 fn _start(x0: usize, x1: usize, x2: usize, x3: usize) -> !;
57}
58
59pub fn reset() -> ! {
60 unsafe {
61 _reset(0, 0, 0, 0);
62 }
63}
64
65pub fn reset1(x0: usize) -> ! {
66 unsafe {
67 _reset(x0, 0, 0, 0);
68 }
69}
70
71pub fn reset2(x0: usize, x1: usize) -> ! {
72 unsafe {
73 _reset(x0, x1, 0, 0);
74 }
75}
76
77pub fn reset3(x0: usize, x1: usize, x2: usize) -> ! {
78 unsafe {
79 _reset(x0, x1, x2, 0);
80 }
81}
82
83pub fn reset4(x0: usize, x1: usize, x2: usize, x3: usize) -> ! {
84 unsafe {
85 _reset(x0, x1, x2, x3);
86 }
87}
88
89unsafe extern "C" fn reset_rust_entrypoint(x0: usize, x1: usize, x2: usize, x3: usize) -> ! {
90 unsafe {
91 reset_memory(get_regions());
92 _start(x0, x1, x2, x3)
93 }
94}
95
96const STACK_SIZE: usize = 4096;
97
98#[unsafe(link_section = ".persistent")]
99static STACK: Stack<STACK_SIZE> = Stack::new();
100
101static STACK_BOTTOM: StackBottom = STACK.bottom();
102
103#[unsafe(naked)]
104unsafe extern "C" fn _reset(x0: usize, x1: usize, x2: usize, x3: usize) -> ! {
105 naked_asm! {
106 cfg_select! {
107 target_arch = "aarch64" => r#"
108 ldr x9, ={stack_bottom}
109 ldr x9, [x9]
110 mov sp, x9
111 b {rust_entrypoint}
112 "#,
113 target_arch = "arm" => r#"
114 ldr r12, ={stack_bottom}
115 ldr r12, [r12]
116 mov sp, r12
117 b {rust_entrypoint}
118 "#,
119 target_arch = "riscv64" => r#"
120 la sp, {stack_bottom}
121 ld sp, (sp)
122 j {rust_entrypoint}
123 "#,
124 target_arch = "riscv32" => r#"
125 la sp, {stack_bottom}
126 lw sp, (sp)
127 j {rust_entrypoint}
128 "#,
129 target_arch = "x86_64" => r#"
130 mov rsp, {stack_bottom}
131 mov rbp, rsp
132 sub rsp, 0x8 // Stack must be 16-byte aligned before call
133 push rbp
134 jmp {rust_entrypoint}
135 "#,
136 },
137 stack_bottom = sym STACK_BOTTOM,
138 rust_entrypoint = sym reset_rust_entrypoint,
139 }
140}