More thermal runaway states
This commit is contained in:
		| @@ -76,15 +76,14 @@ unsigned char soft_pwm_bed; | ||||
| #define HAS_HEATER_THERMAL_PROTECTION (defined(THERMAL_RUNAWAY_PROTECTION_PERIOD) && THERMAL_RUNAWAY_PROTECTION_PERIOD > 0) | ||||
| #define HAS_BED_THERMAL_PROTECTION (defined(THERMAL_RUNAWAY_PROTECTION_BED_PERIOD) && THERMAL_RUNAWAY_PROTECTION_BED_PERIOD > 0 && TEMP_SENSOR_BED != 0) | ||||
| #if HAS_HEATER_THERMAL_PROTECTION || HAS_BED_THERMAL_PROTECTION | ||||
|   enum TRState { TRInactive, TRFirstHeating, TRStable }; | ||||
|   static bool thermal_runaway = false; | ||||
|   enum TRState { TRReset, TRInactive, TRFirstHeating, TRStable, TRRunaway }; | ||||
|   void thermal_runaway_protection(TRState *state, unsigned long *timer, float temperature, float target_temperature, int heater_id, int period_seconds, int hysteresis_degc); | ||||
|   #if HAS_HEATER_THERMAL_PROTECTION | ||||
|     static TRState thermal_runaway_state_machine[4] = { TRInactive, TRInactive, TRInactive, TRInactive }; | ||||
|     static TRState thermal_runaway_state_machine[4] = { TRReset, TRReset, TRReset, TRReset }; | ||||
|     static unsigned long thermal_runaway_timer[4]; // = {0,0,0,0}; | ||||
|   #endif | ||||
|   #if HAS_BED_THERMAL_PROTECTION | ||||
|     static TRState thermal_runaway_bed_state_machine = TRInactive; | ||||
|     static TRState thermal_runaway_bed_state_machine = TRReset; | ||||
|     static unsigned long thermal_runaway_bed_timer; | ||||
|   #endif | ||||
| #endif | ||||
| @@ -1007,7 +1006,7 @@ void setWatch() { | ||||
|  | ||||
|   void thermal_runaway_protection(TRState *state, unsigned long *timer, float temperature, float target_temperature, int heater_id, int period_seconds, int hysteresis_degc) { | ||||
|  | ||||
|     static float tr_target_temperature[EXTRUDERS+1]; | ||||
|     static float tr_target_temperature[EXTRUDERS+1] = { 0.0 }; | ||||
|  | ||||
|     /* | ||||
|         SERIAL_ECHO_START; | ||||
| @@ -1023,20 +1022,23 @@ void setWatch() { | ||||
|         SERIAL_ECHOPGM(target_temperature); | ||||
|         SERIAL_EOL; | ||||
|     */ | ||||
|     if (target_temperature == 0 || thermal_runaway) { | ||||
|       *state = TRInactive; | ||||
|       *timer = 0; | ||||
|       return; | ||||
|     } | ||||
|  | ||||
|     // If the target temperature changes, restart | ||||
|     if (tr_target_temperature[heater_index] != target_temperature) | ||||
|       *state = TRReset; | ||||
|  | ||||
|     int heater_index = heater_id >= 0 ? heater_id : EXTRUDERS; | ||||
|  | ||||
|     switch (*state) { | ||||
|       case TRReset: | ||||
|         *timer = 0; | ||||
|         *state = TRInactive; | ||||
|         break; | ||||
|       // Inactive state waits for a target temperature to be set | ||||
|       case TRInactive: | ||||
|         if (target_temperature > 0) { | ||||
|           *state = TRFirstHeating; | ||||
|           tr_target_temperature[heater_index] = target_temperature; | ||||
|           *state = TRFirstHeating; | ||||
|         } | ||||
|         break; | ||||
|       // When first heating, wait for the temperature to be reached then go to Stable state | ||||
| @@ -1045,31 +1047,24 @@ void setWatch() { | ||||
|         break; | ||||
|       // While the temperature is stable watch for a bad temperature | ||||
|       case TRStable: | ||||
|       { | ||||
|         // If the target temperature changes, restart | ||||
|         if (tr_target_temperature[heater_index] != target_temperature) { | ||||
|           *state = TRInactive; | ||||
|           break; | ||||
|         } | ||||
|  | ||||
|         // If the temperature is over the target (-hysteresis) restart the timer | ||||
|         if (temperature >= tr_target_temperature[heater_index] - hysteresis_degc) { | ||||
|         if (temperature >= tr_target_temperature[heater_index] - hysteresis_degc) | ||||
|           *timer = millis(); | ||||
|         } // If the timer goes too long without a reset, trigger shutdown | ||||
|         else if (millis() > *timer + period_seconds * 1000UL) { | ||||
|           SERIAL_ERROR_START; | ||||
|           SERIAL_ERRORLNPGM(MSG_THERMAL_RUNAWAY_STOP); | ||||
|           if (heater_id < 0) SERIAL_ERRORLNPGM("bed"); else SERIAL_ERRORLN(heater_id); | ||||
|           LCD_ALERTMESSAGEPGM(MSG_THERMAL_RUNAWAY); | ||||
|           thermal_runaway = true; | ||||
|           disable_heater(); | ||||
|           disable_all_steppers(); | ||||
|           for (;;) { | ||||
|             manage_heater(); | ||||
|             lcd_update(); | ||||
|           } | ||||
|           // If the timer goes too long without a reset, trigger shutdown | ||||
|         else if (millis() > *timer + period_seconds * 1000UL) | ||||
|           *state = TRRunaway; | ||||
|         break; | ||||
|       case TRRunaway: | ||||
|         SERIAL_ERROR_START; | ||||
|         SERIAL_ERRORLNPGM(MSG_THERMAL_RUNAWAY_STOP); | ||||
|         if (heater_id < 0) SERIAL_ERRORLNPGM("bed"); else SERIAL_ERRORLN(heater_id); | ||||
|         LCD_ALERTMESSAGEPGM(MSG_THERMAL_RUNAWAY); | ||||
|         disable_heater(); | ||||
|         disable_all_steppers(); | ||||
|         for (;;) { | ||||
|           manage_heater(); | ||||
|           lcd_update(); | ||||
|         } | ||||
|       } break; | ||||
|     } | ||||
|   } | ||||
|  | ||||
|   | ||||
		Reference in New Issue
	
	Block a user