Fix: The argument to LowPower.idle(millis) has absolutely no effect. a…

…rduino-libraries#39
be-philippe · Feb 22, 2021 · 0531915 · 0531915
1 parent d701922
commit 0531915
Showing 1 changed file with 14 additions and 3 deletions.
diff --git a/src/samd/ArduinoLowPower.cpp b/src/samd/ArduinoLowPower.cpp
@@ -30,9 +30,20 @@ void ArduinoLowPowerClass::idle() {
 	__WFI();
 }
 
-void ArduinoLowPowerClass::idle(uint32_t millis) {
-	setAlarmIn(millis);
-	idle();
+void ArduinoLowPowerClass::idle(uint32_t delay)
+{
+  uint32_t ticks = delay;
+  while (ticks > 0)
+  {
+    uint32_t lastMillis = millis();
+    idle();
+    uint32_t delta = millis() - lastMillis;
+    if (delta > ticks) {
+      ticks = 0;
+    } else {
+      ticks -= delta;
+    }
+  }
 }
 
 void ArduinoLowPowerClass::sleep() {