state-handler: fix auto mode

2022-10-27 16:33:36 +03:00
parent 58dbbf0f06
commit fa8734a9a8
5 changed files with 34 additions and 7 deletions
--- a/esp-vent-main/src/Timer.cpp
+++ b/esp-vent-main/src/Timer.cpp
@@ -28,6 +28,7 @@ Timer::Timer (uint32_t freq, bool setup) : freq (freq), mode (setup)
    }
  resetCounter ();
  timer = 0;
+  prev_ticks = 0;
  systicks.store (0, std::memory_order_relaxed);
 }

@@ -43,8 +44,9 @@ Timer::tickCounter (int ms)
    {
      resetCounter ();
    }
-  counter.fetch_add (ms, std::memory_order_relaxed);
  Sleep (ms);
+  counter += (systicks - prev_ticks);
+  prev_ticks = systicks;
 }

 void