use core::ptr::addr_of;
use alloc::boxed::Box;
use spin::Lazy;
use x86_64::VirtAddr;
use x86_64::instructions::segmentation::{CS, SS, Segment};
use x86_64::instructions::tables::load_tss;
use x86_64::structures::gdt::GlobalDescriptorTable;
use x86_64::structures::gdt::{Descriptor, SegmentSelector};
use x86_64::structures::tss::TaskStateSegment;
pub const DOUBLE_FAULT_IST_INDEX: usize = 0;
pub const PAGE_FAULT_IST_INDEX: usize = 1;
pub const YIELD_IST_INDEX: usize = 2;
pub const FAULT_STACK_SIZE: usize = 4 * 1024;
pub const YIELD_STACK_SIZE: usize = 4 * 1024;
pub struct CpuInfo {
gdt: GlobalDescriptorTable,
tss: TaskStateSegment,
selectors: Option<Selectors>,
fault_stack: &'static mut [u8],
yield_stack: &'static mut [u8],
}
impl Default for CpuInfo {
fn default() -> Self {
Self {
gdt: GlobalDescriptorTable::new(),
tss: TaskStateSegment::new(),
selectors: None,
fault_stack: Box::leak(Box::new([0; FAULT_STACK_SIZE])),
yield_stack: Box::leak(Box::new([0; YIELD_STACK_SIZE])),
}
}
}
impl CpuInfo {
#[inline]
pub fn set_ring0_rsp(&mut self, rsp: VirtAddr) {
self.tss.privilege_stack_table[0] = rsp;
}
}
impl CpuInfo {
pub fn init(&mut self) {
let (mut gdt, mut selectors) = COMMON_GDT.clone();
self.tss.interrupt_stack_table[DOUBLE_FAULT_IST_INDEX] = {
let stack_start = self.fault_stack.as_ptr() as u64;
VirtAddr::new(stack_start + self.fault_stack.len() as u64)
};
self.tss.interrupt_stack_table[PAGE_FAULT_IST_INDEX] = {
let stack_start = self.fault_stack.as_ptr() as u64;
VirtAddr::new(stack_start + self.fault_stack.len() as u64)
};
self.tss.interrupt_stack_table[YIELD_IST_INDEX] = {
let stack_start = self.yield_stack.as_ptr() as u64;
VirtAddr::new(stack_start + self.yield_stack.len() as u64)
};
let tss_ref = unsafe { &*addr_of!(self.tss) };
let tss_selector = Some(gdt.append(Descriptor::tss_segment(tss_ref)));
selectors.tss_selector = tss_selector;
self.gdt = gdt;
self.selectors = Some(selectors);
let gdt_ptr: *const _ = &self.gdt;
unsafe { (*gdt_ptr).load() }
let selectors = &self.selectors.as_ref().unwrap();
unsafe {
CS::set_reg(selectors.code_selector);
SS::set_reg(selectors.data_selector);
load_tss(selectors.tss_selector.unwrap());
}
}
pub fn kernel_code_selector(&self) -> usize {
self.selectors.as_ref().unwrap().code_selector.0 as usize
}
pub fn kernel_data_selector(&self) -> usize {
self.selectors.as_ref().unwrap().data_selector.0 as usize
}
pub fn user_code_selector(&self) -> usize {
self.selectors.as_ref().unwrap().user_code_selector.0 as usize
}
pub fn user_data_selector(&self) -> usize {
self.selectors.as_ref().unwrap().user_data_selector.0 as usize
}
}
static COMMON_GDT: Lazy<(GlobalDescriptorTable, Selectors)> = Lazy::new(|| {
let mut gdt = GlobalDescriptorTable::new();
let code_selector = gdt.append(Descriptor::kernel_code_segment());
let data_selector = gdt.append(Descriptor::kernel_data_segment());
let user_data_selector = gdt.append(Descriptor::user_data_segment());
let user_code_selector = gdt.append(Descriptor::user_code_segment());
let selectors = Selectors {
code_selector,
data_selector,
user_data_selector,
user_code_selector,
tss_selector: None,
};
(gdt, selectors)
});
#[derive(Clone)]
pub struct Selectors {
code_selector: SegmentSelector,
data_selector: SegmentSelector,
user_code_selector: SegmentSelector,
user_data_selector: SegmentSelector,
tss_selector: Option<SegmentSelector>,
}