|
@ -1047,33 +1047,26 @@ void Temperature::init() { |
|
|
int heater_index = heater_id >= 0 ? heater_id : EXTRUDERS; |
|
|
int heater_index = heater_id >= 0 ? heater_id : EXTRUDERS; |
|
|
|
|
|
|
|
|
// If the target temperature changes, restart
|
|
|
// If the target temperature changes, restart
|
|
|
if (tr_target_temperature[heater_index] != target_temperature) |
|
|
if (tr_target_temperature[heater_index] != target_temperature) { |
|
|
*state = TRReset; |
|
|
tr_target_temperature[heater_index] = target_temperature; |
|
|
|
|
|
*state = target_temperature > 0 ? TRFirstHeating : TRInactive; |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
switch (*state) { |
|
|
switch (*state) { |
|
|
case TRReset: |
|
|
|
|
|
*timer = 0; |
|
|
|
|
|
*state = TRInactive; |
|
|
|
|
|
// Inactive state waits for a target temperature to be set
|
|
|
// Inactive state waits for a target temperature to be set
|
|
|
case TRInactive: |
|
|
case TRInactive: break; |
|
|
if (target_temperature > 0) { |
|
|
|
|
|
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
|
|
|
// When first heating, wait for the temperature to be reached then go to Stable state
|
|
|
case TRFirstHeating: |
|
|
case TRFirstHeating: |
|
|
if (temperature >= tr_target_temperature[heater_index]) *state = TRStable; |
|
|
if (temperature < tr_target_temperature[heater_index]) break; |
|
|
break; |
|
|
*state = TRStable; |
|
|
// While the temperature is stable watch for a bad temperature
|
|
|
// While the temperature is stable watch for a bad temperature
|
|
|
case TRStable: |
|
|
case TRStable: |
|
|
// If the temperature is over the target (-hysteresis) restart the timer
|
|
|
if (temperature < tr_target_temperature[heater_index] - hysteresis_degc && ELAPSED(millis(), *timer)) |
|
|
if (temperature >= tr_target_temperature[heater_index] - hysteresis_degc) |
|
|
|
|
|
*timer = millis(); |
|
|
|
|
|
// If the timer goes too long without a reset, trigger shutdown
|
|
|
|
|
|
else if (ELAPSED(millis(), *timer + period_seconds * 1000UL)) |
|
|
|
|
|
*state = TRRunaway; |
|
|
*state = TRRunaway; |
|
|
break; |
|
|
else { |
|
|
|
|
|
*timer = millis() + period_seconds * 1000UL; |
|
|
|
|
|
break; |
|
|
|
|
|
} |
|
|
case TRRunaway: |
|
|
case TRRunaway: |
|
|
_temp_error(heater_id, PSTR(MSG_T_THERMAL_RUNAWAY), PSTR(MSG_THERMAL_RUNAWAY)); |
|
|
_temp_error(heater_id, PSTR(MSG_T_THERMAL_RUNAWAY), PSTR(MSG_THERMAL_RUNAWAY)); |
|
|
} |
|
|
} |
|
|