ax-driver 0.11.3

ArceOS rdrive driver registration and rdif binding collection
Documentation
use alloc::{string::String, vec::Vec};
use core::cell::UnsafeCell;

use ax_errno::AxError;
use ax_kernel_guard::IrqSave;
use axklib::irq::{CpuId, IrqError, run_on_cpu_sync};
use fdt_edit::{Fdt, RegFixed};
use log::warn;
pub use rdif_serial::{
    Config, ConfigError, DataBits, OwnerId, OwnerLease, Parity, RawUart, RxFlag, RxItem, RxQueue,
    SerialCounters, SerialIrqHandler, SerialIrqOutcome, SerialParts, SerialPort, SerialSoftWork,
    StopBits, TxQueue,
};
use rdrive::{Device, DeviceId, DriverGeneric, probe::acpi::AcpiInfo, register::FdtInfo};

mod ns16550;
mod pl011;
mod rockchip_fiq;

use crate::{BindingInfo, BindingIrq, binding_info_from_acpi, binding_info_from_fdt};

pub type SerialRuntime = SerialParts;

struct SerialProbeRuntime {
    name: &'static str,
    base_addr: usize,
    baudrate: u32,
    runtime: SerialRuntime,
}

struct PlatformSerialDevice {
    name: String,
    info: SerialDeviceInfo,
    runtime: Option<SerialRuntime>,
}

#[derive(Clone, Debug, PartialEq, Eq)]
pub struct SerialDeviceInfo {
    pub fdt_path: String,
    pub alias_index: Option<usize>,
    pub paddr: usize,
    pub mapped_base: usize,
    pub baudrate: u32,
    pub irq: Option<BindingIrq>,
    pub binding_info: BindingInfo,
}

pub struct SerialDevice {
    pub name: String,
    pub rdrive_device_id: DeviceId,
    pub info: SerialDeviceInfo,
    pub runtime: SerialRuntime,
}

impl PlatformSerialDevice {
    fn new(name: String, info: SerialDeviceInfo, runtime: SerialRuntime) -> Self {
        Self {
            name,
            info,
            runtime: Some(runtime),
        }
    }
}

impl DriverGeneric for PlatformSerialDevice {
    fn name(&self) -> &str {
        &self.name
    }
}

fn serial_runtime(raw: impl RawUart) -> SerialProbeRuntime {
    let name = raw.name();
    let base_addr = raw.base_addr();
    let baudrate = raw.baudrate();
    let runtime = SerialPort::split(raw, OwnerId(0));
    SerialProbeRuntime {
        name,
        base_addr,
        baudrate,
        runtime,
    }
}

impl TryFrom<Device<PlatformSerialDevice>> for SerialDevice {
    type Error = AxError;

    fn try_from(base: Device<PlatformSerialDevice>) -> Result<Self, Self::Error> {
        let rdrive_device_id = base.descriptor().device_id();
        let mut dev = base.lock().map_err(|_| AxError::BadState)?;
        let name = dev.name.clone();
        let info = dev.info.clone();
        let runtime = dev.runtime.take().ok_or(AxError::BadState)?;
        Ok(Self {
            name,
            rdrive_device_id,
            info,
            runtime,
        })
    }
}

