finished new encoder

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];