Hesu-eco
/
limiteur_vitesse
premiere ebauche
Diff: speedlimiter.cpp
- 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;