Fix SYSTIMER time driver

esp-rs · May 29, 2024 · c39a587 · c39a587
1 parent 46c3d3e
commit c39a587
Showing 1 changed file with 5 additions and 3 deletions.
diff --git a/esp-hal-embassy/src/time_driver/systimer.rs b/esp-hal-embassy/src/time_driver/systimer.rs
@@ -125,10 +125,12 @@ impl EmbassyTimer {
     }
 
     fn arm(&self, id: usize, timestamp: u64) {
+        let now = SystemTimer::now();
+
         match id {
-            0 => unwrap!(self.alarm0.load_value(timestamp.micros())),
-            1 => unwrap!(self.alarm1.load_value(timestamp.micros())),
-            2 => unwrap!(self.alarm2.load_value(timestamp.micros())),
+            0 => unwrap!(self.alarm0.load_value(timestamp.micros() - now)),
+            1 => unwrap!(self.alarm1.load_value(timestamp.micros() - now)),
+            2 => unwrap!(self.alarm2.load_value(timestamp.micros() - now)),
             _ => {}
         }
     }