eonix/crates/eonix_hal/src/arch/x86_64/interrupt.rs

use crate::arch::cpu::rdmsr;
use core::{arch::asm, marker::PhantomPinned, pin::Pin, ptr::NonNull};

#[repr(C)]
#[derive(Clone, Copy)]
struct IDTEntry {
    offset_low: u16,
    selector: u16,

    interrupt_stack: u8,
    attributes: u8,

    offset_mid: u16,
    offset_high: u32,
    reserved: u32,
}

pub struct APICReg(*mut u32);
pub struct APICRegs {
    base: NonNull<u32>,
}

/// Architecture-specific interrupt control block.
pub struct InterruptControl {
    idt: [IDTEntry; 256],
    apic_base: APICRegs,
    _pinned: PhantomPinned,
}

impl IDTEntry {
    const fn new(offset: usize, selector: u16, attributes: u8) -> Self {
        Self {
            offset_low: offset as u16,
            selector,
            interrupt_stack: 0,
            attributes,
            offset_mid: (offset >> 16) as u16,
            offset_high: (offset >> 32) as u32,
            reserved: 0,
        }
    }

    const fn null() -> Self {
        Self {
            offset_low: 0,
            selector: 0,
            interrupt_stack: 0,
            attributes: 0,
            offset_mid: 0,
            offset_high: 0,
            reserved: 0,
        }
    }
}

impl APICReg {
    fn new(pointer: *mut u32) -> Self {
        Self(pointer)
    }

    pub fn read(&self) -> u32 {
        unsafe { self.0.read_volatile() }
    }

    pub fn write(&self, value: u32) {
        unsafe { self.0.write_volatile(value) }
    }
}

impl APICRegs {
    pub fn local_apic_id(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x20).as_ptr()) }
    }

    pub fn task_priority(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x80).as_ptr()) }
    }

    pub fn end_of_interrupt(&self) {
        unsafe { APICReg::new(self.base.byte_offset(0xb0).as_ptr()).write(0) }
    }

    pub fn spurious(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0xf0).as_ptr()) }
    }

    pub fn interrupt_command(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x300).as_ptr()) }
    }

    pub fn timer_register(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x320).as_ptr()) }
    }

    pub fn timer_initial_count(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x380).as_ptr()) }
    }

    pub fn timer_current_count(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x390).as_ptr()) }
    }

    pub fn timer_divide(&self) -> APICReg {
        unsafe { APICReg::new(self.base.byte_offset(0x3e0).as_ptr()) }
    }
}

impl InterruptControl {
    /// # Return
    /// Returns a tuple of InterruptControl and the cpu id of the current cpu.
    pub fn new() -> (Self, usize) {
        let trap_stubs_base = super::trap::trap_stubs_start as usize;

        let idt = core::array::from_fn(|idx| match idx {
            0..0x80 => IDTEntry::new(trap_stubs_base + 8 * idx, 0x08, 0x8e),
            0x80 => IDTEntry::new(trap_stubs_base + 8 * idx, 0x08, 0xee),
            _ => IDTEntry::null(),
        });

        let apic_base = {
            let apic_base = rdmsr(0x1b);
            assert_eq!(apic_base & 0x800, 0x800, "LAPIC not enabled");

            let apic_base = ((apic_base & !0xfff) + 0xffffff00_00000000) as *mut u32;
            APICRegs {
                // TODO: A better way to convert to physical address
                base: NonNull::new(apic_base).expect("Invalid APIC base"),
            }
        };

        // Make sure APIC is enabled.
        apic_base.spurious().write(0x1ff);

        let cpuid = apic_base.local_apic_id().read() >> 24;

        (
            Self {
                idt,
                apic_base,
                _pinned: PhantomPinned,
            },
            cpuid as usize,
        )
    }

    pub fn setup_timer(&self) {
        self.apic_base.task_priority().write(0);
        self.apic_base.timer_divide().write(0x3); // Divide by 16
        self.apic_base.timer_register().write(0x0040);

        // Setup the PIT to generate interrupts at 100Hz.
        unsafe {
            asm!(
                "in $0x61, %al",
                "and $0xfd, %al",
                "or $0x1, %al",
                "out %al, %dx",
                "mov $0xb2, %al",
                "out %al, $0x43",
                "mov $0x9b, %al",
                "out %al, $0x42",
                "in $0x60, %al",
                "mov $0x2e, %al",
                "out %al, $0x42",
                "in $0x61, %al",
                "and $0xfe, %al",
                "out %al, $0x61",
                "or $0x1, %al",
                "out %al, $0x61",
                out("eax") _,
                out("edx") _,
                options(att_syntax, nomem, nostack, preserves_flags),
            );
        }

        self.apic_base.timer_initial_count().write(u32::MAX);

        unsafe {
            asm!(
                "2:",
                "in $0x61, %al",
                "and $0x20, %al",
                "jz 2b",
                out("ax") _,
                options(att_syntax, nomem, nostack, preserves_flags),
            )
        }

        self.apic_base.timer_register().write(0x10000);

        let counts = self.apic_base.timer_current_count().read();
        let freq = (u32::MAX - counts) as u64 * 16 * 100;

        self.apic_base
            .timer_initial_count()
            .write((freq / 16 / 1_000) as u32);

        self.apic_base.timer_register().write(0x20040);
        self.apic_base.timer_divide().write(0x3); // Divide by 16
    }

    pub fn setup_idt(self: Pin<&mut Self>) {
        lidt(
            self.idt.as_ptr() as usize,
            (size_of::<IDTEntry>() * 256 - 1) as u16,
        );
    }

    pub fn send_sipi(&self) {
        let icr = self.apic_base.interrupt_command();

        icr.write(0xc4500);
        while icr.read() & 0x1000 != 0 {
            core::hint::spin_loop();
        }

        icr.write(0xc4606);
        while icr.read() & 0x1000 != 0 {
            core::hint::spin_loop();
        }
    }

    /// Send EOI to APIC so that it can send more interrupts.
    pub fn end_of_interrupt(&self) {
        self.apic_base.end_of_interrupt()
    }
}

fn lidt(base: usize, limit: u16) {
    let mut idt_descriptor = [0u16; 5];

    idt_descriptor[0] = limit;
    idt_descriptor[1] = base as u16;
    idt_descriptor[2] = (base >> 16) as u16;
    idt_descriptor[3] = (base >> 32) as u16;
    idt_descriptor[4] = (base >> 48) as u16;

    unsafe {
        asm!("lidt ({})", in(reg) &idt_descriptor, options(att_syntax, nostack, preserves_flags));
    }
}