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);
+        }
         ;//
     }