DragonOS/kernel/src/arch/x86_64/interrupt/ipi.rs

use alloc::sync::Arc;
use log::error;
use system_error::SystemError;
use x86::apic::ApicId;

use crate::{
    arch::{
        driver::apic::{lapic_vector::local_apic_chip, CurrentApic, LocalAPIC},
        smp::SMP_BOOT_DATA,
    },
    exception::{
        ipi::{FlushTLBIpiHandler, IpiKind, IpiTarget, KickCpuIpiHandler},
        irqdata::{IrqData, IrqLineStatus},
        irqdesc::{irq_desc_manager, IrqDesc, IrqFlowHandler, IrqHandler},
        HardwareIrqNumber, IrqNumber,
    },
    smp::cpu::ProcessorId,
};

use super::TrapFrame;

pub const IPI_NUM_KICK_CPU: IrqNumber = IrqNumber::new(200);
pub const IPI_NUM_FLUSH_TLB: IrqNumber = IrqNumber::new(201);
/// IPI的种类(架构相关，指定了向量号)
#[derive(Debug, Copy, Clone, Eq, PartialEq)]
#[repr(u32)]
pub enum ArchIpiKind {
    KickCpu = IPI_NUM_KICK_CPU.data(),
    FlushTLB = IPI_NUM_FLUSH_TLB.data(),
    SpecVector(HardwareIrqNumber),
}

impl From<IpiKind> for ArchIpiKind {
    fn from(kind: IpiKind) -> Self {
        match kind {
            IpiKind::KickCpu => ArchIpiKind::KickCpu,
            IpiKind::FlushTLB => ArchIpiKind::FlushTLB,
            IpiKind::SpecVector(vec) => ArchIpiKind::SpecVector(vec),
        }
    }
}

impl From<ArchIpiKind> for u8 {
    fn from(value: ArchIpiKind) -> Self {
        match value {
            ArchIpiKind::KickCpu => IPI_NUM_KICK_CPU.data() as u8,
            ArchIpiKind::FlushTLB => IPI_NUM_FLUSH_TLB.data() as u8,
            ArchIpiKind::SpecVector(vec) => (vec.data() & 0xFF) as u8,
        }
    }
}

/// IPI投递目标
#[derive(Debug, Copy, Clone, Eq, PartialEq)]
pub enum ArchIpiTarget {
    /// 当前CPU
    Current,
    /// 所有CPU
    All,
    /// 除了当前CPU以外的所有CPU
    Other,
    /// 指定的CPU
    Specified(x86::apic::ApicId),
}

impl From<IpiTarget> for ArchIpiTarget {
    fn from(target: IpiTarget) -> Self {
        match target {
            IpiTarget::Current => ArchIpiTarget::Current,
            IpiTarget::All => ArchIpiTarget::All,
            IpiTarget::Other => ArchIpiTarget::Other,
            IpiTarget::Specified(cpu_id) => {
                ArchIpiTarget::Specified(Self::cpu_id_to_apic_id(cpu_id))
            }
        }
    }
}

impl From<ArchIpiTarget> for ApicId {
    fn from(val: ArchIpiTarget) -> Self {
        if let ArchIpiTarget::Specified(id) = val {
            return id;
        } else if CurrentApic.x2apic_enabled() {
            return x86::apic::ApicId::X2Apic(0);
        } else {
            return x86::apic::ApicId::XApic(0);
        }
    }
}

impl ArchIpiTarget {
    #[allow(dead_code)]
    pub fn shorthand(&self) -> u8 {
        match self {
            ArchIpiTarget::Specified(_) => 0,
            ArchIpiTarget::Current => 1,
            ArchIpiTarget::All => 2,
            ArchIpiTarget::Other => 3,
        }
    }

    #[inline(always)]
    fn cpu_id_to_apic_id(cpu_id: ProcessorId) -> x86::apic::ApicId {
        if CurrentApic.x2apic_enabled() {
            x86::apic::ApicId::X2Apic(cpu_id.data())
        } else {
            x86::apic::ApicId::XApic(cpu_id.data() as u8)
        }
    }
}

impl From<ArchIpiTarget> for x86::apic::DestinationShorthand {
    fn from(val: ArchIpiTarget) -> Self {
        match val {
            ArchIpiTarget::Specified(_) => x86::apic::DestinationShorthand::NoShorthand,
            ArchIpiTarget::Current => x86::apic::DestinationShorthand::Myself,
            ArchIpiTarget::All => x86::apic::DestinationShorthand::AllIncludingSelf,
            ArchIpiTarget::Other => x86::apic::DestinationShorthand::AllExcludingSelf,
        }
    }
}

