xous-core/services/bao1x-emu/src/main.rs
2026-05-06 07:28:08 +08:00

109 lines
4.8 KiB
Rust

mod keyboard;
mod susres;
use bao1x_api::*;
fn main() {
log_server::init_wait().unwrap();
log::set_max_level(log::LevelFilter::Info);
log::info!("my PID is {}", xous::process::id());
let xns = xous_names::XousNames::new().unwrap();
let sid = xns.register_name(bao1x_api::SERVER_NAME_BAO1X_HAL, None).expect("can't register server");
// start keyboard emulator service
keyboard::start_keyboard_service();
// start susres responder
susres::start_susres_service();
let mut msg_opt = None;
log::debug!("Starting main loop");
loop {
xous::reply_and_receive_next(sid, &mut msg_opt).unwrap();
let msg = msg_opt.as_mut().unwrap();
let opcode =
num_traits::FromPrimitive::from_usize(msg.body.id()).unwrap_or(api::HalOpcode::InvalidCall);
log::debug!("{:?}", opcode);
match opcode {
HalOpcode::MapIfram => {
if let Some(scalar) = msg.body.scalar_message_mut() {
let requested_size = scalar.arg1; // requested size
let _requested_bank = scalar.arg2; // Specifies bank 0, 1, or don't care (any number but 0 or 1)
// return as if the mapping passed
scalar.arg1 = requested_size;
scalar.arg2 = 0xDEAD_BEEF; // fake address
}
}
HalOpcode::UnmapIfram => {
if let Some(_scalar) = msg.body.scalar_message() {
// do nothing
}
}
HalOpcode::ConfigureIox => {
let buf =
unsafe { xous_ipc::Buffer::from_memory_message(msg.body.memory_message().unwrap()) };
let config = buf.to_original::<IoxConfigMessage, _>().unwrap();
log::info!("Emulation got IO config request: {:?}", config);
}
HalOpcode::ConfigureIoxIrq => {
let buf =
unsafe { xous_ipc::Buffer::from_memory_message(msg.body.memory_message().unwrap()) };
let registration = buf.to_original::<IoxIrqRegistration, _>().unwrap();
log::info!("Got registration request: {:?}", registration);
}
HalOpcode::IrqLocalHandler => {}
HalOpcode::SetGpioBank => {
if let Some(scalar) = msg.body.scalar_message() {
let port: IoxPort = num_traits::FromPrimitive::from_usize(scalar.arg1).unwrap();
let value = scalar.arg2 as u16;
let bitmask = scalar.arg3 as u16;
log::info!("Set Gpio{:?}, {:x}&{:x}", port, value, bitmask);
}
}
HalOpcode::GetGpioBank => {
if let Some(scalar) = msg.body.scalar_message_mut() {
let port: IoxPort = num_traits::FromPrimitive::from_usize(scalar.arg1).unwrap();
log::info!("Get Gpio{:?} - returning 0", port);
scalar.arg1 = 0;
}
}
HalOpcode::ConfigureUdmaClock => {
if let Some(scalar) = msg.body.scalar_message() {
let periph: PeriphId = num_traits::FromPrimitive::from_usize(scalar.arg1).unwrap();
let enable = if scalar.arg2 != 0 { true } else { false };
log::info!("Udma clock setting of {:?} for {:?}", enable, periph);
}
}
HalOpcode::ConfigureUdmaEvent => {
if let Some(scalar) = msg.body.scalar_message() {
let periph: PeriphId = num_traits::FromPrimitive::from_usize(scalar.arg1).unwrap();
let event_offset = scalar.arg2 as u32;
let to_channel: EventChannel =
num_traits::FromPrimitive::from_usize(scalar.arg3).unwrap();
log::info!("Udma configure event: {:?}/{:?}, {:x}", periph, to_channel, event_offset);
}
}
HalOpcode::UdmaIrqStatusBits => {
if let Some(scalar) = msg.body.scalar_message_mut() {
scalar.arg1 = 0;
}
}
HalOpcode::PeriphReset => {
if let Some(scalar) = msg.body.scalar_message() {
let periph: PeriphId = num_traits::FromPrimitive::from_usize(scalar.arg1).unwrap();
log::info!("Udma periph reset of {:?}", periph);
}
}
HalOpcode::InvalidCall => {
log::error!("Invalid opcode received: {:?}", msg);
}
HalOpcode::SetPreemptionState => {
todo!("unimplemented opcode: {:?}", opcode);
}
_ => {
unimplemented!("Not available in hosted mode");
}
}
}
}