From 90b78616b7a8da92ee5b0600e8ac682ac5267d49 Mon Sep 17 00:00:00 2001
From: Alex Voinea <voinea.dragos.alexandru@gmail.com>
Date: Fri, 25 Feb 2022 08:18:10 +0100
Subject: [PATCH] Fix reinit on error

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

diff --git a/Firmware/Filament_sensor.h b/Firmware/Filament_sensor.h
index 5f6f360f7..8718725b7 100644
--- a/Firmware/Filament_sensor.h
+++ b/Firmware/Filament_sensor.h
@@ -187,6 +187,9 @@ protected:
 class IR_sensor: public Filament_sensor {
 public:
     void init() {
+        if (state == State::error) {
+            deinit(); //deinit first if there was an error.
+        }
         puts_P(PSTR("fsensor::init()"));
         SET_INPUT(IR_SENSOR_PIN); //input mode
         WRITE(IR_SENSOR_PIN, 1); //pullup