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 Switch::Switch(){}
  15
  16 Switch::Switch(uint16_t name){
  17     this->name_checksum = name;
  18 }
  19
  20 void Switch::on_module_loaded(){
  21     this->register_for_event(ON_GCODE_EXECUTE);
  22
  23     // Settings
  24     this->on_config_reload(this);
  25
  26 }
  27
  28
  29 // Get config
  30 void Switch::on_config_reload(void* argument){
  31     this->on_m_code                   = this->kernel->config->value(switch_checksum, this->name_checksum, on_m_code_checksum          )->required()->as_number();
  32     this->off_m_code                  = this->kernel->config->value(switch_checksum, this->name_checksum, off_m_code_checksum         )->required()->as_number();
  33     this->output_pin                  = this->kernel->config->value(switch_checksum, this->name_checksum, output_pin_checksum         )->required()->as_pin()->as_output();
  34     this->output_pin->set(              this->kernel->config->value(switch_checksum, this->name_checksum, startup_state_checksum      )->by_default(0)->as_number() );
  35 }
  36
  37 // Turn pin on and off
  38 void Switch::on_gcode_execute(void* argument){
  39     Gcode* gcode = static_cast<Gcode*>(argument);
  40     if( gcode->has_letter('M' )){
  41         int code = gcode->get_value('M');
  42         if( code == this->on_m_code ){
  43             // Turn pin on
  44             this->output_pin->set(1);
  45         }
  46         if( code == this->off_m_code ){
  47             // Turn pin off
  48             this->output_pin->set(0);
  49         }
  50     }
  51 }
  52
  53
  54
  55