MRI Hooks: remember previous state, programmatically construct pin lists from Tempera...
[clinton/Smoothieware.git] / src / modules / tools / switch / Switch.cpp
1 /*
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/>.
6 */
7
8 #include "libs/Module.h"
9 #include "libs/Kernel.h"
10 #include <math.h>
11 #include "Switch.h"
12 #include "libs/Pin.h"
13
14 #include "MRI_Hooks.h"
15
16 Switch::Switch(){}
17
18 Switch::Switch(uint16_t name){
19 this->name_checksum = name;
20 }
21
22 void Switch::on_module_loaded(){
23 this->register_for_event(ON_GCODE_EXECUTE);
24
25 // Settings
26 this->on_config_reload(this);
27
28 // PWM
29 this->kernel->slow_ticker->attach(1000, this->output_pin, &Pwm::on_tick);
30 }
31
32
33 // Get config
34 void Switch::on_config_reload(void* argument){
35 this->on_m_code = this->kernel->config->value(switch_checksum, this->name_checksum, on_m_code_checksum )->required()->as_number();
36 this->off_m_code = this->kernel->config->value(switch_checksum, this->name_checksum, off_m_code_checksum )->required()->as_number();
37 this->output_pin = this->kernel->config->value(switch_checksum, this->name_checksum, output_pin_checksum )->required()->as_pwm()->as_output();
38 this->output_pin->set(this->kernel->config->value(switch_checksum, this->name_checksum, startup_state_checksum )->by_default(0)->as_number() );
39
40 set_low_on_debug(output_pin->pin->port_number, output_pin->pin->pin);
41 }
42
43 // Turn pin on and off
44 void Switch::on_gcode_execute(void* argument){
45 Gcode* gcode = static_cast<Gcode*>(argument);
46 if( gcode->has_m){
47 int code = gcode->m;
48 if( code == this->on_m_code ){
49 if (gcode->has_letter('S'))
50 {
51 int v = gcode->get_value('S') * output_pin->max_pwm() / 256.0;
52 if (v)
53 this->output_pin->pwm(v);
54 else
55 this->output_pin->set(0);
56 }
57 else
58 {
59 // Turn pin on
60 this->output_pin->set(1);
61 }
62 }
63 if( code == this->off_m_code ){
64 // Turn pin off
65 this->output_pin->set(0);
66 }
67 }
68 }