From 3b0edbb44214847f46a18dabfd0c15a63e5bdfe5 Mon Sep 17 00:00:00 2001 From: bunnie Date: Wed, 28 Jan 2026 15:09:52 +0800 Subject: [PATCH] add some more test routines - some of these will be culled shortly --- services/bao-console/src/cmds/test.rs | 80 ++++++++++++++++++++++++++- 1 file changed, 78 insertions(+), 2 deletions(-) diff --git a/services/bao-console/src/cmds/test.rs b/services/bao-console/src/cmds/test.rs index e39137623..f63e62697 100644 --- a/services/bao-console/src/cmds/test.rs +++ b/services/bao-console/src/cmds/test.rs @@ -1,3 +1,5 @@ +use std::time::Duration; + use String; use crate::{CommonEnv, ShellCmdApi}; @@ -134,8 +136,8 @@ impl<'a> ShellCmdApi<'a> for Test { match xous::send_message( conn, xous::Message::new_blocking_scalar( - susres::api::Opcode::SuspendRequest.to_usize().unwrap(), - 1, // this is a monkeypatch + susres::api::Opcode::PlatformSpecific.to_usize().unwrap(), + bao1x_hal_service::api::ClockOp::DeepSleep.to_usize().unwrap(), 0, 0, 0, @@ -250,6 +252,80 @@ impl<'a> ShellCmdApi<'a> for Test { } } } + "cam" => { + use bao1x_api::I2cApi; + let mut i2c = bao1x_hal::i2c::I2c::new(); + if args.len() < 1 { + write!(ret, "cam [poke adr data]").ok(); + return Ok(Some(ret)); + } + if args[0] == "poke" { + if args.len() != 3 { + write!(ret, "cam poke adr(hex) data(hex)").ok(); + return Ok(Some(ret)); + } + let adr = u8::from_str_radix(&args[1], 16).map_err(|_| xous::Error::InvalidArgument)?; + let data = u8::from_str_radix(&args[2], 16).map_err(|_| xous::Error::InvalidArgument)?; + i2c.i2c_write(0x3C, adr, &[data]).expect("write failed"); + write!(ret, "Wrote {:x} into {:x}", data, adr).ok(); + } + } + "accel" => { + use std::time::Instant; + + use bao1x_hal::i2c::I2c; + use bao1x_hal::lis2dh12::{Lis2dh12, Orientation}; + + let mut i2c = I2c::new(); + // Initialize + let mut accel = Lis2dh12::new(&mut i2c).unwrap(); + + // Check orientation + let duration = Duration::from_secs(2); + let start_time = Instant::now(); + while Instant::now().duration_since(start_time).lt(&duration) { + let orientation = accel.get_orientation(&mut i2c).unwrap(); + match orientation { + Orientation::FaceUp => println!("Face up"), + Orientation::FaceDown => println!("Face down"), + Orientation::Unknown => println!("Tilted/transitioning"), + } + let raw_data = accel.read_accel_mg(&mut i2c).unwrap(); + log::info!("mg data: {:?}", raw_data); + _env.ticktimer.sleep_ms(50).ok(); + } + + // Set up motion interrupt (200mg threshold, 5 samples duration) + // accel.set_int1_latch(&mut i2c, true)?; + // accel.setup_motion_interrupt(&mut i2c, 100, 2)?; + log::info!("result: {:?}", accel.debug_test_int1_simple(&mut i2c)?); + + let debug = accel.debug_dump_int_config(&mut i2c)?; + debug.interpret(); + log::info!("debug: {:?}", debug); + + // Later, when INT1 fires, read and clear the interrupt source + let duration = Duration::from_secs(30); + let start_time = Instant::now(); + while Instant::now().duration_since(start_time).lt(&duration) { + let source = accel.read_int1_source(&mut i2c)?; + if source.active { + log::info!( + "Motion detected! {:?} {:?}", + source, + accel.read_accel_mg(&mut i2c).unwrap() + ); + accel.reset_highpass(&mut i2c)?; + } + _env.ticktimer.sleep_ms(150).ok(); + /* + if accel.poll_int1_active(&mut i2c)? { + log::info!("int active"); + let raw_data = accel.read_accel_mg(&mut i2c).unwrap(); + log::info!("mg data: {:?}", raw_data); + }*/ + } + } /* // leave this around in case we have more swap bugs to debug // needs to have `swaptest1`` & `swaptest2` added to the image for this to work. "swap" => {