use bit_field::BitField;
use super::{ApicControl, ApicId, Icr};
use crate::msr::{
rdmsr, wrmsr, IA32_APIC_BASE, IA32_TSC_DEADLINE, IA32_X2APIC_APICID, IA32_X2APIC_ESR,
IA32_X2APIC_LVT_LINT0, IA32_X2APIC_LVT_TIMER, IA32_X2APIC_SELF_IPI, IA32_X2APIC_VERSION,
};
#[derive(Debug)]
pub struct X2APIC {
base: u64,
}
impl X2APIC {
pub fn new() -> X2APIC {
unsafe {
X2APIC {
base: rdmsr(IA32_APIC_BASE),
}
}
}
pub fn attach(&mut self) {
unsafe {
self.base = rdmsr(IA32_APIC_BASE);
self.base.set_bit(10, true); self.base.set_bit(11, true); wrmsr(IA32_APIC_BASE, self.base);
let lint0 = 1 << 16 | (1 << 15) | (0b111 << 8) | 0x20;
wrmsr(IA32_X2APIC_LVT_LINT0, lint0);
let _esr = rdmsr(IA32_X2APIC_ESR);
}
}
pub fn detach(&mut self) {
unsafe {
self.base = rdmsr(IA32_APIC_BASE);
self.base.set_bit(10, false); self.base.set_bit(11, false); wrmsr(IA32_APIC_BASE, self.base);
}
}
pub unsafe fn send_self_ipi(&self, vector: u64) {
wrmsr(IA32_X2APIC_SELF_IPI, vector);
}
}
impl ApicControl for X2APIC {
fn bsp(&self) -> bool {
(self.base & (1 << 8)) > 0
}
fn id(&self) -> u32 {
unsafe { rdmsr(IA32_X2APIC_APICID) as u32 }
}
fn version(&self) -> u32 {
unsafe { rdmsr(IA32_X2APIC_VERSION) as u32 }
}
fn tsc_enable(&mut self) {
unsafe {
let mut lvt: u64 = rdmsr(IA32_X2APIC_LVT_TIMER);
lvt |= 0 << 17;
lvt |= 1 << 18;
wrmsr(IA32_X2APIC_LVT_TIMER, lvt);
}
}
fn tsc_set(&self, value: u64) {
unsafe {
wrmsr(IA32_TSC_DEADLINE, value);
}
}
fn eoi(&mut self) {
unreachable!("NYI");
}
unsafe fn ipi_init(&mut self, _core: ApicId) {
unreachable!("NYI");
}
unsafe fn ipi_init_deassert(&mut self) {
unreachable!("NYI");
}
unsafe fn ipi_startup(&mut self, _core: ApicId, _start_page: u8) {
unreachable!("NYI");
}
unsafe fn send_ipi(&mut self, _icr: Icr) {
unreachable!("NYI");
}
}