#[inline(always)]
pub fn send_ipi(kind: IpiKind, target: IpiTarget) {
    // debug!("send_ipi: {:?} {:?}", kind, target);

    let ipi_vec = ArchIpiKind::from(kind).into();
    let target = ArchIpiTarget::from(target);
    let shorthand: x86::apic::DestinationShorthand = target.into();
    let destination: x86::apic::ApicId = target.into();
    let icr = if CurrentApic.x2apic_enabled() {
        // debug!("send_ipi: x2apic");
        x86::apic::Icr::for_x2apic(
            ipi_vec,
            destination,
            shorthand,
            x86::apic::DeliveryMode::Fixed,
            x86::apic::DestinationMode::Physical,
            x86::apic::DeliveryStatus::Idle,
            x86::apic::Level::Assert,
            x86::apic::TriggerMode::Edge,
        )
    } else {
        // debug!("send_ipi: xapic");
        x86::apic::Icr::for_xapic(
            ipi_vec,
            destination,
            shorthand,
            x86::apic::DeliveryMode::Fixed,
            x86::apic::DestinationMode::Physical,
            x86::apic::DeliveryStatus::Idle,
            x86::apic::Level::Assert,
            x86::apic::TriggerMode::Edge,
        )
    };

    CurrentApic.write_icr(icr);
}

/// 发送smp初始化IPI
pub fn ipi_send_smp_init() {
    let target = ArchIpiTarget::Other;
    let icr = if CurrentApic.x2apic_enabled() {
        x86::apic::Icr::for_x2apic(
            0,
            target.into(),
            x86::apic::DestinationShorthand::AllExcludingSelf,
            x86::apic::DeliveryMode::Init,
            x86::apic::DestinationMode::Physical,
            x86::apic::DeliveryStatus::Idle,
            x86::apic::Level::Deassert,
            x86::apic::TriggerMode::Edge,
        )
    } else {
        x86::apic::Icr::for_xapic(
            0,
            target.into(),
            x86::apic::DestinationShorthand::AllExcludingSelf,
            x86::apic::DeliveryMode::Init,
            x86::apic::DestinationMode::Physical,
            x86::apic::DeliveryStatus::Idle,
            x86::apic::Level::Deassert,
            x86::apic::TriggerMode::Edge,
        )
    };
    CurrentApic.write_icr(icr);
}

/// 发送smp启动IPI
///
/// ## 参数
///
/// * `target_cpu` - 目标CPU
pub fn ipi_send_smp_startup(target_cpu: ProcessorId) -> Result<(), SystemError> {
    if target_cpu.data() as usize >= SMP_BOOT_DATA.cpu_count() {
        return Err(SystemError::EINVAL);
    }
    let target: ArchIpiTarget = IpiTarget::Specified(target_cpu).into();

    let icr = if CurrentApic.x2apic_enabled() {
        x86::apic::Icr::for_x2apic(
            0x20,
            target.into(),
            x86::apic::DestinationShorthand::NoShorthand,
            x86::apic::DeliveryMode::StartUp,
            x86::apic::DestinationMode::Physical,
            x86::apic::DeliveryStatus::Idle,
            x86::apic::Level::Deassert,
            x86::apic::TriggerMode::Edge,
        )
    } else {
        x86::apic::Icr::for_xapic(
            0x20,
            target.into(),
            x86::apic::DestinationShorthand::NoShorthand,
            x86::apic::DeliveryMode::StartUp,
            x86::apic::DestinationMode::Physical,
            x86::apic::DeliveryStatus::Idle,
            x86::apic::Level::Deassert,
            x86::apic::TriggerMode::Edge,
        )
    };

    CurrentApic.write_icr(icr);
    return Ok(());
}

/// 初始化IPI处理函数
pub fn arch_ipi_handler_init() {
    do_init_irq_handler(IPI_NUM_KICK_CPU);
    do_init_irq_handler(IPI_NUM_FLUSH_TLB);
}

fn do_init_irq_handler(irq: IrqNumber) {
    let desc = irq_desc_manager().lookup(irq).unwrap();
    let irq_data: Arc<IrqData> = desc.irq_data();
    let mut chip_info_guard = irq_data.chip_info_write_irqsave();
    chip_info_guard.set_chip(Some(local_apic_chip().clone()));

    desc.modify_status(IrqLineStatus::IRQ_LEVEL, IrqLineStatus::empty());
    drop(chip_info_guard);
    desc.set_handler(&X86_64IpiIrqFlowHandler);
}

#[derive(Debug)]
struct X86_64IpiIrqFlowHandler;

impl IrqFlowHandler for X86_64IpiIrqFlowHandler {
    fn handle(&self, irq_desc: &Arc<IrqDesc>, _trap_frame: &mut TrapFrame) {
        let irq = irq_desc.irq_data().irq();
        match irq {
            IPI_NUM_KICK_CPU => {
                KickCpuIpiHandler.handle(irq, None, None).ok();
            }
            IPI_NUM_FLUSH_TLB => {
                FlushTLBIpiHandler.handle(irq, None, None).ok();
                CurrentApic.send_eoi();
            }
            _ => {
                error!("Unknown IPI: {}", irq.data());
                CurrentApic.send_eoi();
            }
        }
    }
}