@ -1,5 +1,5 @@
/*
temperature . c - temperature control
temperature . cpp - temperature control
Part of Marlin
Copyright ( C ) 2011 Camiel Gubbels / Erik van der Zalm
@ -16,18 +16,7 @@
You should have received a copy of the GNU General Public License
along with this program . If not , see < http : //www.gnu.org/licenses/>.
*/
/*
This firmware is a mashup between Sprinter and grbl .
( https : //github.com/kliment/Sprinter)
( https : //github.com/simen/grbl/tree)
It has preliminary support for Matthew Roberts advance algorithm
http : //reprap.org/pipermail/reprap-dev/2011-May/003323.html
*/
*/
# include "Marlin.h"
# include "ultralcd.h"
@ -87,14 +76,15 @@ 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 ;
void thermal_runaway_protection ( int * state , unsigned long * timer , float temperature , float target_temperature , int heater_id , int period_seconds , int hysteresis_degc ) ;
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 int thermal_runaway_state_machine [ 4 ] ; // = {0,0,0,0};
static TRState thermal_runaway_state_machine [ 4 ] = { TRInactive , TRInactive , TRInactive , TRInactive } ;
static unsigned long thermal_runaway_timer [ 4 ] ; // = {0,0,0,0};
# endif
# if HAS_BED_THERMAL_PROTECTION
static int thermal_runaway_bed_state_machine ;
static TRState thermal_runaway_bed_state_machine = { TRInactive , TRInactive , TRInactive , TRInactive } ;
static unsigned long thermal_runaway_bed_timer ;
# endif
# endif
@ -238,7 +228,7 @@ void PID_autotune(float temp, int extruder, int ncycles)
soft_pwm [ extruder ] = bias = d = PID_MAX / 2 ;
// PID Tuning loop
for ( ; ; ) {
for ( ; ; ) {
unsigned long ms = millis ( ) ;
@ -609,7 +599,7 @@ void manage_heater() {
// Loop through all extruders
for ( int e = 0 ; e < EXTRUDERS ; e + + ) {
# if defined (THERMAL_RUNAWAY_PROTECTION_PERIOD) && THERMAL_RUNAWAY_PROTECTION_PERIOD > 0
# if HAS_HEATER_THERMAL_PROTECTION
thermal_runaway_protection ( & thermal_runaway_state_machine [ e ] , & thermal_runaway_timer [ e ] , current_temperature [ e ] , target_temperature [ e ] , e , THERMAL_RUNAWAY_PROTECTION_PERIOD , THERMAL_RUNAWAY_PROTECTION_HYSTERESIS ) ;
# endif
@ -637,7 +627,7 @@ void manage_heater() {
disable_heater ( ) ;
_temp_error ( 0 , PSTR ( MSG_EXTRUDER_SWITCHED_OFF ) , PSTR ( MSG_ERR_REDUNDANT_TEMP ) ) ;
}
# endif //TEMP_SENSOR_1_AS_REDUNDANT
# endif // TEMP_SENSOR_1_AS_REDUNDANT
} // Extruders Loop
@ -1014,69 +1004,69 @@ void setWatch() {
}
# if HAS_HEATER_THERMAL_PROTECTION || HAS_BED_THERMAL_PROTECTION
void thermal_runaway_protection ( int * state , unsigned long * timer , float temperature , float target_temperature , int heater_id , int period_seconds , int hysteresis_degc )
{
/*
SERIAL_ECHO_START ;
SERIAL_ECHO ( " Thermal Thermal Runaway Running. Heater ID: " ) ;
SERIAL_ECHO ( heater_id ) ;
SERIAL_ECHO ( " ; State: " ) ;
SERIAL_ECHO ( * state ) ;
SERIAL_ECHO ( " ; Timer: " ) ;
SERIAL_ECHO ( * timer ) ;
SERIAL_ECHO ( " ; Temperature: " ) ;
SERIAL_ECHO ( temperature ) ;
SERIAL_ECHO ( " ; Target Temp: " ) ;
SERIAL_ECHO ( target_temperature ) ;
SERIAL_ECHOLN ( " " ) ;
*/
if ( ( target_temperature = = 0 ) | | thermal_runaway )
{
* state = 0 ;
* timer = 0 ;
return ;
}
switch ( * state )
{
case 0 : // "Heater Inactive" state
if ( target_temperature > 0 ) * state = 1 ;
break ;
case 1 : // "First Heating" state
if ( temperature > = target_temperature ) * state = 2 ;
break ;
case 2 : // "Temperature Stable" state
{
unsigned long ms = millis ( ) ;
if ( temperature > = ( target_temperature - hysteresis_degc ) )
{
* timer = ms ;
}
else if ( ( ms - * timer ) > ( ( unsigned long ) period_seconds ) * 1000 )
void thermal_runaway_protection ( TRState * state , unsigned long * timer , float temperature , float target_temperature , int heater_id , int period_seconds , int hysteresis_degc ) {
/*
SERIAL_ECHO_START ;
SERIAL_ECHO ( " Thermal Thermal Runaway Running. Heater ID: " ) ;
SERIAL_ECHO ( heater_id ) ;
SERIAL_ECHO ( " ; State: " ) ;
SERIAL_ECHO ( * state ) ;
SERIAL_ECHO ( " ; Timer: " ) ;
SERIAL_ECHO ( * timer ) ;
SERIAL_ECHO ( " ; Temperature: " ) ;
SERIAL_ECHO ( temperature ) ;
SERIAL_ECHO ( " ; Target Temp: " ) ;
SERIAL_ECHO ( target_temperature ) ;
SERIAL_ECHOLN ( " " ) ;
*/
if ( target_temperature = = 0 | | thermal_runaway ) {
* state = TRInactive ;
* timer = 0 ;
return ;
}
switch ( * state ) {
// Inactive state waits for a target temperature, then
case TRInactive :
if ( target_temperature > 0 ) * state = TRFirstHeating ;
break ;
// When first heating, wait for the temperature to be reached then go to Stable state
case TRFirstHeating :
if ( temperature > = target_temperature ) * state = TRStable ;
break ;
// While the temperature is stable watch for a bad temperature
case TRStable :
{
SERIAL_ERROR_START ;
SERIAL_ERRORLNPGM ( MSG_THERMAL_RUNAWAY_STOP ) ;
SERIAL_ERRORLN ( ( int ) heater_id ) ;
LCD_ALERTMESSAGEPGM ( MSG_THERMAL_RUNAWAY ) ; // translatable
thermal_runaway = true ;
while ( 1 )
{
disable_heater ( ) ;
disable_x ( ) ;
disable_y ( ) ;
disable_z ( ) ;
disable_e0 ( ) ;
disable_e1 ( ) ;
disable_e2 ( ) ;
disable_e3 ( ) ;
manage_heater ( ) ;
lcd_update ( ) ;
// Whenever the current temperature is over the target (-hysteresis) restart the timer
if ( temperature > = target_temperature - hysteresis_degc ) {
* timer = millis ( ) ;
}
}
} break ;
// 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 ) ;
SERIAL_ERRORLN ( ( int ) heater_id ) ;
LCD_ALERTMESSAGEPGM ( MSG_THERMAL_RUNAWAY ) ;
thermal_runaway = true ;
for ( ; ; ) {
disable_heater ( ) ;
disable_x ( ) ;
disable_y ( ) ;
disable_z ( ) ;
disable_e0 ( ) ;
disable_e1 ( ) ;
disable_e2 ( ) ;
disable_e3 ( ) ;
manage_heater ( ) ;
lcd_update ( ) ;
}
}
} break ;
}
}
}
# endif //THERMAL_RUNAWAY_PROTECTION_PERIOD
# endif // HAS_HEATER_THERMAL_PROTECTION
void disable_heater ( ) {
for ( int i = 0 ; i < EXTRUDERS ; i + + ) setTargetHotend ( 0 , i ) ;
Scott Lahteine
10 years ago