Merge pull request #89 from Open-STEM/setspeedfixes

Clear speed controller history when set_speed is 0

Author: KalticCodes

XRPLib/encoded_motor.py

@@ -173,6 +173,7 @@ def set_speed(self, speed_rpm: float = None):
         if speed_rpm is None or speed_rpm == 0:
             self.target_speed = None
             self.set_effort(0)
+            self.speedController.clear_history()
             return
         # Convert from rev per min to counts per 20ms (60 sec/min, 50 Hz)
         self.target_speed = speed_rpm*self._encoder.resolution/(60*50)