firmware: correctly clear TSC interrupt when turned off

afilini · Aug 17, 2024 · 3db53fe · 3db53fe
1 parent 59c7a53
commit 3db53fe
Show file tree

Hide file tree

Showing 2 changed files with 10 additions and 7 deletions.
diff --git a/firmware/src/hw/tsc.rs b/firmware/src/hw/tsc.rs
@@ -62,6 +62,10 @@ where
         }
     }
 
+    pub fn clear_interrupt(&mut self) {
+        self.tsc.clear(hal::tsc::Event::EndOfAcquisition);
+    }
+
     pub fn perform_read(&self) -> bool {
         self.tsc.read_unchecked() < TSC_THRESHOLD
     }

diff --git a/firmware/src/main.rs b/firmware/src/main.rs
@@ -377,14 +377,13 @@ mod app {
 
     #[task(binds = TSC, local = [tsc])]
     fn tsc_interrupt(_cx: tsc_interrupt::Context) {
-        #[cfg(feature = "device")]
-        {
-            let (ref mut tsc, ref mut channel) = _cx.local.tsc;
+        let (ref mut tsc, ref mut channel) = _cx.local.tsc;
 
-            if tsc.is_enabled() {
-                let _ = channel.try_send(tsc.perform_read());
-                tsc.start_acquisition();
-            }
+        if tsc.is_enabled() {
+            let _ = channel.try_send(tsc.perform_read());
+            tsc.start_acquisition();
+        } else {
+            tsc.clear_interrupt();
         }
     }
 }