2 This file is part of Smoothie (http://smoothieware.org/). The motion control part is heavily based on Grbl (https://github.com/simen/grbl).
3 Smoothie 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.
4 Smoothie 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.
5 You should have received a copy of the GNU General Public License along with Smoothie. If not, see <http://www.gnu.org/licenses/>.
9 TemperatureSwitch is an optional module that will automatically turn on or off a switch
10 based on a setpoint temperature. It is commonly used to turn on/off a cooling fan or water pump
11 to cool the hot end's cold zone. Specifically, it turns one of the small MOSFETs on or off.
13 Author: Michael Hackney, mhackney@eclecticangler.com
16 #include "TemperatureSwitch.h"
17 #include "libs/Module.h"
18 #include "libs/Kernel.h"
19 #include "modules/tools/temperaturecontrol/TemperatureControlPublicAccess.h"
20 #include "SwitchPublicAccess.h"
25 #include "ConfigValue.h"
26 #include "checksumm.h"
27 #include "PublicData.h"
28 #include "StreamOutputPool.h"
29 #include "TemperatureControlPool.h"
31 #define temperatureswitch_checksum CHECKSUM("temperatureswitch")
32 #define enable_checksum CHECKSUM("enable")
33 #define temperatureswitch_hotend_checksum CHECKSUM("hotend")
34 #define temperatureswitch_threshold_temp_checksum CHECKSUM("threshold_temp")
35 #define temperatureswitch_type_checksum CHECKSUM("type")
36 #define temperatureswitch_switch_checksum CHECKSUM("switch")
37 #define temperatureswitch_heatup_poll_checksum CHECKSUM("heatup_poll")
38 #define temperatureswitch_cooldown_poll_checksum CHECKSUM("cooldown_poll")
39 #define temperatureswitch_trigger_checksum CHECKSUM("trigger")
40 #define temperatureswitch_inverted_checksum CHECKSUM("inverted")
41 #define temperatureswitch_arm_command_checksum CHECKSUM("arm_mcode")
42 #define designator_checksum CHECKSUM("designator")
44 TemperatureSwitch::TemperatureSwitch()
46 this->temperatureswitch_state
= false;
47 this->second_counter
= 0;
51 void TemperatureSwitch::on_module_loaded()
53 vector
<uint16_t> modulist
;
54 // allow for multiple temperature switches
55 THEKERNEL
->config
->get_module_list(&modulist
, temperatureswitch_checksum
);
56 for (auto m
: modulist
) {
60 // no longer need this instance as it is just used to load the other instances
65 bool TemperatureSwitch::load_config(uint16_t modcs
)
68 if (!THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, enable_checksum
)->by_default(false)->as_bool()) {
72 // create a temperature control and load settings
75 string s
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, designator_checksum
)->by_default("")->as_string();
77 // for backward compatibility temperatureswitch.hotend will need designator 'T' by default @DEPRECATED
78 if(modcs
== temperatureswitch_hotend_checksum
) designator
= 'T';
84 if(designator
== 0) return false; // no designator then not valid
86 // create a new temperature switch module
87 TemperatureSwitch
*ts
= new TemperatureSwitch();
89 // get the list of temperature controllers and remove any that don't have designator == specified designator
90 auto& tempcontrollers
= THEKERNEL
->temperature_control_pool
->get_controllers();
92 // see what its designator is and add to list of it the one we specified
94 for (auto controller
: tempcontrollers
) {
95 bool temp_ok
= PublicData::get_value(temperature_control_checksum
, controller
, current_temperature_checksum
, &returned_temp
);
97 struct pad_temperature temp
= *static_cast<struct pad_temperature
*>(returned_temp
);
98 if (temp
.designator
[0] == designator
) {
99 ts
->temp_controllers
.push_back(controller
);
104 // if we don't have any matching controllers, then not valid
105 if (ts
->temp_controllers
.empty()) {
110 // load settings from config file
111 s
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_switch_checksum
)->by_default("")->as_string();
113 // handle old configs where this was called type @DEPRECATED
114 s
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_type_checksum
)->by_default("")->as_string();
116 // no switch specified so invalid entry
122 // if we should turn the switch on or off when trigger is hit
123 ts
->inverted
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_inverted_checksum
)->by_default(false)->as_bool();
125 // if we should trigger when above and below, or when rising through, or when falling through the specified temp
126 string trig
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_trigger_checksum
)->by_default("level")->as_string();
127 if(trig
== "level") ts
->trigger
= LEVEL
;
128 else if(trig
== "rising") ts
->trigger
= RISING
;
129 else if(trig
== "falling") ts
->trigger
= FALLING
;
130 else ts
->trigger
= LEVEL
;
132 // the mcode used to arm the switch
133 ts
->arm_mcode
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_arm_command_checksum
)->by_default(0)->as_number();
134 // if not defined then always armed, otherwise start out disarmed
135 if(ts
->arm_mcode
== 0){
144 ts
->temperatureswitch_switch_cs
= get_checksum(s
); // checksum of the switch to use
146 ts
->temperatureswitch_threshold_temp
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_threshold_temp_checksum
)->by_default(50.0f
)->as_number();
148 // these are to tune the heatup and cooldown polling frequencies
149 ts
->temperatureswitch_heatup_poll
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_heatup_poll_checksum
)->by_default(15)->as_number();
150 ts
->temperatureswitch_cooldown_poll
= THEKERNEL
->config
->value(temperatureswitch_checksum
, modcs
, temperatureswitch_cooldown_poll_checksum
)->by_default(60)->as_number();
151 ts
->current_delay
= ts
->temperatureswitch_heatup_poll
;
154 float current_temp
= ts
->get_highest_temperature();
155 ts
->lower
= current_temp
< ts
->temperatureswitch_threshold_temp
;
157 // Register for events
158 ts
->register_for_event(ON_SECOND_TICK
);
159 ts
->register_for_event(ON_GCODE_RECEIVED
);
163 void TemperatureSwitch::on_gcode_received(void *argument
)
165 if(this->arm_mcode
== 0) return;
167 Gcode
*gcode
= static_cast<Gcode
*>(argument
);
168 if(gcode
->has_m
&& gcode
->m
== this->arm_mcode
) {
169 this->armed
= (gcode
->has_letter('S') && gcode
->get_value('S') != 0);
173 // Called once a second but we only need to service on the cooldown and heatup poll intervals
174 void TemperatureSwitch::on_second_tick(void *argument
)
177 if (second_counter
< current_delay
) {
182 float current_temp
= this->get_highest_temperature();
184 if (current_temp
>= this->temperatureswitch_threshold_temp
) {
185 // temp >= threshold temp, call set_switch if trigger is LEVEL, or if we were lower and RISING
186 if (this->trigger
== LEVEL
|| (this->lower
&& this->trigger
== RISING
)) {
189 current_delay
= temperatureswitch_cooldown_poll
;
191 if(this->lower
&& this->trigger
== FALLING
) {
196 // temp < threshold temp, call set_switch if trigger is LEVEL, or if we were not lower and FALLING
197 if (this->trigger
== LEVEL
|| (!this->lower
&& this->trigger
== FALLING
)) {
200 current_delay
= temperatureswitch_heatup_poll
;
202 if(!this->lower
&& this->trigger
== RISING
) {
209 // Get the highest temperature from the set of temperature controllers
210 float TemperatureSwitch::get_highest_temperature()
213 float high_temp
= 0.0;
215 for (auto controller
: temp_controllers
) {
216 bool temp_ok
= PublicData::get_value(temperature_control_checksum
, controller
, current_temperature_checksum
, &returned_temp
);
218 struct pad_temperature temp
= *static_cast<struct pad_temperature
*>(returned_temp
);
219 // check if this controller's temp is the highest and save it if so
220 if (temp
.current_temperature
> high_temp
) {
221 high_temp
= temp
.current_temperature
;
228 // Turn the switch on (true) or off (false)
229 void TemperatureSwitch::set_switch(bool switch_state
)
231 if(this->temperatureswitch_state
== switch_state
) return;
233 this->temperatureswitch_state
= switch_state
;
236 // if one shot we only trigger once per arming
237 if(!this->armed
) return; // do not actually switch anything if not armed, but we do need to keep the state
241 if(this->inverted
) switch_state
= !switch_state
; // turn switch on or off inverted
243 bool ok
= PublicData::set_value(switch_checksum
, this->temperatureswitch_switch_cs
, state_checksum
, &switch_state
);
245 THEKERNEL
->streams
->printf("// Failed changing switch state.\r\n");