Skip to main content

sel4_reset/
lib.rs

1//
2// Copyright 2024, Colias Group, LLC
3//
4// SPDX-License-Identifier: BSD-2-Clause
5//
6
7#![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
53// // //
54
55unsafe 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}