somehal 0.8.0

SomeHAL: A hardware abstraction layer for kernel development.
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50

use rdif_intc::Intc;
use rdrive::{module_driver, probe::OnProbeError, register::ProbeFdt};

static mut TIMER_IRQ: Option<irq_framework::IrqId> = None;

pub fn systick_irq() -> irq_framework::IrqId {
    unsafe { TIMER_IRQ.expect("systick irq is not initialized") }
}

module_driver!(
    name: "ARMv8 Timer",
    level: ProbeLevel::PreKernel,
    priority: ProbePriority::TIMER,
    probe_kinds: &[
        ProbeKind::Fdt {
            compatibles: &["arm,armv8-timer"],
            on_probe: probe
        }
    ],
);

pub(crate) fn setup_systick_irq() {
    let id = systick_irq();
    if let Err(err) = super::gic::irq_set_enable(id, true) {
        warn!("failed to enable ARMv8 timer IRQ {id:?}: {err:?}");
    }
}

fn probe(probe: ProbeFdt<'_>) -> Result<(), OnProbeError> {
    let (fdt, dev) = probe.into_parts();
    let intc_id = dev.descriptor.irq_parent.unwrap();

    let mut intc = rdrive::get::<Intc>(intc_id).unwrap().lock().unwrap();
    let interrupts = fdt.interrupts();

    let irq_idx = someboot::timer::aarch64_timer_irq_index(someboot::timer::aarch64_timer_mode());
    let irq = &interrupts[irq_idx].specifier;
    let translation = intc
        .translate_fdt(irq)
        .map_err(|err| OnProbeError::other(alloc::format!("invalid timer IRQ: {err:?}")))?;
    intc.configure(&translation).map_err(|err| {
        OnProbeError::other(alloc::format!("failed to configure timer IRQ: {err:?}"))
    })?;
    let irq = translation.id;
    debug!("Armv8 timer irq: {:?}", irq);
    unsafe {
        TIMER_IRQ = Some(irq);
    }
    Ok(())
}