somehal 0.4.11

Boot kernel code with mmu.
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89

use core::ops::Range;

use crate::println;
use num_align::NumAlign;

use crate::{
    boot_info,
    common::{fdt, mem::ld::stack0},
    mem::{page_size, phys_to_virt, with_regions},
};

#[unsafe(link_section = ".data")]
static mut STACK_START: usize = 0;
#[unsafe(link_section = ".data")]
static mut STACK_END: usize = 0;

pub fn cpu_id_list() -> impl Iterator<Item = usize> {
    let mut start = unsafe { STACK_START };
    let end = unsafe { STACK_END };
    let len = stack0().len().align_up(page_size());
    [boot_info().cpu_id]
        .into_iter()
        .chain(core::iter::from_fn(move || {
            if start >= end {
                return None;
            }
            let id = unsafe { (phys_to_virt(start) as *const usize).read() };
            let ret = Some(id);
            start += len;
            ret
        }))
}

pub fn init_percpu_stack() -> *mut u8 {
    unsafe {
        let rsv_start = boot_info().free_memory_start;
        let mut rsv_end = rsv_start.align_up(page_size());
        STACK_START = rsv_end as _;
        let per_size = stack0().len().align_up(page_size());
        for cpu_id in fdt::cpu_id_list() {
            if cpu_id == boot_info().cpu_id {
                continue;
            }

            let start = rsv_end;
            (start as *mut usize).write(cpu_id);
            let end = start.add(per_size);
            rsv_end = end;

            println!("CPU {cpu_id:#x} stack: [{start:#p}, {end:#p})");
        }

        with_regions(|ls| {
            ls.push(crate::common::mem::MemoryRegion {
                start: rsv_start as _,
                end: rsv_end as _,
                kind: crate::common::mem::MemoryRegionKind::Reserved,
            })
            .unwrap();
        });
        STACK_END = rsv_end as _;
        rsv_end as _
    }
}

pub fn percpu_stack_range() -> Range<usize> {
    unsafe { STACK_START..STACK_END }
}

pub fn cpu_stack(cpu_id: usize) -> Range<usize> {
    unsafe {
        if cpu_id == boot_info().cpu_id {
            return stack0();
        }

        let mut start = STACK_START;

        while start < STACK_END {
            let id = (phys_to_virt(start) as *const usize).read();
            let end = start + stack0().len().align_up(page_size());
            if id == cpu_id {
                return start..end;
            }
            start = end;
        }

        panic!("CPU {cpu_id:#x} stack not found");
    }
}