Make running averaging optional.

[openparking.git] / firmware / firmware.c

diff --git a/firmware/firmware.c b/firmware/firmware.c
index c9c4317db1de3d1571498dde1ee45f975488aca4..5400714f48b10645dc196673493eb88d7a321871 100644 (file)
--- a/firmware/firmware.c
+++ b/firmware/firmware.c
@@ -5,9 +5,9 @@
 #include "clock.h"
 #include "modbus.h"
 
-#define ECHO_TIMEOUT           (CLOCK_HZ/20)   // 50 ms
-#define MEASUREMENT_WAIT       (4*ECHO_TIMEOUT)
-#define MEASUREMENT_SHIFT      2               // running avg (1 << M_SHIFT)
+#define ECHO_TIMEOUT           (CLOCK_HZ/10)   // 100 ms
+#define MEASUREMENT_WAIT       (2*ECHO_TIMEOUT)
+#define MEASUREMENT_SHIFT      0               // running avg (1 << M_SHIFT)
 
 #define N_TRIGGERS 3
 #define N_SENSORS 12
@@ -24,6 +24,7 @@
 #define distances      (hold_regs+MB_N_HOLD_REGS_EEPROM+1)
 #define free_bitmap    (hold_regs[MB_N_HOLD_REGS_EEPROM+13])
 #define err_bitmap     (hold_regs[MB_N_HOLD_REGS_EEPROM+14])
+#define max_distances  (hold_regs+MB_N_HOLD_REGS_EEPROM+21)
 
 static void pull_trigger(uint8_t trig)
 {
@@ -71,11 +72,18 @@ static void do_measurement(unsigned char trig)
                                to_start &= ~mask;
                                to_measure |= mask;
                        } else if ((to_measure & mask) && !(bits & mask)) {
-                               uint16_t old_d, new_d;
+#if MEASUREMENT_SHIFT > 0
+                               uint16_t old_d;
+#endif
+                               uint16_t new_d;
                                uint8_t idx = trig*N_TRIG_SENSORS+i;
                                // echo end
                                to_measure &= ~mask;
                                new_d = now - starttimes[i];
+                               if (new_d > max_distances[idx])
+                                       max_distances[idx] = new_d;
+
+#if MEASUREMENT_SHIFT > 0
                                old_d = distances[idx];
 
                                if (old_d == 0
@@ -88,6 +96,9 @@ static void do_measurement(unsigned char trig)
                                                - old_d
                                                ) >> MEASUREMENT_SHIFT;
                                }
+#else
+                               distances[idx] = new_d;
+#endif
                        }
                }
        }