77 lines
2.4 KiB
Rust
77 lines
2.4 KiB
Rust
use bootloader::bootinfo::{MemoryMap, MemoryRegionType};
|
|
use x86_64::{
|
|
structures::paging::{
|
|
FrameAllocator, Mapper, OffsetPageTable, Page, PageTable, PhysFrame, Size4KiB,
|
|
},
|
|
PhysAddr, VirtAddr,
|
|
};
|
|
|
|
pub unsafe fn init(physical_memory_offset: VirtAddr) -> OffsetPageTable<'static> {
|
|
let level_4_table = active_level_4_table(physical_memory_offset);
|
|
OffsetPageTable::new(level_4_table, physical_memory_offset)
|
|
}
|
|
|
|
unsafe fn active_level_4_table(physical_memory_offset: VirtAddr) -> &'static mut PageTable {
|
|
use x86_64::registers::control::Cr3;
|
|
|
|
let (level_4_table_frame, _) = Cr3::read();
|
|
|
|
let phys = level_4_table_frame.start_address();
|
|
let virt = physical_memory_offset + phys.as_u64();
|
|
let page_table_ptr: *mut PageTable = virt.as_mut_ptr();
|
|
|
|
&mut *page_table_ptr
|
|
}
|
|
|
|
pub fn create_example_mapping(
|
|
page: Page,
|
|
mapper: &mut OffsetPageTable,
|
|
frame_allocator: &mut impl FrameAllocator<Size4KiB>,
|
|
) {
|
|
use x86_64::structures::paging::PageTableFlags as Flags;
|
|
|
|
let frame = PhysFrame::containing_address(PhysAddr::new(0xb8000));
|
|
let flags = Flags::PRESENT | Flags::WRITABLE;
|
|
|
|
let map_to_result = unsafe { mapper.map_to(page, frame, flags, frame_allocator) };
|
|
map_to_result.expect("map_to failed").flush();
|
|
}
|
|
|
|
pub struct EmptyFrameAllocator;
|
|
|
|
unsafe impl FrameAllocator<Size4KiB> for EmptyFrameAllocator {
|
|
fn allocate_frame(&mut self) -> Option<PhysFrame> {
|
|
None
|
|
}
|
|
}
|
|
|
|
pub struct BootInfoFrameAllocator {
|
|
memory_map: &'static MemoryMap,
|
|
next: usize,
|
|
}
|
|
|
|
impl BootInfoFrameAllocator {
|
|
pub unsafe fn init(memory_map: &'static MemoryMap) -> Self {
|
|
BootInfoFrameAllocator {
|
|
memory_map,
|
|
next: 0,
|
|
}
|
|
}
|
|
|
|
fn usable_frames(&self) -> impl Iterator<Item = PhysFrame> {
|
|
let regions = self.memory_map.iter();
|
|
let usable_regions = regions.filter(|r| r.region_type == MemoryRegionType::Usable);
|
|
let addr_ranges = usable_regions.map(|r| r.range.start_addr()..r.range.end_addr());
|
|
let frame_addresses = addr_ranges.flat_map(|r| r.step_by(4096));
|
|
frame_addresses.map(|addr| PhysFrame::containing_address(PhysAddr::new(addr)))
|
|
}
|
|
}
|
|
|
|
unsafe impl FrameAllocator<Size4KiB> for BootInfoFrameAllocator {
|
|
fn allocate_frame(&mut self) -> Option<PhysFrame> {
|
|
let frame = self.usable_frames().nth(self.next);
|
|
self.next += 1;
|
|
frame
|
|
}
|
|
}
|