Fix minor bug in track recoil functionality.

OpenPanzerProject · Jan 27, 2020 · afcf9b1 · afcf9b1
1 parent d884c81
commit afcf9b1
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/OpenPanzerTCB/OpenPanzerTCB.ino b/OpenPanzerTCB/OpenPanzerTCB.ino
@@ -972,6 +972,8 @@ if (Startup)
                 if (DriveModeActual == TRACK_RECOIL && DriveSpeed == 0)
                 {
                     DriveModeActual = STOP;
+                    RightSpeed_Previous = 0;    // Force treads to update for next round
+                    LeftSpeed_Previous = 0;
                 }
             }
             else
@@ -1067,7 +1069,7 @@ if (Startup)
 
                     //Finally! We send the motor commands out to the motors, but only if something has changed since last time. 
                     if ((RightSpeed_Previous != RightSpeed) || (LeftSpeed_Previous != LeftSpeed))
-                    {
+                    {   
                         RightTread->setSpeed(RightSpeed);
                         LeftTread->setSpeed(LeftSpeed);
                         RightSpeed_Previous = RightSpeed;    // Save these for next time