Improve and simplify algorithm

FintasticMan · FintasticMan · commit 5269885b572c · 2021-12-13T09:32:31.000+01:00
diff --git a/src/components/motion/MotionController.cpp b/src/components/motion/MotionController.cpp
@@ -40,17 +40,14 @@ bool MotionController::ShouldWakeUp(bool isSleeping) {
   return false;
 }
 bool MotionController::ShouldSleep(bool isSleeping) {
-  if (not isSleeping) {
-    if (y <= 0) {
-      lastYForSleep = 0;
-      return false;
-    }
-    if (y - 230 > lastYForSleep) {
-      lastYForSleep = y;
-      return true;
-    }
-  }
-  return false;
+  bool ret = false;
+
+  if (y >= lastYForSleep + 192 && !isSleeping)
+    ret = true;
+
+  lastYForSleep = (y > 320) ? y : 320;
+
+  return ret;
 }
 
 void MotionController::IsSensorOk(bool isOk) {
