mirror of
https://github.com/saymrwulf/xous-core.git
synced 2026-11-19 09:00:54 +00:00
fix camera inconsistent start issue
on first boot, camera may not always start (some boards it never starts) it always starts on a second prompting the issue is related to the relevant code being swapped out, it seems; i think an event fires and gets missed in the fray of all the data being swapped in from off-chip storage. this patch: - re-orders the pipe warming and system bring-up - adds a watchdog thread that ensures the camera interrupt fires, and if it does not, issues a manual camera interrupt to kick start the system This greatly improves the reliability of first-start success. Across several trials on many units i had only one misfire - not sure what it was, can't reproduce, but this is much better than the roughly 80-90% misfire rate I was seeing before. ship it.
This commit is contained in:
parent
d3970eaa80
commit
9232b87139
1 changed files with 74 additions and 41 deletions
|
|
@ -432,6 +432,7 @@ pub fn wrapped_main(main_thread_token: MainThreadToken) -> ! {
|
||||||
let mut bw_thresh: u8 = 128;
|
let mut bw_thresh: u8 = 128;
|
||||||
let mut qr_request: Option<xous::MessageEnvelope> = None;
|
let mut qr_request: Option<xous::MessageEnvelope> = None;
|
||||||
let mut kbd_listeners: Vec<(CID, usize)> = Vec::new();
|
let mut kbd_listeners: Vec<(CID, usize)> = Vec::new();
|
||||||
|
let cam_started = Arc::new(AtomicBool::new(false));
|
||||||
#[allow(unused_mut)]
|
#[allow(unused_mut)]
|
||||||
let mut orientation = DisplayOrientation::Normal;
|
let mut orientation = DisplayOrientation::Normal;
|
||||||
loop {
|
loop {
|
||||||
|
|
@ -445,41 +446,6 @@ pub fn wrapped_main(main_thread_token: MainThreadToken) -> ! {
|
||||||
#[cfg(not(feature = "hosted-baosec"))]
|
#[cfg(not(feature = "hosted-baosec"))]
|
||||||
GfxOpcode::AcquireQr => {
|
GfxOpcode::AcquireQr => {
|
||||||
if qr_request.is_none() {
|
if qr_request.is_none() {
|
||||||
// reset camera UDMA block
|
|
||||||
udma_global.reset(PeriphId::Cam);
|
|
||||||
|
|
||||||
// display.stash(); // save a copy of the UI
|
|
||||||
// this will defer response until later
|
|
||||||
qr_request = msg_opt.take();
|
|
||||||
|
|
||||||
// power up the camera
|
|
||||||
// starts MCLK
|
|
||||||
iox.setup_pin(
|
|
||||||
cam_clk.0,
|
|
||||||
cam_clk.1,
|
|
||||||
Some(IoxDir::Output),
|
|
||||||
Some(IoxFunction::AF3),
|
|
||||||
None,
|
|
||||||
None,
|
|
||||||
Some(IoxEnable::Disable),
|
|
||||||
Some(IoxDriveStrength::Drive8mA),
|
|
||||||
);
|
|
||||||
timer.wo(utra::pwm::REG_CH_EN, 1);
|
|
||||||
timer.rmwf(utra::pwm::REG_TIM0_CMD_R_TIMER0_START, 1);
|
|
||||||
tt.sleep_ms(2).ok(); // wait for camera to clock-up
|
|
||||||
// bring camera out of powerdown
|
|
||||||
iox.set_gpio_pin_value(cam_pdwn.0, cam_pdwn.1, IoxValue::Low);
|
|
||||||
tt.sleep_ms(3).ok(); // wait for camera to power-up
|
|
||||||
let (pid, mid) = cam.read_id(&mut i2c);
|
|
||||||
log::info!("Camera pid {:x}, mid {:x}", pid, mid);
|
|
||||||
cam.init(&mut i2c, bao1x_api::camera::Resolution::Res320x240);
|
|
||||||
tt.sleep_ms(1).ok();
|
|
||||||
|
|
||||||
let (cols, _rows) = cam.resolution();
|
|
||||||
let border = (cols - IMAGE_WIDTH) / 2;
|
|
||||||
cam.set_slicing((border, 0), (cols - border, IMAGE_HEIGHT));
|
|
||||||
log::info!("320x240 resolution setup with 256x240 slicing");
|
|
||||||
|
|
||||||
// decode dummy data - what this does is load the swapped out QR decoding logic, thus
|
// decode dummy data - what this does is load the swapped out QR decoding logic, thus
|
||||||
// improving the latency of the decoder on the "first hit". The sole purpose of this
|
// improving the latency of the decoder on the "first hit". The sole purpose of this
|
||||||
// is to improve the user experience during scanning.
|
// is to improve the user experience during scanning.
|
||||||
|
|
@ -505,18 +471,84 @@ pub fn wrapped_main(main_thread_token: MainThreadToken) -> ! {
|
||||||
} else {
|
} else {
|
||||||
log::error!("test image failed to decode, this shouldn't happen!");
|
log::error!("test image failed to decode, this shouldn't happen!");
|
||||||
}
|
}
|
||||||
|
|
||||||
// turning off preemption makes camera acquisition smoother; the OS will naturally try
|
|
||||||
// to schedule other tasks between camera frames after each
|
|
||||||
// CamIrq interrupt
|
|
||||||
hal.set_preemption(false);
|
|
||||||
// fix orientation if it's upside down
|
// fix orientation if it's upside down
|
||||||
if orientation == DisplayOrientation::UpsideDown {
|
if orientation == DisplayOrientation::UpsideDown {
|
||||||
display
|
display
|
||||||
.flip_vertical(false)
|
.flip_vertical(false)
|
||||||
.unwrap_or_else(|_| display_timeout_handler(&udma_global, &mut display))
|
.unwrap_or_else(|_| display_timeout_handler(&udma_global, &mut display))
|
||||||
}
|
}
|
||||||
// now start acquisition
|
|
||||||
|
// reset camera UDMA block
|
||||||
|
udma_global.reset(PeriphId::Cam);
|
||||||
|
|
||||||
|
// display.stash(); // save a copy of the UI
|
||||||
|
// this will defer response until later
|
||||||
|
qr_request = msg_opt.take();
|
||||||
|
|
||||||
|
// power up the camera
|
||||||
|
// starts MCLK
|
||||||
|
iox.setup_pin(
|
||||||
|
cam_clk.0,
|
||||||
|
cam_clk.1,
|
||||||
|
Some(IoxDir::Output),
|
||||||
|
Some(IoxFunction::AF3),
|
||||||
|
None,
|
||||||
|
None,
|
||||||
|
Some(IoxEnable::Disable),
|
||||||
|
Some(IoxDriveStrength::Drive8mA),
|
||||||
|
);
|
||||||
|
timer.wo(utra::pwm::REG_CH_EN, 1);
|
||||||
|
timer.rmwf(utra::pwm::REG_TIM0_CMD_R_TIMER0_START, 1);
|
||||||
|
tt.sleep_ms(5).ok(); // wait for camera to clock-up
|
||||||
|
// bring camera out of powerdown
|
||||||
|
iox.set_gpio_pin_value(cam_pdwn.0, cam_pdwn.1, IoxValue::Low);
|
||||||
|
tt.sleep_ms(10).ok(); // wait for camera to power-up
|
||||||
|
let (pid, mid) = cam.read_id(&mut i2c);
|
||||||
|
log::info!("Camera pid {:x}, mid {:x}", pid, mid);
|
||||||
|
cam.init(&mut i2c, bao1x_api::camera::Resolution::Res320x240);
|
||||||
|
tt.sleep_ms(5).ok();
|
||||||
|
|
||||||
|
let (cols, _rows) = cam.resolution();
|
||||||
|
let border = (cols - IMAGE_WIDTH) / 2;
|
||||||
|
cam.set_slicing((border, 0), (cols - border, IMAGE_HEIGHT));
|
||||||
|
log::info!("320x240 resolution setup with 256x240 slicing");
|
||||||
|
|
||||||
|
cam_started.store(false, Ordering::SeqCst);
|
||||||
|
|
||||||
|
// start watchdog to make sure camera is running
|
||||||
|
let _ = std::thread::spawn({
|
||||||
|
let cid = cid.clone();
|
||||||
|
let cam_started = cam_started.clone();
|
||||||
|
move || {
|
||||||
|
let hal = Hal::new();
|
||||||
|
let start = std::time::Instant::now();
|
||||||
|
while !cam_started.load(Ordering::SeqCst)
|
||||||
|
&& std::time::Instant::now().duration_since(start).as_millis() < 600
|
||||||
|
{
|
||||||
|
std::thread::sleep(std::time::Duration::from_millis(30));
|
||||||
|
}
|
||||||
|
if !cam_started.load(Ordering::SeqCst) {
|
||||||
|
// force an IRQ into the pipe to start the camera
|
||||||
|
xous::try_send_message(
|
||||||
|
cid,
|
||||||
|
xous::Message::new_scalar(
|
||||||
|
GfxOpcode::CamIrq.to_usize().unwrap(),
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
),
|
||||||
|
)
|
||||||
|
.ok();
|
||||||
|
}
|
||||||
|
// turning off preemption makes camera acquisition smoother; the OS will
|
||||||
|
// naturally try to schedule other tasks
|
||||||
|
// between camera frames after each CamIrq interrupt
|
||||||
|
hal.set_preemption(false);
|
||||||
|
}
|
||||||
|
});
|
||||||
|
|
||||||
|
// now start an acquisition
|
||||||
cam.capture_async();
|
cam.capture_async();
|
||||||
}
|
}
|
||||||
// if qr_request is already pending, ignore any new acquisition requests
|
// if qr_request is already pending, ignore any new acquisition requests
|
||||||
|
|
@ -567,6 +599,7 @@ pub fn wrapped_main(main_thread_token: MainThreadToken) -> ! {
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
GfxOpcode::CamIrq => {
|
GfxOpcode::CamIrq => {
|
||||||
|
cam_started.store(true, Ordering::SeqCst);
|
||||||
// copy the camera data to our FB
|
// copy the camera data to our FB
|
||||||
let fb: &[u32] = cam.rx_buf();
|
let fb: &[u32] = cam.rx_buf();
|
||||||
// fb is an array of IMAGE_WIDTH x IMAGE_HEIGHT x u16
|
// fb is an array of IMAGE_WIDTH x IMAGE_HEIGHT x u16
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue