Moved trip meter update to MotionController and changed trip meter logic
This commit is contained in:
parent
fb87fdb2d9
commit
f7d1b3f368
3 changed files with 13 additions and 15 deletions
|
|
@ -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) {
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue