139 lines
3.7 KiB
Rust
139 lines
3.7 KiB
Rust
use core::mem;
|
|
use x86::dtables::{self, DescriptorTablePointer};
|
|
|
|
use interrupt::*;
|
|
|
|
pub static mut IDTR: DescriptorTablePointer = DescriptorTablePointer {
|
|
limit: 0,
|
|
base: 0
|
|
};
|
|
|
|
pub static mut IDT: [IdtEntry; 256] = [IdtEntry::new(); 256];
|
|
|
|
pub unsafe fn init() {
|
|
IDTR.limit = (IDT.len() * mem::size_of::<IdtEntry>() - 1) as u16;
|
|
IDTR.base = IDT.as_ptr() as u64;
|
|
|
|
// Set up exceptions
|
|
IDT[0].set_func(exception::divide_by_zero);
|
|
IDT[1].set_func(exception::debug);
|
|
IDT[2].set_func(exception::non_maskable);
|
|
IDT[3].set_func(exception::breakpoint);
|
|
IDT[4].set_func(exception::overflow);
|
|
IDT[5].set_func(exception::bound_range);
|
|
IDT[6].set_func(exception::invalid_opcode);
|
|
IDT[7].set_func(exception::device_not_available);
|
|
IDT[8].set_func(exception::double_fault);
|
|
// 9 no longer available
|
|
IDT[10].set_func(exception::invalid_tss);
|
|
IDT[11].set_func(exception::segment_not_present);
|
|
IDT[12].set_func(exception::stack_segment);
|
|
IDT[13].set_func(exception::protection);
|
|
IDT[14].set_func(exception::page);
|
|
// 15 reserved
|
|
IDT[16].set_func(exception::fpu);
|
|
IDT[17].set_func(exception::alignment_check);
|
|
IDT[18].set_func(exception::machine_check);
|
|
IDT[19].set_func(exception::simd);
|
|
IDT[20].set_func(exception::virtualization);
|
|
// 21 through 29 reserved
|
|
IDT[30].set_func(exception::security);
|
|
// 31 reserved
|
|
|
|
// Set up IRQs
|
|
IDT[32].set_func(irq::pit);
|
|
IDT[33].set_func(irq::keyboard);
|
|
IDT[34].set_func(irq::cascade);
|
|
IDT[35].set_func(irq::com2);
|
|
IDT[36].set_func(irq::com1);
|
|
IDT[37].set_func(irq::lpt2);
|
|
IDT[38].set_func(irq::floppy);
|
|
IDT[39].set_func(irq::lpt1);
|
|
IDT[40].set_func(irq::rtc);
|
|
IDT[41].set_func(irq::pci1);
|
|
IDT[42].set_func(irq::pci2);
|
|
IDT[43].set_func(irq::pci3);
|
|
IDT[44].set_func(irq::mouse);
|
|
IDT[45].set_func(irq::fpu);
|
|
IDT[46].set_func(irq::ata1);
|
|
IDT[47].set_func(irq::ata2);
|
|
|
|
// Set syscall function
|
|
IDT[0x80].set_func(syscall::syscall);
|
|
|
|
dtables::lidt(&IDTR);
|
|
}
|
|
|
|
bitflags! {
|
|
pub flags IdtFlags: u8 {
|
|
const IDT_PRESENT = 1 << 7,
|
|
const IDT_RING_0 = 0 << 5,
|
|
const IDT_RING_1 = 1 << 5,
|
|
const IDT_RING_2 = 2 << 5,
|
|
const IDT_RING_3 = 3 << 5,
|
|
const IDT_SS = 1 << 4,
|
|
const IDT_INTERRUPT = 0xE,
|
|
const IDT_TRAP = 0xF,
|
|
}
|
|
}
|
|
|
|
#[repr(packed)]
|
|
pub struct IdtDescriptor {
|
|
size: u16,
|
|
offset: u64
|
|
}
|
|
|
|
impl IdtDescriptor {
|
|
pub fn set_slice(&mut self, slice: &'static [IdtEntry]) {
|
|
self.size = (slice.len() * mem::size_of::<IdtEntry>() - 1) as u16;
|
|
self.offset = slice.as_ptr() as u64;
|
|
}
|
|
|
|
pub unsafe fn load(&self) {
|
|
asm!("lidt [rax]" : : "{rax}"(self as *const _ as usize) : : "intel", "volatile");
|
|
}
|
|
}
|
|
|
|
#[derive(Copy, Clone, Debug)]
|
|
#[repr(packed)]
|
|
pub struct IdtEntry {
|
|
offsetl: u16,
|
|
selector: u16,
|
|
zero: u8,
|
|
attribute: u8,
|
|
offsetm: u16,
|
|
offseth: u32,
|
|
zero2: u32
|
|
}
|
|
|
|
impl IdtEntry {
|
|
pub const fn new() -> IdtEntry {
|
|
IdtEntry {
|
|
offsetl: 0,
|
|
selector: 0,
|
|
zero: 0,
|
|
attribute: 0,
|
|
offsetm: 0,
|
|
offseth: 0,
|
|
zero2: 0
|
|
}
|
|
}
|
|
|
|
pub fn set_flags(&mut self, flags: IdtFlags) {
|
|
self.attribute = flags.bits;
|
|
}
|
|
|
|
pub fn set_offset(&mut self, selector: u16, base: usize) {
|
|
self.selector = selector;
|
|
self.offsetl = base as u16;
|
|
self.offsetm = (base >> 16) as u16;
|
|
self.offseth = (base >> 32) as u32;
|
|
}
|
|
|
|
// A function to set the offset more easily
|
|
pub fn set_func(&mut self, func: unsafe extern fn()) {
|
|
self.set_flags(IDT_PRESENT | IDT_RING_0 | IDT_INTERRUPT);
|
|
self.set_offset(8, func as usize);
|
|
}
|
|
}
|