use crate::common::LineAddr;
use crate::sim::components::ComponentId;
use crate::sim::handle::{Handle, HandleCtx};
use crate::sim::packet::{HitLevel, MemOp, MemRespData, MesiState, Packet, WriteData};
use crate::soc::devices::Device;
use std::sync::Arc;
use std::sync::atomic::{AtomicU64, Ordering};
#[derive(Debug)]
pub struct Htif {
base_addr: u64,
exit_signal: Arc<AtomicU64>,
}
impl Htif {
pub const fn new(base_addr: u64, exit_signal: Arc<AtomicU64>) -> Self {
Self { base_addr, exit_signal }
}
fn handle_tohost(&self, val: u64) {
if val == 0 {
return;
}
if val == 1 {
self.exit_signal.store(0, Ordering::Relaxed);
} else if val & 1 != 0 {
let test_num = val >> 1;
tracing::warn!(target: "rvsim::htif", test = test_num, tohost = val, "test failed");
self.exit_signal.store(test_num, Ordering::Relaxed);
} else {
tracing::warn!(target: "rvsim::htif", tohost = val, "unhandled tohost value");
self.exit_signal.store(val, Ordering::Relaxed);
}
}
}
impl Handle for Htif {
fn handle(&mut self, packet: Packet, source: ComponentId, ctx: &mut HandleCtx<'_>) {
if let Packet::MemReq { req_id, paddr, size, op, .. } = packet {
let offset = paddr.val().saturating_sub(self.base_addr);
if offset == 0
&& matches!(
size,
crate::sim::packet::AccessSize::B4 | crate::sim::packet::AccessSize::B8
)
&& let MemOp::Write { data: WriteData::Small(val), .. } = op
{
self.handle_tohost(val);
}
ctx.scheduler.schedule(
ctx.cycle + ctx.config.system.device_access_cycles(self.name()),
source,
ctx.self_id,
Packet::MemResp {
req_id,
line_addr: LineAddr::from_phys(paddr, 64),
data: MemRespData::Small(0),
hit_level: HitLevel::Mmio,
state: MesiState::Exclusive,
},
);
}
}
}
impl Device for Htif {
fn name(&self) -> &'static str {
"HTIF"
}
fn address_range(&self) -> (u64, u64) {
(self.base_addr, 16)
}
fn quiet_ticks(&self) -> Option<u64> {
None
}
}