X-Git-Url: http://git.code-monkey.de/?a=blobdiff_plain;f=src%2Fapplication%2Fmain.rs;h=f1aaafe40b1a5e0bc7273f3231a68f3b331c6eda;hb=c14bb6b5cfbfdc40c7e5d981645604811041b640;hp=edb234eae4fafe355e3541c1dbdfb9cb80c52ddc;hpb=95486d1430d2c3f66a07c99771088a80afbb8735;p=gps-watch.git

diff --git a/src/application/main.rs b/src/application/main.rs
index edb234e..f1aaafe 100644
--- a/src/application/main.rs
+++ b/src/application/main.rs
@@ -39,6 +39,7 @@ use common::i2c;
 use common::uart;
 use common::usb_serial;
 use common::display;
+use common::gps;
 
 extern {
     fn enable_interrupts();
@@ -46,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<F>(&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();
@@ -99,11 +126,35 @@ pub unsafe extern "C" fn _start() -> ! {
 
     nvic::enable_irq(12); // UART0
 
+    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 {
-        systick::delay_ms(1000);
+        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;
+        }
 
-        cdc_tx_buf.write(b".\n");
-        cdc_tx_buf.flush();
+        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();