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();
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);
+ let mut gps_icon_timer = Timer::new(500);
+
loop {
let mut tap = gps::TimeAndPos::new();
+ let old_gps_has_fix = gps_has_fix;
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;
+ }
+
+ if gps_has_fix && !old_gps_has_fix {
+ display.show_icon(display::Icon::SatelliteBody);
+ display.show_icon(display::Icon::SatelliteWave1);
+ display.show_icon(display::Icon::SatelliteWave2);
+ } else if !gps_has_fix {
+ gps_icon_timer.update(|state| {
+ if state == 1 {
+ display.show_icon(display::Icon::SatelliteWave1);
+ 2
+ } else if state == 2 {
+ display.show_icon(display::Icon::SatelliteWave2);
+ 3
+ } else if state == 3 {
+ display.hide_icon(display::Icon::SatelliteBody);
+ display.hide_icon(display::Icon::SatelliteWave1);
+ display.hide_icon(display::Icon::SatelliteWave2);
+ 0
+ } else {
+ display.show_icon(display::Icon::SatelliteBody);
+ 1
+ }
+ });
}
+ 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();
}