pub fn run_on_owner<F, R>(owner: OwnerId, op: F) -> Result<R, IrqError>
where
    F: FnOnce(OwnerLease<'_>) -> R,
{
    struct OwnerCall<F, R> {
        owner: OwnerId,
        op: UnsafeCell<Option<F>>,
        result: UnsafeCell<Option<R>>,
    }

    unsafe fn thunk<F, R>(arg: *mut ())
    where
        F: FnOnce(OwnerLease<'_>) -> R,
    {
        let call = unsafe { &*(arg as *const OwnerCall<F, R>) };
        let op = unsafe { &mut *call.op.get() }
            .take()
            .expect("serial owner call entered twice");
        let _irq_guard = IrqSave::new();
        let lease = unsafe { OwnerLease::new_unchecked(call.owner) };
        let result = op(lease);
        unsafe { *call.result.get() = Some(result) };
    }

    let call = OwnerCall {
        owner,
        op: UnsafeCell::new(Some(op)),
        result: UnsafeCell::new(None),
    };
    unsafe {
        run_on_cpu_sync(
            CpuId(owner.0),
            thunk::<F, R>,
            (&call as *const OwnerCall<F, R> as *mut ()).cast(),
        )?;
    }
    Ok(unsafe { &mut *call.result.get() }
        .take()
        .expect("serial owner call did not complete"))
}

pub fn owner_lease_for_cpu(owner: OwnerId, cpu: CpuId) -> Option<OwnerLease<'static>> {
    (cpu.0 == owner.0).then(|| unsafe { OwnerLease::new_unchecked(owner) })
}

pub fn take_serial_devices() -> Vec<SerialDevice> {
    if !rdrive::is_initialized() {
        warn!("rdrive is not initialized; no serial devices available");
        return Vec::new();
    }

    rdrive::get_list::<PlatformSerialDevice>()
        .into_iter()
        .filter_map(|dev| match SerialDevice::try_from(dev) {
            Ok(serial) => Some(serial),
            Err(err) => {
                warn!("failed to take serial device: {err:?}");
                None
            }
        })
        .collect()
}

fn serial_device_info(
    info: &FdtInfo<'_>,
    base_reg: &RegFixed,
    mapped_base: usize,
    baudrate: u32,
) -> SerialDeviceInfo {
    let fdt_path = info.node.path();
    let alias_index = rdrive::with_fdt(|fdt| serial_alias_index(fdt, &fdt_path)).flatten();
    let binding_info = serial_binding_info(info, &fdt_path);
    let irq = binding_info.irq_cloned();
    SerialDeviceInfo {
        fdt_path,
        alias_index,
        paddr: base_reg.address as usize,
        mapped_base,
        baudrate,
        irq,
        binding_info,
    }
}

fn acpi_serial_device_info(
    info: &AcpiInfo<'_>,
    paddr: usize,
    mapped_base: usize,
    baudrate: u32,
) -> SerialDeviceInfo {
    let binding_info = acpi_serial_binding_info(info);
    let irq = binding_info.irq_cloned();
    SerialDeviceInfo {
        fdt_path: info.path.into(),
        alias_index: None,
        paddr,
        mapped_base,
        baudrate,
        irq,
        binding_info,
    }
}

fn serial_binding_info(info: &FdtInfo<'_>, fdt_path: &str) -> BindingInfo {
    binding_info_from_fdt(info).unwrap_or_else(|err| {
        warn!("failed to resolve serial IRQ for {fdt_path}: {err:?}");
        BindingInfo::empty()
    })
}

fn acpi_serial_binding_info(info: &AcpiInfo<'_>) -> BindingInfo {
    binding_info_from_acpi(info).unwrap_or_else(|err| {
        warn!(
            "failed to resolve ACPI serial IRQ for {}: {err:?}",
            info.path
        );
        BindingInfo::empty()
    })
}

fn serial_alias_index(fdt: &Fdt, node_path: &str) -> Option<usize> {
    let aliases = fdt.get_by_path("/aliases")?;
    aliases
        .as_node()
        .properties()
        .iter()
        .filter_map(|prop| {
            let index = prop.name().strip_prefix("serial")?.parse::<usize>().ok()?;
            let path = prop.as_str()?;
            (path == node_path).then_some(index)
        })
        .next()
}

fn prop_u32(node: &fdt_edit::Node, name: &str) -> Option<u32> {
    node.get_property(name).and_then(|prop| prop.get_u32())
}

#[cfg(test)]
mod tests {
    use alloc::vec::Vec;

    use fdt_edit::{Fdt, Node, Property};

    use super::*;

    #[test]
    fn resolves_serial_alias_index_by_node_path() {
        let fdt = minimal_serial_alias_fdt();

        assert_eq!(serial_alias_index(&fdt, "/soc/uart@1000"), Some(0));
        assert_eq!(serial_alias_index(&fdt, "/soc/uart@2000"), Some(2));
        assert_eq!(serial_alias_index(&fdt, "/soc/uart@3000"), None);
    }

    fn minimal_serial_alias_fdt() -> Fdt {
        minimal_serial_alias_fdt_with_root_compatible(&[])
    }

    fn minimal_serial_alias_fdt_with_root_compatible(compatibles: &[&str]) -> Fdt {
        let mut fdt = Fdt::new();
        let root = fdt.root_id();
        if !compatibles.is_empty() {
            fdt.node_mut(root)
                .unwrap()
                .set_property(prop_strs("compatible", compatibles));
        }
        let aliases = fdt.add_node(root, Node::new("aliases"));
        fdt.node_mut(aliases)
            .unwrap()
            .set_property(prop_str("serial0", "/soc/uart@1000"));
        fdt.node_mut(aliases)
            .unwrap()
            .set_property(prop_str("serial2", "/soc/uart@2000"));

        let soc = fdt.add_node(root, Node::new("soc"));
        fdt.add_node(soc, Node::new("uart@1000"));
        fdt.add_node(soc, Node::new("uart@2000"));
        fdt
    }

    fn prop_str(name: &str, value: &str) -> Property {
        let mut data = Vec::new();
        data.extend_from_slice(value.as_bytes());
        data.push(0);
        Property::new(name, data)
    }

    fn prop_strs(name: &str, values: &[&str]) -> Property {
        let mut data = Vec::new();
        for value in values {
            data.extend_from_slice(value.as_bytes());
            data.push(0);
        }
        Property::new(name, data)
    }
}