X-Git-Url: http://git.code-monkey.de/?a=blobdiff_plain;f=src%2Fapplication%2Fmain.rs;h=f1aaafe40b1a5e0bc7273f3231a68f3b331c6eda;hb=c14bb6b5cfbfdc40c7e5d981645604811041b640;hp=dbd748c8e28013e25f5c62afdd8f24d68251ba86;hpb=f33681815491184edca121e8005de0281aa611ac;p=gps-watch.git diff --git a/src/application/main.rs b/src/application/main.rs index dbd748c..f1aaafe 100644 --- a/src/application/main.rs +++ b/src/application/main.rs @@ -47,6 +47,32 @@ extern { static mut cdc_tx_buf: Buffer; } +struct Timer { + state: u32, + delay_ms: u32, + last_update_ticks: u32, +} + +impl Timer { + pub fn new(delay_ms: u32) -> Timer { + Timer { + state: 0, + delay_ms: delay_ms, + last_update_ticks: systick::now(), + } + } + + pub fn update(&mut self, func: F) + where F: FnOnce(u32) -> u32 + { + if systick::has_timeout_ms(self.last_update_ticks, self.delay_ms) { + self.state = func(self.state); + + self.last_update_ticks = systick::now(); + } + } +} + #[no_mangle] pub unsafe extern "C" fn _start() -> ! { clock::configure(); @@ -102,12 +128,34 @@ pub unsafe extern "C" fn _start() -> ! { let mut gps = gps::Gps::new(); + let mut gps_has_fix = false; + let mut gps_has_fix_ticks = 0; + + let mut heart_icon_timer = Timer::new(1000); + loop { let mut tap = gps::TimeAndPos::new(); while gps.update(&mut tap) { + gps_has_fix = true; + gps_has_fix_ticks = systick::now(); } + // Did GPS fix information expire? + if gps_has_fix && systick::has_timeout_ms(gps_has_fix_ticks, 1500) { + gps_has_fix = false; + } + + heart_icon_timer.update(|state| { + if state == 1 { + display.hide_icon(display::Icon::Heart); + 0 + } else { + display.show_icon(display::Icon::Heart); + 1 + } + }); + if (gpio::get(gpio::GPIOA) & (1 << 12)) == 0 { nvic::system_reset(); }