Don't keep subsecond ticks

1 files changed, 3 insertions, 11 deletions

diff --git a/src/components/datetime/DateTimeController.cpp b/src/components/datetime/DateTimeController.cpp
index c297aa1..0dd5347 100644
--- a/src/components/datetime/DateTimeController.cpp
+++ b/src/components/datetime/DateTimeController.cpp
@@ -45,17 +45,9 @@ void DateTime::SetTime(
 
 void DateTime::UpdateTime(uint32_t systickCounter) {
   // Handle systick counter overflow
-  uint32_t systickDelta = (systickCounter - previousSystickCounter) & 0xffffff;
-  previousSystickCounter = systickCounter;
-
-  /*
-   * 1000 ms = 1024 ticks
-   */
-  // auto newSeconds = systickDelta >> 10;
-  // auto rest = systickDelta & ((1 << 10)-1);
-  subsecondTicks += systickDelta & ((1 << 10)-1);
-  systickDelta = (systickDelta >> 10) + (subsecondTicks >> 10);
-  subsecondTicks &= ((1 << 10)-1);
+  uint32_t systickDelta   = ( systickCounter - previousSystickCounter       ) & 0xffffff;
+  previousSystickCounter  = ( systickCounter - (systickDelta & ((1<<10)-1)) ) & 0xffffff;
+  systickDelta >>= 10;
 
   currentDateTime += std::chrono::seconds(systickDelta);
   uptime += std::chrono::seconds(systickDelta);