|
|
|
@ -21,24 +21,8 @@ |
|
|
|
*/ |
|
|
|
|
|
|
|
/**
|
|
|
|
temperature.cpp - temperature control |
|
|
|
Part of Marlin |
|
|
|
|
|
|
|
Copyright (C) 2011 Camiel Gubbels / Erik van der Zalm |
|
|
|
|
|
|
|
This program is free software: you can redistribute it and/or modify |
|
|
|
it under the terms of the GNU General Public License as published by |
|
|
|
the Free Software Foundation, either version 3 of the License, or |
|
|
|
(at your option) any later version. |
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful, |
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of |
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|
|
|
GNU General Public License for more details. |
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License |
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/ |
|
|
|
* temperature.cpp - temperature control |
|
|
|
*/ |
|
|
|
|
|
|
|
#include "Marlin.h" |
|
|
|
#include "ultralcd.h" |
|
|
|
@ -50,144 +34,10 @@ |
|
|
|
#include "watchdog.h" |
|
|
|
#endif |
|
|
|
|
|
|
|
//===========================================================================
|
|
|
|
//================================== macros =================================
|
|
|
|
//===========================================================================
|
|
|
|
|
|
|
|
#ifdef K1 // Defined in Configuration.h in the PID settings
|
|
|
|
#define K2 (1.0-K1) |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(PIDTEMPBED) || ENABLED(PIDTEMP) |
|
|
|
#define PID_dT ((OVERSAMPLENR * 12.0)/(F_CPU / 64.0 / 256.0)) |
|
|
|
#endif |
|
|
|
|
|
|
|
//===========================================================================
|
|
|
|
//============================= public variables ============================
|
|
|
|
//===========================================================================
|
|
|
|
|
|
|
|
int target_temperature[4] = { 0 }; |
|
|
|
int target_temperature_bed = 0; |
|
|
|
int current_temperature_raw[4] = { 0 }; |
|
|
|
float current_temperature[4] = { 0.0 }; |
|
|
|
int current_temperature_bed_raw = 0; |
|
|
|
float current_temperature_bed = 0.0; |
|
|
|
#if ENABLED(TEMP_SENSOR_1_AS_REDUNDANT) |
|
|
|
int redundant_temperature_raw = 0; |
|
|
|
float redundant_temperature = 0.0; |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(PIDTEMPBED) |
|
|
|
float bedKp = DEFAULT_bedKp; |
|
|
|
float bedKi = (DEFAULT_bedKi* PID_dT); |
|
|
|
float bedKd = (DEFAULT_bedKd / PID_dT); |
|
|
|
#endif //PIDTEMPBED
|
|
|
|
|
|
|
|
#if ENABLED(FAN_SOFT_PWM) |
|
|
|
unsigned char fanSpeedSoftPwm[FAN_COUNT]; |
|
|
|
#endif |
|
|
|
|
|
|
|
unsigned char soft_pwm_bed; |
|
|
|
|
|
|
|
#if ENABLED(BABYSTEPPING) |
|
|
|
volatile int babystepsTodo[3] = { 0 }; |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(FILAMENT_WIDTH_SENSOR) |
|
|
|
int current_raw_filwidth = 0; //Holds measured filament diameter - one extruder only
|
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(THERMAL_PROTECTION_HOTENDS) || ENABLED(THERMAL_PROTECTION_BED) |
|
|
|
enum TRState { TRReset, TRInactive, TRFirstHeating, TRStable, TRRunaway }; |
|
|
|
void thermal_runaway_protection(TRState* state, millis_t* timer, float temperature, float target_temperature, int heater_id, int period_seconds, int hysteresis_degc); |
|
|
|
#if ENABLED(THERMAL_PROTECTION_HOTENDS) |
|
|
|
static TRState thermal_runaway_state_machine[4] = { TRReset, TRReset, TRReset, TRReset }; |
|
|
|
static millis_t thermal_runaway_timer[4]; // = {0,0,0,0};
|
|
|
|
#endif |
|
|
|
#if ENABLED(THERMAL_PROTECTION_BED) && TEMP_SENSOR_BED != 0 |
|
|
|
static TRState thermal_runaway_bed_state_machine = TRReset; |
|
|
|
static millis_t thermal_runaway_bed_timer; |
|
|
|
#endif |
|
|
|
#endif |
|
|
|
|
|
|
|
//===========================================================================
|
|
|
|
//============================ private variables ============================
|
|
|
|
//===========================================================================
|
|
|
|
|
|
|
|
static volatile bool temp_meas_ready = false; |
|
|
|
|
|
|
|
#if ENABLED(PIDTEMP) |
|
|
|
//static cannot be external:
|
|
|
|
static float temp_iState[EXTRUDERS] = { 0 }; |
|
|
|
static float temp_dState[EXTRUDERS] = { 0 }; |
|
|
|
static float pTerm[EXTRUDERS]; |
|
|
|
static float iTerm[EXTRUDERS]; |
|
|
|
static float dTerm[EXTRUDERS]; |
|
|
|
#if ENABLED(PID_ADD_EXTRUSION_RATE) |
|
|
|
static float cTerm[EXTRUDERS]; |
|
|
|
static long last_position[EXTRUDERS]; |
|
|
|
static long lpq[LPQ_MAX_LEN]; |
|
|
|
static int lpq_ptr = 0; |
|
|
|
#endif |
|
|
|
//int output;
|
|
|
|
static float pid_error[EXTRUDERS]; |
|
|
|
static float temp_iState_min[EXTRUDERS]; |
|
|
|
static float temp_iState_max[EXTRUDERS]; |
|
|
|
static bool pid_reset[EXTRUDERS]; |
|
|
|
#endif //PIDTEMP
|
|
|
|
#if ENABLED(PIDTEMPBED) |
|
|
|
//static cannot be external:
|
|
|
|
static float temp_iState_bed = { 0 }; |
|
|
|
static float temp_dState_bed = { 0 }; |
|
|
|
static float pTerm_bed; |
|
|
|
static float iTerm_bed; |
|
|
|
static float dTerm_bed; |
|
|
|
//int output;
|
|
|
|
static float pid_error_bed; |
|
|
|
static float temp_iState_min_bed; |
|
|
|
static float temp_iState_max_bed; |
|
|
|
#else //PIDTEMPBED
|
|
|
|
static millis_t next_bed_check_ms; |
|
|
|
#endif //PIDTEMPBED
|
|
|
|
static unsigned char soft_pwm[EXTRUDERS]; |
|
|
|
|
|
|
|
#if ENABLED(FAN_SOFT_PWM) |
|
|
|
static unsigned char soft_pwm_fan[FAN_COUNT]; |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN |
|
|
|
static millis_t next_auto_fan_check_ms; |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(PIDTEMP) |
|
|
|
#if ENABLED(PID_PARAMS_PER_EXTRUDER) |
|
|
|
float Kp[EXTRUDERS] = ARRAY_BY_EXTRUDERS1(DEFAULT_Kp); |
|
|
|
float Ki[EXTRUDERS] = ARRAY_BY_EXTRUDERS1((DEFAULT_Ki) * (PID_dT)); |
|
|
|
float Kd[EXTRUDERS] = ARRAY_BY_EXTRUDERS1((DEFAULT_Kd) / (PID_dT)); |
|
|
|
#if ENABLED(PID_ADD_EXTRUSION_RATE) |
|
|
|
float Kc[EXTRUDERS] = ARRAY_BY_EXTRUDERS1(DEFAULT_Kc); |
|
|
|
#endif // PID_ADD_EXTRUSION_RATE
|
|
|
|
#else //PID_PARAMS_PER_EXTRUDER
|
|
|
|
float Kp = DEFAULT_Kp; |
|
|
|
float Ki = (DEFAULT_Ki) * (PID_dT); |
|
|
|
float Kd = (DEFAULT_Kd) / (PID_dT); |
|
|
|
#if ENABLED(PID_ADD_EXTRUSION_RATE) |
|
|
|
float Kc = DEFAULT_Kc; |
|
|
|
#endif // PID_ADD_EXTRUSION_RATE
|
|
|
|
#endif // PID_PARAMS_PER_EXTRUDER
|
|
|
|
#endif //PIDTEMP
|
|
|
|
|
|
|
|
// Init min and max temp with extreme values to prevent false errors during startup
|
|
|
|
static int minttemp_raw[EXTRUDERS] = ARRAY_BY_EXTRUDERS(HEATER_0_RAW_LO_TEMP , HEATER_1_RAW_LO_TEMP , HEATER_2_RAW_LO_TEMP, HEATER_3_RAW_LO_TEMP); |
|
|
|
static int maxttemp_raw[EXTRUDERS] = ARRAY_BY_EXTRUDERS(HEATER_0_RAW_HI_TEMP , HEATER_1_RAW_HI_TEMP , HEATER_2_RAW_HI_TEMP, HEATER_3_RAW_HI_TEMP); |
|
|
|
static int minttemp[EXTRUDERS] = { 0 }; |
|
|
|
static int maxttemp[EXTRUDERS] = ARRAY_BY_EXTRUDERS1(16383); |
|
|
|
#ifdef BED_MINTEMP |
|
|
|
static int bed_minttemp_raw = HEATER_BED_RAW_LO_TEMP; |
|
|
|
#endif |
|
|
|
#ifdef BED_MAXTEMP |
|
|
|
static int bed_maxttemp_raw = HEATER_BED_RAW_HI_TEMP; |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(TEMP_SENSOR_1_AS_REDUNDANT) |
|
|
|
static void* heater_ttbl_map[2] = {(void*)HEATER_0_TEMPTABLE, (void*)HEATER_1_TEMPTABLE }; |
|
|
|
static uint8_t heater_ttbllen_map[2] = { HEATER_0_TEMPTABLE_LEN, HEATER_1_TEMPTABLE_LEN }; |
|
|
|
@ -196,39 +46,11 @@ static int maxttemp[EXTRUDERS] = ARRAY_BY_EXTRUDERS1(16383); |
|
|
|
static uint8_t heater_ttbllen_map[EXTRUDERS] = ARRAY_BY_EXTRUDERS(HEATER_0_TEMPTABLE_LEN, HEATER_1_TEMPTABLE_LEN, HEATER_2_TEMPTABLE_LEN, HEATER_3_TEMPTABLE_LEN); |
|
|
|
#endif |
|
|
|
|
|
|
|
static float analog2temp(int raw, uint8_t e); |
|
|
|
static float analog2tempBed(int raw); |
|
|
|
static void updateTemperaturesFromRawValues(); |
|
|
|
|
|
|
|
#if ENABLED(THERMAL_PROTECTION_HOTENDS) && WATCH_TEMP_PERIOD > 0 |
|
|
|
int watch_target_temp[EXTRUDERS] = { 0 }; |
|
|
|
millis_t watch_heater_next_ms[EXTRUDERS] = { 0 }; |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(THERMAL_PROTECTION_BED) && WATCH_BED_TEMP_PERIOD > 0 |
|
|
|
int watch_target_bed_temp = 0; |
|
|
|
millis_t watch_bed_next_ms = 0; |
|
|
|
#endif |
|
|
|
|
|
|
|
#ifndef SOFT_PWM_SCALE |
|
|
|
#define SOFT_PWM_SCALE 0 |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(FILAMENT_WIDTH_SENSOR) |
|
|
|
static int meas_shift_index; //used to point to a delayed sample in buffer for filament width sensor
|
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(HEATER_0_USES_MAX6675) |
|
|
|
static int read_max6675(); |
|
|
|
#endif |
|
|
|
|
|
|
|
//===========================================================================
|
|
|
|
//================================ Functions ================================
|
|
|
|
//===========================================================================
|
|
|
|
Temperature thermalManager; |
|
|
|
|
|
|
|
#if HAS_PID_HEATING |
|
|
|
|
|
|
|
void PID_autotune(float temp, int extruder, int ncycles, bool set_result/*=false*/) { |
|
|
|
void Temperature::PID_autotune(float temp, int extruder, int ncycles, bool set_result/*=false*/) { |
|
|
|
float input = 0.0; |
|
|
|
int cycles = 0; |
|
|
|
bool heating = true; |
|
|
|
@ -242,7 +64,7 @@ static void updateTemperaturesFromRawValues(); |
|
|
|
float max = 0, min = 10000; |
|
|
|
|
|
|
|
#if HAS_AUTO_FAN |
|
|
|
millis_t next_auto_fan_check_ms = temp_ms + 2500UL; |
|
|
|
next_auto_fan_check_ms = temp_ms + 2500UL; |
|
|
|
#endif |
|
|
|
|
|
|
|
if (false |
|
|
|
@ -459,9 +281,37 @@ static void updateTemperaturesFromRawValues(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
#endif // PIDTEMP
|
|
|
|
#endif // HAS_PID_HEATING
|
|
|
|
|
|
|
|
#if ENABLED(PIDTEMP) |
|
|
|
|
|
|
|
#if ENABLED(PID_PARAMS_PER_EXTRUDER) |
|
|
|
|
|
|
|
float Temperature::Kp[EXTRUDERS] = ARRAY_BY_EXTRUDERS1(DEFAULT_Kp), |
|
|
|
Temperature::Ki[EXTRUDERS] = ARRAY_BY_EXTRUDERS1((DEFAULT_Ki) * (PID_dT)), |
|
|
|
Temperature::Kd[EXTRUDERS] = ARRAY_BY_EXTRUDERS1((DEFAULT_Kd) / (PID_dT)); |
|
|
|
|
|
|
|
void updatePID() { |
|
|
|
#if ENABLED(PID_ADD_EXTRUSION_RATE) |
|
|
|
float Temperature::Kc[EXTRUDERS] = ARRAY_BY_EXTRUDERS1(DEFAULT_Kc); |
|
|
|
#endif |
|
|
|
|
|
|
|
#else |
|
|
|
|
|
|
|
float Temperature::Kp = DEFAULT_Kp, |
|
|
|
Temperature::Ki = (DEFAULT_Ki) * (PID_dT), |
|
|
|
Temperature::Kd = (DEFAULT_Kd) / (PID_dT); |
|
|
|
|
|
|
|
#if ENABLED(PID_ADD_EXTRUSION_RATE) |
|
|
|
float Temperature::Kc = DEFAULT_Kc; |
|
|
|
#endif |
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
Temperature::Temperature() { } |
|
|
|
|
|
|
|
void Temperature::updatePID() { |
|
|
|
#if ENABLED(PIDTEMP) |
|
|
|
for (int e = 0; e < EXTRUDERS; e++) { |
|
|
|
temp_iState_max[e] = (PID_INTEGRAL_DRIVE_MAX) / PID_PARAM(Ki, e); |
|
|
|
@ -475,85 +325,41 @@ void updatePID() { |
|
|
|
#endif |
|
|
|
} |
|
|
|
|
|
|
|
int getHeaterPower(int heater) { |
|
|
|
int Temperature::getHeaterPower(int heater) { |
|
|
|
return heater < 0 ? soft_pwm_bed : soft_pwm[heater]; |
|
|
|
} |
|
|
|
|
|
|
|
#if HAS_AUTO_FAN |
|
|
|
|
|
|
|
void setExtruderAutoFanState(int pin, bool state) { |
|
|
|
unsigned char newFanSpeed = (state != 0) ? EXTRUDER_AUTO_FAN_SPEED : 0; |
|
|
|
// this idiom allows both digital and PWM fan outputs (see M42 handling).
|
|
|
|
digitalWrite(pin, newFanSpeed); |
|
|
|
analogWrite(pin, newFanSpeed); |
|
|
|
} |
|
|
|
|
|
|
|
void checkExtruderAutoFans() { |
|
|
|
uint8_t fanState = 0; |
|
|
|
|
|
|
|
// which fan pins need to be turned on?
|
|
|
|
#if HAS_AUTO_FAN_0 |
|
|
|
if (current_temperature[0] > EXTRUDER_AUTO_FAN_TEMPERATURE) |
|
|
|
fanState |= 1; |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN_1 |
|
|
|
if (current_temperature[1] > EXTRUDER_AUTO_FAN_TEMPERATURE) { |
|
|
|
if (EXTRUDER_1_AUTO_FAN_PIN == EXTRUDER_0_AUTO_FAN_PIN) |
|
|
|
fanState |= 1; |
|
|
|
else |
|
|
|
fanState |= 2; |
|
|
|
void Temperature::checkExtruderAutoFans() { |
|
|
|
const uint8_t fanPin[] = { EXTRUDER_0_AUTO_FAN_PIN, EXTRUDER_1_AUTO_FAN_PIN, EXTRUDER_2_AUTO_FAN_PIN, EXTRUDER_3_AUTO_FAN_PIN }; |
|
|
|
const int fanBit[] = { 0, |
|
|
|
EXTRUDER_1_AUTO_FAN_PIN == EXTRUDER_0_AUTO_FAN_PIN ? 0 : 1, |
|
|
|
EXTRUDER_2_AUTO_FAN_PIN == EXTRUDER_0_AUTO_FAN_PIN ? 0 : |
|
|
|
EXTRUDER_2_AUTO_FAN_PIN == EXTRUDER_1_AUTO_FAN_PIN ? 1 : 2, |
|
|
|
EXTRUDER_3_AUTO_FAN_PIN == EXTRUDER_0_AUTO_FAN_PIN ? 0 : |
|
|
|
EXTRUDER_3_AUTO_FAN_PIN == EXTRUDER_1_AUTO_FAN_PIN ? 1 : |
|
|
|
EXTRUDER_3_AUTO_FAN_PIN == EXTRUDER_2_AUTO_FAN_PIN ? 2 : 3 |
|
|
|
}; |
|
|
|
uint8_t fanState = 0; |
|
|
|
for (int f = 0; f <= 3; f++) { |
|
|
|
if (current_temperature[f] > EXTRUDER_AUTO_FAN_TEMPERATURE) |
|
|
|
SBI(fanState, fanBit[f]); |
|
|
|
} |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN_2 |
|
|
|
if (current_temperature[2] > EXTRUDER_AUTO_FAN_TEMPERATURE) { |
|
|
|
if (EXTRUDER_2_AUTO_FAN_PIN == EXTRUDER_0_AUTO_FAN_PIN) |
|
|
|
fanState |= 1; |
|
|
|
else if (EXTRUDER_2_AUTO_FAN_PIN == EXTRUDER_1_AUTO_FAN_PIN) |
|
|
|
fanState |= 2; |
|
|
|
else |
|
|
|
fanState |= 4; |
|
|
|
} |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN_3 |
|
|
|
if (current_temperature[3] > EXTRUDER_AUTO_FAN_TEMPERATURE) { |
|
|
|
if (EXTRUDER_3_AUTO_FAN_PIN == EXTRUDER_0_AUTO_FAN_PIN) |
|
|
|
fanState |= 1; |
|
|
|
else if (EXTRUDER_3_AUTO_FAN_PIN == EXTRUDER_1_AUTO_FAN_PIN) |
|
|
|
fanState |= 2; |
|
|
|
else if (EXTRUDER_3_AUTO_FAN_PIN == EXTRUDER_2_AUTO_FAN_PIN) |
|
|
|
fanState |= 4; |
|
|
|
else |
|
|
|
fanState |= 8; |
|
|
|
for (int f = 0; f <= 3; f++) { |
|
|
|
unsigned char newFanSpeed = TEST(fanState, f) ? EXTRUDER_AUTO_FAN_SPEED : 0; |
|
|
|
// this idiom allows both digital and PWM fan outputs (see M42 handling).
|
|
|
|
digitalWrite(fanPin[f], newFanSpeed); |
|
|
|
analogWrite(fanPin[f], newFanSpeed); |
|
|
|
} |
|
|
|
#endif |
|
|
|
|
|
|
|
// update extruder auto fan states
|
|
|
|
#if HAS_AUTO_FAN_0 |
|
|
|
setExtruderAutoFanState(EXTRUDER_0_AUTO_FAN_PIN, (fanState & 1) != 0); |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN_1 |
|
|
|
if (EXTRUDER_1_AUTO_FAN_PIN != EXTRUDER_0_AUTO_FAN_PIN) |
|
|
|
setExtruderAutoFanState(EXTRUDER_1_AUTO_FAN_PIN, (fanState & 2) != 0); |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN_2 |
|
|
|
if (EXTRUDER_2_AUTO_FAN_PIN != EXTRUDER_0_AUTO_FAN_PIN |
|
|
|
&& EXTRUDER_2_AUTO_FAN_PIN != EXTRUDER_1_AUTO_FAN_PIN) |
|
|
|
setExtruderAutoFanState(EXTRUDER_2_AUTO_FAN_PIN, (fanState & 4) != 0); |
|
|
|
#endif |
|
|
|
#if HAS_AUTO_FAN_3 |
|
|
|
if (EXTRUDER_3_AUTO_FAN_PIN != EXTRUDER_0_AUTO_FAN_PIN |
|
|
|
&& EXTRUDER_3_AUTO_FAN_PIN != EXTRUDER_1_AUTO_FAN_PIN |
|
|
|
&& EXTRUDER_3_AUTO_FAN_PIN != EXTRUDER_2_AUTO_FAN_PIN) |
|
|
|
setExtruderAutoFanState(EXTRUDER_3_AUTO_FAN_PIN, (fanState & 8) != 0); |
|
|
|
#endif |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
#endif // HAS_AUTO_FAN
|
|
|
|
|
|
|
|
//
|
|
|
|
// Temperature Error Handlers
|
|
|
|
//
|
|
|
|
inline void _temp_error(int e, const char* serial_msg, const char* lcd_msg) { |
|
|
|
void Temperature::_temp_error(int e, const char* serial_msg, const char* lcd_msg) { |
|
|
|
static bool killed = false; |
|
|
|
if (IsRunning()) { |
|
|
|
SERIAL_ERROR_START; |
|
|
|
@ -572,14 +378,14 @@ inline void _temp_error(int e, const char* serial_msg, const char* lcd_msg) { |
|
|
|
#endif |
|
|
|
} |
|
|
|
|
|
|
|
void max_temp_error(uint8_t e) { |
|
|
|
void Temperature::max_temp_error(uint8_t e) { |
|
|
|
_temp_error(e, PSTR(MSG_T_MAXTEMP), PSTR(MSG_ERR_MAXTEMP)); |
|
|
|
} |
|
|
|
void min_temp_error(uint8_t e) { |
|
|
|
void Temperature::min_temp_error(uint8_t e) { |
|
|
|
_temp_error(e, PSTR(MSG_T_MINTEMP), PSTR(MSG_ERR_MINTEMP)); |
|
|
|
} |
|
|
|
|
|
|
|
float get_pid_output(int e) { |
|
|
|
float Temperature::get_pid_output(int e) { |
|
|
|
float pid_output; |
|
|
|
#if ENABLED(PIDTEMP) |
|
|
|
#if DISABLED(PID_OPENLOOP) |
|
|
|
@ -658,7 +464,7 @@ float get_pid_output(int e) { |
|
|
|
} |
|
|
|
|
|
|
|
#if ENABLED(PIDTEMPBED) |
|
|
|
float get_pid_output_bed() { |
|
|
|
float Temperature::get_pid_output_bed() { |
|
|
|
float pid_output; |
|
|
|
#if DISABLED(PID_OPENLOOP) |
|
|
|
pid_error_bed = target_temperature_bed - current_temperature_bed; |
|
|
|
@ -710,7 +516,7 @@ float get_pid_output(int e) { |
|
|
|
* - Apply filament width to the extrusion rate (may move) |
|
|
|
* - Update the heated bed PID output value |
|
|
|
*/ |
|
|
|
void manage_heater() { |
|
|
|
void Temperature::manage_heater() { |
|
|
|
|
|
|
|
if (!temp_meas_ready) return; |
|
|
|
|
|
|
|
@ -811,7 +617,7 @@ void manage_heater() { |
|
|
|
|
|
|
|
#if TEMP_SENSOR_BED != 0 |
|
|
|
|
|
|
|
#if ENABLED(THERMAL_PROTECTION_BED) |
|
|
|
#if HAS_THERMALLY_PROTECTED_BED |
|
|
|
thermal_runaway_protection(&thermal_runaway_bed_state_machine, &thermal_runaway_bed_timer, current_temperature_bed, target_temperature_bed, -1, THERMAL_PROTECTION_BED_PERIOD, THERMAL_PROTECTION_BED_HYSTERESIS); |
|
|
|
#endif |
|
|
|
|
|
|
|
@ -846,9 +652,10 @@ void manage_heater() { |
|
|
|
} |
|
|
|
|
|
|
|
#define PGM_RD_W(x) (short)pgm_read_word(&x) |
|
|
|
|
|
|
|
// Derived from RepRap FiveD extruder::getTemperature()
|
|
|
|
// For hot end temperature measurement.
|
|
|
|
static float analog2temp(int raw, uint8_t e) { |
|
|
|
float Temperature::analog2temp(int raw, uint8_t e) { |
|
|
|
#if ENABLED(TEMP_SENSOR_1_AS_REDUNDANT) |
|
|
|
if (e > EXTRUDERS) |
|
|
|
#else |
|
|
|
@ -891,7 +698,7 @@ static float analog2temp(int raw, uint8_t e) { |
|
|
|
|
|
|
|
// Derived from RepRap FiveD extruder::getTemperature()
|
|
|
|
// For bed temperature measurement.
|
|
|
|
static float analog2tempBed(int raw) { |
|
|
|
float Temperature::analog2tempBed(int raw) { |
|
|
|
#if ENABLED(BED_USES_THERMISTOR) |
|
|
|
float celsius = 0; |
|
|
|
byte i; |
|
|
|
@ -923,18 +730,22 @@ static float analog2tempBed(int raw) { |
|
|
|
#endif |
|
|
|
} |
|
|
|
|
|
|
|
/* Called to get the raw values into the the actual temperatures. The raw values are created in interrupt context,
|
|
|
|
and this function is called from normal context as it is too slow to run in interrupts and will block the stepper routine otherwise */ |
|
|
|
static void updateTemperaturesFromRawValues() { |
|
|
|
/**
|
|
|
|
* Get the raw values into the actual temperatures. |
|
|
|
* The raw values are created in interrupt context, |
|
|
|
* and this function is called from normal context |
|
|
|
* as it would block the stepper routine. |
|
|
|
*/ |
|
|
|
void Temperature::updateTemperaturesFromRawValues() { |
|
|
|
#if ENABLED(HEATER_0_USES_MAX6675) |
|
|
|
current_temperature_raw[0] = read_max6675(); |
|
|
|
#endif |
|
|
|
for (uint8_t e = 0; e < EXTRUDERS; e++) { |
|
|
|
current_temperature[e] = analog2temp(current_temperature_raw[e], e); |
|
|
|
current_temperature[e] = Temperature::analog2temp(current_temperature_raw[e], e); |
|
|
|
} |
|
|
|
current_temperature_bed = analog2tempBed(current_temperature_bed_raw); |
|
|
|
current_temperature_bed = Temperature::analog2tempBed(current_temperature_bed_raw); |
|
|
|
#if ENABLED(TEMP_SENSOR_1_AS_REDUNDANT) |
|
|
|
redundant_temperature = analog2temp(redundant_temperature_raw, 1); |
|
|
|
redundant_temperature = Temperature::analog2temp(redundant_temperature_raw, 1); |
|
|
|
#endif |
|
|
|
#if ENABLED(FILAMENT_WIDTH_SENSOR) |
|
|
|
filament_width_meas = analog2widthFil(); |
|
|
|
@ -954,13 +765,13 @@ static void updateTemperaturesFromRawValues() { |
|
|
|
#if ENABLED(FILAMENT_WIDTH_SENSOR) |
|
|
|
|
|
|
|
// Convert raw Filament Width to millimeters
|
|
|
|
float analog2widthFil() { |
|
|
|
float Temperature::analog2widthFil() { |
|
|
|
return current_raw_filwidth / 16383.0 * 5.0; |
|
|
|
//return current_raw_filwidth;
|
|
|
|
} |
|
|
|
|
|
|
|
// Convert raw Filament Width to a ratio
|
|
|
|
int widthFil_to_size_ratio() { |
|
|
|
int Temperature::widthFil_to_size_ratio() { |
|
|
|
float temp = filament_width_meas; |
|
|
|
if (temp < MEASURED_LOWER_LIMIT) temp = filament_width_nominal; //assume sensor cut out
|
|
|
|
else NOMORE(temp, MEASURED_UPPER_LIMIT); |
|
|
|
@ -974,7 +785,8 @@ static void updateTemperaturesFromRawValues() { |
|
|
|
* Initialize the temperature manager |
|
|
|
* The manager is implemented by periodic calls to manage_heater() |
|
|
|
*/ |
|
|
|
void tp_init() { |
|
|
|
void Temperature::init() { |
|
|
|
|
|
|
|
#if MB(RUMBA) && ((TEMP_SENSOR_0==-1)||(TEMP_SENSOR_1==-1)||(TEMP_SENSOR_2==-1)||(TEMP_SENSOR_BED==-1)) |
|
|
|
//disable RUMBA JTAG in case the thermocouple extension is plugged on top of JTAG connector
|
|
|
|
MCUCR = _BV(JTD); |
|
|
|
@ -1189,7 +1001,7 @@ void tp_init() { |
|
|
|
* their target temperature by a configurable margin. |
|
|
|
* This is called when the temperature is set. (M104, M109) |
|
|
|
*/ |
|
|
|
void start_watching_heater(int e) { |
|
|
|
void Temperature::start_watching_heater(int e) { |
|
|
|
if (degHotend(e) < degTargetHotend(e) - (WATCH_TEMP_INCREASE + TEMP_HYSTERESIS + 1)) { |
|
|
|
watch_target_temp[e] = degHotend(e) + WATCH_TEMP_INCREASE; |
|
|
|
watch_heater_next_ms[e] = millis() + (WATCH_TEMP_PERIOD) * 1000UL; |
|
|
|
@ -1205,7 +1017,7 @@ void tp_init() { |
|
|
|
* their target temperature by a configurable margin. |
|
|
|
* This is called when the temperature is set. (M140, M190) |
|
|
|
*/ |
|
|
|
void start_watching_bed() { |
|
|
|
void Temperature::start_watching_bed() { |
|
|
|
if (degBed() < degTargetBed() - (WATCH_BED_TEMP_INCREASE + TEMP_BED_HYSTERESIS + 1)) { |
|
|
|
watch_target_bed_temp = degBed() + WATCH_BED_TEMP_INCREASE; |
|
|
|
watch_bed_next_ms = millis() + (WATCH_BED_TEMP_PERIOD) * 1000UL; |
|
|
|
@ -1215,9 +1027,9 @@ void tp_init() { |
|
|
|
} |
|
|
|
#endif |
|
|
|
|
|
|
|
#if ENABLED(THERMAL_PROTECTION_HOTENDS) || ENABLED(THERMAL_PROTECTION_BED) |
|
|
|
#if ENABLED(THERMAL_PROTECTION_HOTENDS) || HAS_THERMALLY_PROTECTED_BED |
|
|
|
|
|
|
|
void thermal_runaway_protection(TRState* state, millis_t* timer, float temperature, float target_temperature, int heater_id, int period_seconds, int hysteresis_degc) { |
|
|
|
void Temperature::thermal_runaway_protection(TRState* state, millis_t* timer, float temperature, float target_temperature, int heater_id, int period_seconds, int hysteresis_degc) { |
|
|
|
|
|
|
|
static float tr_target_temperature[EXTRUDERS + 1] = { 0.0 }; |
|
|
|
|
|
|
|
@ -1273,7 +1085,7 @@ void tp_init() { |
|
|
|
|
|
|
|
#endif // THERMAL_PROTECTION_HOTENDS || THERMAL_PROTECTION_BED
|
|
|
|
|
|
|
|
void disable_all_heaters() { |
|
|
|
void Temperature::disable_all_heaters() { |
|
|
|
for (int i = 0; i < EXTRUDERS; i++) setTargetHotend(0, i); |
|
|
|
setTargetBed(0); |
|
|
|
|
|
|
|
@ -1327,9 +1139,9 @@ void disable_all_heaters() { |
|
|
|
#define MAX6675_DISCARD_BITS 3 |
|
|
|
#endif |
|
|
|
|
|
|
|
static millis_t next_max6675_ms = 0; |
|
|
|
int Temperature::read_max6675() { |
|
|
|
|
|
|
|
static int read_max6675() { |
|
|
|
static millis_t next_max6675_ms = 0; |
|
|
|
|
|
|
|
millis_t ms = millis(); |
|
|
|
|
|
|
|
@ -1392,10 +1204,10 @@ enum TempState { |
|
|
|
StartupDelay // Startup, delay initial temp reading a tiny bit so the hardware can settle
|
|
|
|
}; |
|
|
|
|
|
|
|
static unsigned long raw_temp_value[4] = { 0 }; |
|
|
|
static unsigned long raw_temp_bed_value = 0; |
|
|
|
|
|
|
|
static void set_current_temp_raw() { |
|
|
|
/**
|
|
|
|
* Get raw temperatures |
|
|
|
*/ |
|
|
|
void Temperature::set_current_temp_raw() { |
|
|
|
#if HAS_TEMP_0 && DISABLED(HEATER_0_USES_MAX6675) |
|
|
|
current_temperature_raw[0] = raw_temp_value[0]; |
|
|
|
#endif |
|
|
|
@ -1423,7 +1235,9 @@ static void set_current_temp_raw() { |
|
|
|
* - Check new temperature values for MIN/MAX errors |
|
|
|
* - Step the babysteps value for each axis towards 0 |
|
|
|
*/ |
|
|
|
ISR(TIMER0_COMPB_vect) { |
|
|
|
ISR(TIMER0_COMPB_vect) { thermalManager.isr(); } |
|
|
|
|
|
|
|
void Temperature::isr() { |
|
|
|
|
|
|
|
static unsigned char temp_count = 0; |
|
|
|
static TempState temp_state = StartupDelay; |
|
|
|
@ -1845,11 +1659,3 @@ ISR(TIMER0_COMPB_vect) { |
|
|
|
} |
|
|
|
#endif //BABYSTEPPING
|
|
|
|
} |
|
|
|
|
|
|
|
#if ENABLED(PIDTEMP) |
|
|
|
// Apply the scale factors to the PID values
|
|
|
|
float scalePID_i(float i) { return i * PID_dT; } |
|
|
|
float unscalePID_i(float i) { return i / PID_dT; } |
|
|
|
float scalePID_d(float d) { return d / PID_dT; } |
|
|
|
float unscalePID_d(float d) { return d * PID_dT; } |
|
|
|
#endif //PIDTEMP
|
|
|
|
|
Scott Lahteine
9 years ago