mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-15 08:30:02 +00:00
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.
This commit is contained in:
parent
a74a87e1ac
commit
b6f761a9a9
1 changed files with 48 additions and 0 deletions
48
services/bao1x-hal-service/src/servers/power.rs
Normal file
48
services/bao1x-hal-service/src/servers/power.rs
Normal file
|
|
@ -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);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
Loading…
Reference in a new issue