finished new encoder

src/SpecialMenus/driveModi/TestMode/speedometerTest.cpp

@@ -13,6 +13,7 @@
 
 SpeedometerTest::SpeedometerTest(Speedometer* speedometer) {
     this->speedometer = speedometer;
+    this->speedometer->setDirection(Speedometer::Forward);
 }
 
 

src/moveControl.cpp

@@ -60,6 +60,10 @@ void MoveControl::loop() {
         ||  left_speed_time > 50
         ||  right_speed_time > 50) {
 
+        // Dont count overTimeCounter if one speedometer is in TestMode.
+        if (left_speed_time == UINT16_MAX || right_speed_time == UINT16_MAX)
+            this->overTimeCounter--;
+
         this->overTimeCounter++;
         if (this->overTimeCounter >= this->overTimeMax) {
             char buf[128];