Fixed up some of the testing code.

Author: finnkuusisto

Devlpr.cpp

@@ -24,7 +24,6 @@ void Devlpr::tick()
         // NOTE do we want to do some sort of remainder on
         // NOTE the micros - ie do we want to play catch up
         // NOTE or just make a best effort to run on sched?
-        dummy = lastValueFiltered();
     }
     // just pretend no time has passed since function start
     lastTickMicros = currMicros;

Devlpr.h

@@ -11,7 +11,6 @@ class Devlpr
         int lastValue();
         float lastValueFiltered();
         float windowAvg();
-        float dummy;
     private:
         // general buffer bookkeeping
         static const byte BUFSIZE = 155; // size of filter

libdevlpr.ino

@@ -6,6 +6,25 @@ void setup() {
     Serial.begin(9600);
 }
 
+unsigned long microsSinceFilteredCall = 0;
+unsigned long prevLoopMicros = 0;
+float result = 0.0;
 void loop() {
+    // let the DEVLPR library do its job
     devlpr.tick();
+
+    // try to sample filtered data at 1000Hz
+    unsigned long currMicros = micros();
+    unsigned long microsDelta = currMicros - prevLoopMicros;
+    microsSinceFilteredCall += microsDelta;
+    // has 1ms passed
+    if (microsSinceFilteredCall > 1000) {
+        // 1ms has passed, get the value
+        result = devlpr.lastValueFiltered();
+        Serial.println(result);
+        // update our last filtered call
+        microsSinceFilteredCall = 0;
+    }
+    // update our last loop time
+    prevLoopMicros = currMicros;
 }