From 338f1f7615baaa33de3cb90ae0b3327d8547bc3e Mon Sep 17 00:00:00 2001
From: Alex Voinea <voinea.dragos.alexandru@gmail.com>
Date: Tue, 22 Feb 2022 15:26:11 +0100
Subject: [PATCH] IR volt debugging

---
 Firmware/Filament_sensor.h | 9 +++++++++
 1 file changed, 9 insertions(+)

diff --git a/Firmware/Filament_sensor.h b/Firmware/Filament_sensor.h
index 6cd1f7b66..9124f7186 100644
--- a/Firmware/Filament_sensor.h
+++ b/Firmware/Filament_sensor.h
@@ -3,6 +3,7 @@
 #include <inttypes.h>
 #include <stdio.h>
 #include <avr/pgmspace.h>
+#include <util/atomic.h>
 
 #include "Marlin.h"
 #include "ultralcd.h"
@@ -136,6 +137,14 @@ public:
     
     void update() {
         IR_sensor::update();
+        if (voltReady) {
+            uint16_t newVoltRaw;
+            ATOMIC_BLOCK(ATOMIC_RESTORESTATE) {
+                newVoltRaw = voltRaw;
+                voltReady = false;
+            }
+            printf_P(PSTR("newVoltRaw:%u\n"), newVoltRaw / OVERSAMPLENR);
+        }
         ;//
     }