premiere ebauche

Dependencies:   mbed PinDetect

Revision:
9:3e8bb4aba7c7
Parent:
8:51549d7108dd
Child:
10:f0b382368614
--- a/speedlimiter.cpp	Tue Nov 06 22:07:05 2018 +0000
+++ b/speedlimiter.cpp	Tue Nov 06 22:36:18 2018 +0000
@@ -10,7 +10,10 @@
 
 float getNextReferenceSpeed() {
     static int index = 0;
-    return valeursVitessesRecommandes[index++];
+    float val = valeursVitessesRecommandes[index++];
+    if (index >= 20)
+        index = 0;
+    return val;
 }
 
 
@@ -127,7 +130,8 @@
 
     // calculs
     double Vm = getMeasuredSpeed();
-    double Vd = 20;
+    double Vd = getReferenceSpeed();
+    //double Vd = 20;
     double out = 0.0;
     if (readAdcPedalHi() > 1) {
         double e = Vd - Vm;