tg_kernel_vm/space/
mod.rs1mod mapper;
2mod visitor;
3
4extern crate alloc;
5
6use crate::PageManager;
7use alloc::vec::Vec;
8use core::{fmt, ops::Range, ptr::NonNull};
9use mapper::Mapper;
10use page_table::{PageTable, PageTableFormatter, Pos, VAddr, VmFlags, VmMeta, PPN, VPN};
11use visitor::Visitor;
12
13pub struct AddressSpace<Meta: VmMeta, M: PageManager<Meta>> {
15 pub areas: Vec<Range<VPN<Meta>>>,
17 page_manager: M,
18}
19
20impl<Meta: VmMeta, M: PageManager<Meta>> AddressSpace<Meta, M> {
21 #[inline]
23 pub fn new() -> Self {
24 Self {
25 areas: Vec::new(),
26 page_manager: M::new_root(),
27 }
28 }
29
30 #[inline]
32 pub fn root_ppn(&self) -> PPN<Meta> {
33 self.page_manager.root_ppn()
34 }
35
36 #[inline]
38 pub fn root(&self) -> PageTable<Meta> {
39 unsafe { PageTable::from_root(self.page_manager.root_ptr()) }
42 }
43
44 pub fn map_extern(&mut self, range: Range<VPN<Meta>>, pbase: PPN<Meta>, flags: VmFlags<Meta>) {
46 self.areas.push(range.start..range.end);
47 let count = range.end.val() - range.start.val();
48 let mut root = self.root();
49 let mut mapper = Mapper::new(self, pbase..pbase + count, flags);
50 root.walk_mut(Pos::new(range.start, 0), &mut mapper);
51 if !mapper.ans() {
52 todo!()
54 }
55 }
56
57 pub fn map(
59 &mut self,
60 range: Range<VPN<Meta>>,
61 data: &[u8],
62 offset: usize,
63 mut flags: VmFlags<Meta>,
64 ) {
65 let count = range.end.val() - range.start.val();
66 let size = count << Meta::PAGE_BITS;
67 assert!(size >= data.len() + offset);
68 let page = self.page_manager.allocate(count, &mut flags);
69 unsafe {
73 use core::slice::from_raw_parts_mut as slice;
74 let mut ptr = page.as_ptr();
75 slice(ptr, offset).fill(0);
76 ptr = ptr.add(offset);
77 slice(ptr, data.len()).copy_from_slice(data);
78 ptr = ptr.add(data.len());
79 slice(ptr, page.as_ptr().add(size).offset_from(ptr) as _).fill(0);
80 }
81 self.map_extern(range, self.page_manager.v_to_p(page), flags)
82 }
83
84 pub fn unmap(&mut self, range: Range<VPN<Meta>>) {
86 let mut new_areas = Vec::new();
88 for area in self.areas.drain(..) {
89 if area.end <= range.start || area.start >= range.end {
90 new_areas.push(area);
92 } else {
93 if area.start < range.start {
95 new_areas.push(area.start..range.start);
96 }
97 if area.end > range.end {
98 new_areas.push(range.end..area.end);
99 }
100 }
101 }
102 self.areas = new_areas;
103
104 let mut vpn = range.start;
106 while vpn < range.end {
107 if let Some(pte_ptr) = self.find_pte_mut(vpn) {
109 unsafe {
110 core::ptr::write_bytes(
111 pte_ptr as *mut u8,
112 0,
113 core::mem::size_of::<page_table::Pte<Meta>>(),
114 )
115 };
116 }
117 vpn = vpn + 1;
118 }
119
120 #[cfg(target_arch = "riscv64")]
122 unsafe {
123 core::arch::asm!("sfence.vma")
124 };
125 }
126
127 fn find_pte_mut(&self, vpn: VPN<Meta>) -> Option<*mut page_table::Pte<Meta>> {
129 let mut current = self.page_manager.root_ptr();
130
131 for level in (0..=Meta::MAX_LEVEL).rev() {
132 let idx = vpn.index_in(level);
133 let pte_ptr = unsafe { current.as_ptr().add(idx) };
134 let pte = unsafe { *pte_ptr };
135
136 if level == 0 {
137 return Some(pte_ptr);
138 }
139
140 if !pte.is_valid() {
141 return None;
142 }
143
144 let flags_raw = pte.flags().val();
147 let is_leaf = (flags_raw & 0b1010) != 0; if is_leaf {
149 return Some(pte_ptr);
150 }
151
152 current = self.page_manager.p_to_v(pte.ppn());
153 }
154 None
155 }
156
157 pub fn translate<T>(&self, addr: VAddr<Meta>, flags: VmFlags<Meta>) -> Option<NonNull<T>> {
159 let mut visitor = Visitor::new(self);
160 self.root().walk(Pos::new(addr.floor(), 0), &mut visitor);
161 visitor
162 .ans()
163 .filter(|pte| pte.flags().contains(flags))
164 .map(|pte| {
165 unsafe {
170 NonNull::new_unchecked(
171 self.page_manager
172 .p_to_v::<u8>(pte.ppn())
173 .as_ptr()
174 .add(addr.offset())
175 .cast(),
176 )
177 }
178 })
179 }
180
181 pub fn cloneself(&self, new_addrspace: &mut AddressSpace<Meta, M>) {
183 let root = self.root();
184 let areas = &self.areas;
185 for (_, range) in areas.iter().enumerate() {
186 let mut visitor = Visitor::new(self);
187 let vpn = range.start;
189 root.walk(Pos::new(vpn, 0), &mut visitor);
191 let (mut flags, mut data_ptr) = visitor
193 .ans()
194 .filter(|pte| pte.is_valid())
195 .map(|pte| {
196 (pte.flags(), unsafe {
198 NonNull::new_unchecked(self.page_manager.p_to_v::<u8>(pte.ppn()).as_ptr())
199 })
200 })
201 .unwrap();
202 let vpn_range = range.start..range.end;
203 let count = range.end.val() - range.start.val();
205 let size = count << Meta::PAGE_BITS;
206 let paddr = new_addrspace.page_manager.allocate(count, &mut flags);
208 let ppn = new_addrspace.page_manager.v_to_p(paddr);
209 unsafe {
212 use core::slice::from_raw_parts_mut as slice;
213 let data = slice(data_ptr.as_mut(), size);
214 let ptr = paddr.as_ptr();
215 slice(ptr, size).copy_from_slice(data);
216 }
217 new_addrspace.map_extern(vpn_range, ppn, flags);
218 }
219 }
220}
221
222impl<Meta: VmMeta, P: PageManager<Meta>> fmt::Debug for AddressSpace<Meta, P> {
223 fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
224 writeln!(f, "root: {:#x}", self.root_ppn().val())?;
225 write!(
226 f,
227 "{:?}",
228 PageTableFormatter {
229 pt: self.root(),
230 f: |ppn| self.page_manager.p_to_v(ppn)
231 }
232 )
233 }
234}