From beddb8cf26138f9aaa5fa8bacf8aa355fa0b069c Mon Sep 17 00:00:00 2001
From: Tilman Sauerbeck <tilman@code-monkey.de>
Date: Sun, 5 Jul 2020 18:35:09 +0200
Subject: [PATCH] common: Make Logger calculate and publish pace.

Every 1000m, pace is set to the time in seconds it took to travel
that distance.
---
 src/common/logger.rs | 26 ++++++++++++++++++++++++--
 test/logger_test.rs  | 39 +++++++++++++++++++++++++++++++++++++++
 2 files changed, 63 insertions(+), 2 deletions(-)

diff --git a/src/common/logger.rs b/src/common/logger.rs
index ea84bc2..98a857a 100644
--- a/src/common/logger.rs
+++ b/src/common/logger.rs
@@ -119,6 +119,10 @@ pub struct Logger<'a> {
     // The total distance logged of the currently running recording.
     pub total_distance_cm: u32,
 
+    split_distance_cm: u32,
+    split_duration_ms: u32,
+    pub pace_s: u32,
+
     // The number of slots filled in num_flight.
     num_in_flight: usize,
 
@@ -294,6 +298,9 @@ impl<'a> Logger<'a> {
             first_sector: 0,
             recording_started: 0,
             total_distance_cm: 0,
+            split_distance_cm: 0,
+            split_duration_ms: 0,
+            pace_s: 0,
             num_in_flight: 0,
 
             in_flight: [InFlight::new(); 7],
@@ -362,6 +369,9 @@ impl<'a> Logger<'a> {
         self.sectors_written = 0;
         self.recording_started = tap.unix_time;
         self.total_distance_cm = 0;
+        self.split_distance_cm = 0;
+        self.split_duration_ms = 0;
+        self.pace_s = 0;
         self.num_in_flight = 0;
 
         self.prepare_write_buffer(true);
@@ -372,8 +382,6 @@ impl<'a> Logger<'a> {
     }
 
     pub fn log(&mut self, prev_tap: &TimeAndPos, tap: &TimeAndPos) {
-        self.total_distance_cm += tap.distance_cm(&prev_tap) as u32;
-
         let d_time_ms = elapsed_ms(tap.system_time, prev_tap.system_time);
 
         // We know that our hardware cannot deliver updates more often
@@ -390,6 +398,20 @@ impl<'a> Logger<'a> {
         if self.write_packet(d_time_s, d_lat, d_lon) {
             self.flush_in_flight(false);
         }
+
+        let distance_cm = tap.distance_cm(&prev_tap) as u32;
+
+        self.total_distance_cm += distance_cm;
+        self.split_distance_cm += distance_cm;
+
+        self.split_duration_ms += d_time_ms;
+
+        if self.split_distance_cm >= 100_000 {
+            self.split_distance_cm -= 100_000;
+
+            self.pace_s = self.split_duration_ms / 1000;
+            self.split_duration_ms = 0;
+        }
     }
 
     pub fn stop_recording(&mut self, tap: &TimeAndPos) -> u16 {
diff --git a/test/logger_test.rs b/test/logger_test.rs
index 784c049..18b0fbb 100644
--- a/test/logger_test.rs
+++ b/test/logger_test.rs
@@ -572,3 +572,42 @@ fn remove_recording1() {
 
     assert_eq!(fake_storage.expected, fake_storage.actual);
 }
+
+#[test]
+fn pace0() {
+    let mut fake_storage = FakeStorage::new();
+
+    let mut logger = Logger::new(&mut fake_storage);
+    logger.init();
+
+    let lat_lon = [
+        (49.372117, 8.820219),
+        (49.372229, 8.821636),
+    ];
+
+    let template = gps::TimeAndPos {
+        system_time: 0,
+        unix_time: 0,
+        latitude_deg: 0,
+        longitude_deg: 0,
+        latitude_rad: Fixed::from_f32(0.0),
+        longitude_rad: Fixed::from_f32(0.0),
+    };
+
+    let mut taps = [template; 11];
+
+    for i in 0..taps.len() {
+        taps[i].system_time = (i as u32) * 100;
+        taps[i].unix_time = i as u32;
+        taps[i].latitude_rad = Fixed::from_f32(lat_lon[i % lat_lon.len()].0).to_radians();
+        taps[i].longitude_rad = Fixed::from_f32(lat_lon[i % lat_lon.len()].1).to_radians();
+    }
+
+    logger.start_recording(&taps[0]);
+
+    for i in 0..(taps.len() - 1) {
+        logger.log(&taps[i], &taps[i + 1]);
+    }
+
+    assert_eq!(logger.pace_s, 10);
+}
-- 
2.30.2