From b6f761a9a9a274e938c832d32904d2ae6e8a091f Mon Sep 17 00:00:00 2001 From: bunnie Date: Thu, 11 Dec 2025 02:07:17 +0800 Subject: [PATCH] move power manager to a server this is because the power manager itself relies on the HAL server to manipulate GPIOs and it'll block the main loop if the calls are handled there. --- .../bao1x-hal-service/src/servers/power.rs | 48 +++++++++++++++++++ 1 file changed, 48 insertions(+) create mode 100644 services/bao1x-hal-service/src/servers/power.rs diff --git a/services/bao1x-hal-service/src/servers/power.rs b/services/bao1x-hal-service/src/servers/power.rs new file mode 100644 index 000000000..7644562e7 --- /dev/null +++ b/services/bao1x-hal-service/src/servers/power.rs @@ -0,0 +1,48 @@ +use bao1x_api::PowerOp; +use utralib::*; + +pub fn start_power_service(sid: xous::SID) { + std::thread::spawn(move || { + power_service(sid); + }); +} + +fn power_service(sid: xous::SID) { + let mut clk_mgr = bao1x_hal::clocks::ClockManager::new().unwrap(); + let measured = clk_mgr.measured_freqs(); + log::info!("computed frequencies:"); + log::info!(" vco: {}", clk_mgr.vco_freq); + log::info!(" fclk: {}", clk_mgr.fclk); + log::info!(" aclk: {}", clk_mgr.aclk); + log::info!(" hclk: {}", clk_mgr.hclk); + log::info!(" iclk: {}", clk_mgr.iclk); + log::info!(" pclk: {}", clk_mgr.pclk); + log::info!(" per: {}", clk_mgr.perclk); + log::info!("measured frequencies:"); + for (name, freq) in measured { + log::info!(" {}: {} MHz", name, freq); + } + + let hal = bao1x_hal_service::Hal::new(); + + let mut msg_opt = None; + loop { + xous::reply_and_receive_next(sid, &mut msg_opt).unwrap(); + let msg = msg_opt.as_mut().unwrap(); + let opcode: PowerOp = + num_traits::FromPrimitive::from_usize(msg.body.id()).unwrap_or(PowerOp::Invalid); + log::debug!("{:?}", opcode); + match opcode { + PowerOp::Wfi => { + log::info!("triggering wfi..."); + clk_mgr.wfi(); + log::info!("recovered from wfi!"); + hal.set_preemption(true); + log::info!("preemption turned on!"); + } + PowerOp::Invalid => { + log::error!("Unrecognized opcode: {:?}, ignoring!", opcode); + } + } + } +}