Moved trip meter update to MotionController and changed trip meter logic

2021-10-21 23:37:35 -04:00
parent fb87fdb2d9
commit f7d1b3f368
3 changed files with 13 additions and 15 deletions
--- a/src/components/motion/MotionController.cpp
+++ b/src/components/motion/MotionController.cpp
@@ -14,7 +14,11 @@ void MotionController::Update(int16_t x, int16_t y, int16_t z, uint32_t nbSteps)
  this->x = x;
  this->y = y;
  this->z = z;
+  deltaSteps = nbSteps - this->nbSteps;
  this->nbSteps = nbSteps;
+  if(deltaSteps > 0){
+    currentTripSteps += deltaSteps;
+  }
 }

 bool MotionController::ShouldWakeUp(bool isSleeping) {