mod uart0;
use common::buffer::Buffer;
+use common::ringbuf::Ringbuf;
use common::clock;
use common::systick;
use common::port;
use common::gps;
use common::screen;
use common::time::Time;
+use common::mx25l::Mx25l;
+use common::shell::Shell;
+use common::logger::Logger;
extern {
fn enable_interrupts();
}
}
+fn reset_requested() -> bool {
+ let pta1 = gpio::get(gpio::GPIOA) & (1 << 1);
+ let pte25 = gpio::get(gpio::GPIOE) & (1 << 25);
+
+ (pta1 | pte25) == 0
+}
+
#[inline(never)]
#[panic_handler]
fn panic(_info: &core::panic::PanicInfo) -> ! {
loop {
- if (gpio::get(gpio::GPIOA) & (1 << 12)) == 0 {
+ if reset_requested() {
nvic::system_reset();
}
}
}
+fn configure_push_buttons() {
+ // Configure lower right push button.
+ gpio::set_direction(gpio::GPIOA, 1 << 1, gpio::Direction::Input);
+ port::set_af(port::PORTA, 1, 1);
+ port::set_pull(port::PORTA, 1, port::Pull::Up);
+
+ // Configure upper right push button.
+ gpio::set_direction(gpio::GPIOA, 1 << 12, gpio::Direction::Input);
+ port::set_af(port::PORTA, 12, 1);
+ port::set_pull(port::PORTA, 12, port::Pull::Up);
+
+ // Configure lower left push button.
+ gpio::set_direction(gpio::GPIOE, 1 << 24, gpio::Direction::Input);
+ port::set_af(port::PORTE, 24, 1);
+ port::set_pull(port::PORTE, 24, port::Pull::Up);
+
+ // Configure upper left push button.
+ gpio::set_direction(gpio::GPIOE, 1 << 25, gpio::Direction::Input);
+ port::set_af(port::PORTE, 25, 1);
+ port::set_pull(port::PORTE, 25, port::Pull::Up);
+
+ // Configure middle left push button.
+ gpio::set_direction(gpio::GPIOE, 1 << 31, gpio::Direction::Input);
+ port::set_af(port::PORTE, 31, 1);
+ port::set_pull(port::PORTE, 31, port::Pull::Up);
+}
+
+fn poll_pta12() -> bool {
+ (gpio::get(gpio::GPIOA) & (1 << 12)) == 0
+}
+
+fn uart0_try_read() -> Option<u8> {
+ extern {
+ static mut uart0_rx_buf: Ringbuf;
+ }
+
+ unsafe {
+ if uart0_rx_buf.is_empty() {
+ None
+ } else {
+ Some(uart0_rx_buf.read())
+ }
+ }
+}
+
#[no_mangle]
pub unsafe extern "C" fn _start() -> ! {
clock::configure();
gpio::set_direction(gpio::GPIOB, 1 << 1, gpio::Direction::Output);
port::set_af(port::PORTB, 1, 1);
- // Configure upper right push button.
- gpio::set_direction(gpio::GPIOA, 1 << 12, gpio::Direction::Input);
- port::set_af(port::PORTA, 12, 1);
- port::set_pull(port::PORTA, 12, port::Pull::Up);
+ configure_push_buttons();
enable_interrupts();
nvic::enable_irq(12); // UART0
+ let mut shell = Shell::new(&mut cdc_tx_buf);
+
+ let mut mx25l = Mx25l::new(gpio::GPIOD, 1 << 0);
+
+ let mut logger = Logger::new(&mut mx25l);
+ logger.init();
+
+ let mut pta1_start_press_ticks = 0;
+ let mut pta12_was_pressed = poll_pta12();
+ let mut is_recording = false;
+
let mut gps = gps::Gps::new();
let mut gps_has_fix = false;
let mut prev_tap = gps::TimeAndPos::new();
+ let mut total_distance_cm = 0;
+
loop {
let mut tap = gps::TimeAndPos::new();
let mut show_time = false;
+ let mut show_distance = false;
let old_gps_has_fix = gps_has_fix;
- while gps.update(&mut tap) {
+ while gps.update(&mut tap, uart0_try_read) {
+ if is_recording {
+ logger.log(&prev_tap, &tap);
+
+ total_distance_cm += tap.distance_cm(&prev_tap) as u32;
+
+ show_distance = true;
+ }
+
prev_tap = tap;
show_time = true;
});
}
- if show_time {
+ if show_distance {
+ let mut distance_m_s = [b' '; 8];
+
+ common::fmt::fmt_u32(&mut distance_m_s, total_distance_cm / 100);
+
+ screen.clear();
+ screen.draw_text(&distance_m_s);
+
+ display.draw(&screen);
+ } else if show_time {
if let Some(tm) = Time::from_unix_time(prev_tap.unix_time) {
let mut time_s = [b' '; 8];
tm.fmt_time(&mut time_s);
}
});
- if (gpio::get(gpio::GPIOA) & (1 << 12)) == 0 {
+ shell.update(&mut logger);
+
+ let pta12_is_pressed = poll_pta12();
+
+ if !pta12_was_pressed && pta12_is_pressed {
+ pta1_start_press_ticks = systick::now();
+ } else if pta12_was_pressed && !pta12_is_pressed {
+ if systick::has_timeout_ms(pta1_start_press_ticks, 1500) {
+ is_recording = !is_recording;
+
+ if is_recording {
+ logger.start_recording(&prev_tap);
+ } else {
+ logger.stop_recording(&prev_tap);
+ }
+
+ total_distance_cm = 0;
+ }
+ }
+
+ pta12_was_pressed = pta12_is_pressed;
+
+ if reset_requested() {
nvic::system_reset();
}
}