src/modules/tools/extruder/Extruder.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 "Extruder.h"
   9
  10 #include "libs/Module.h"
  11 #include "libs/Kernel.h"
  12
  13 #include "modules/robot/Conveyor.h"
  14 #include "modules/robot/Block.h"
  15 #include "StepperMotor.h"
  16 #include "SlowTicker.h"
  17 #include "Config.h"
  18 #include "StepperMotor.h"
  19 #include "Robot.h"
  20 #include "checksumm.h"
  21 #include "ConfigValue.h"
  22 #include "Gcode.h"
  23 #include "libs/StreamOutput.h"
  24 #include "PublicDataRequest.h"
  25 #include "StreamOutputPool.h"
  26 #include "ExtruderPublicAccess.h"
  27
  28 #include <mri.h>
  29
  30 // OLD config names for backwards compatibility, NOTE new configs will not be added here
  31 #define extruder_module_enable_checksum      CHECKSUM("extruder_module_enable")
  32 #define extruder_steps_per_mm_checksum       CHECKSUM("extruder_steps_per_mm")
  33 #define extruder_filament_diameter_checksum  CHECKSUM("extruder_filament_diameter")
  34 #define extruder_acceleration_checksum       CHECKSUM("extruder_acceleration")
  35 #define extruder_step_pin_checksum           CHECKSUM("extruder_step_pin")
  36 #define extruder_dir_pin_checksum            CHECKSUM("extruder_dir_pin")
  37 #define extruder_en_pin_checksum             CHECKSUM("extruder_en_pin")
  38 #define extruder_max_speed_checksum          CHECKSUM("extruder_max_speed")
  39 #define extruder_default_feed_rate_checksum  CHECKSUM("extruder_default_feed_rate")
  40
  41 // NEW config names
  42
  43 #define default_feed_rate_checksum           CHECKSUM("default_feed_rate")
  44 #define steps_per_mm_checksum                CHECKSUM("steps_per_mm")
  45 #define filament_diameter_checksum           CHECKSUM("filament_diameter")
  46 #define acceleration_checksum                CHECKSUM("acceleration")
  47 #define step_pin_checksum                    CHECKSUM("step_pin")
  48 #define dir_pin_checksum                     CHECKSUM("dir_pin")
  49 #define en_pin_checksum                      CHECKSUM("en_pin")
  50 #define max_speed_checksum                   CHECKSUM("max_speed")
  51 #define x_offset_checksum                    CHECKSUM("x_offset")
  52 #define y_offset_checksum                    CHECKSUM("y_offset")
  53 #define z_offset_checksum                    CHECKSUM("z_offset")
  54
  55 #define retract_length_checksum              CHECKSUM("retract_length")
  56 #define retract_feedrate_checksum            CHECKSUM("retract_feedrate")
  57 #define retract_recover_length_checksum      CHECKSUM("retract_recover_length")
  58 #define retract_recover_feedrate_checksum    CHECKSUM("retract_recover_feedrate")
  59 #define retract_zlift_length_checksum        CHECKSUM("retract_zlift_length")
  60 #define retract_zlift_feedrate_checksum      CHECKSUM("retract_zlift_feedrate")
  61
  62 #define PI 3.14159265358979F
  63
  64
  65 /*
  66     As the actual motion is handled by the planner and the stepticker, this module just handles Extruder specific gcodes
  67     and settings.
  68     In a multi extruder setting it must be selected to be addressed. (using T0 T1 etc)
  69 */
  70
  71 Extruder::Extruder( uint16_t config_identifier)
  72 {
  73     this->selected = false;
  74     this->identifier = config_identifier;
  75     this->retracted = false;
  76     this->volumetric_multiplier = 1.0F;
  77     this->extruder_multiplier = 1.0F;
  78     this->stepper_motor = nullptr;
  79     this->max_volumetric_rate = 0;
  80
  81     memset(this->offset, 0, sizeof(this->offset));
  82 }
  83
  84 Extruder::~Extruder()
  85 {
  86     delete stepper_motor;
  87 }
  88
  89 void Extruder::on_module_loaded()
  90 {
  91     // Settings
  92     this->config_load();
  93
  94     // We work on the same Block as Stepper, so we need to know when it gets a new one and drops one
  95     this->register_for_event(ON_GCODE_RECEIVED);
  96     this->register_for_event(ON_GET_PUBLIC_DATA);
  97     this->register_for_event(ON_SET_PUBLIC_DATA);
  98 }
  99
 100 // Get config
 101 void Extruder::config_load()
 102 {
 103
 104     Pin step_pin, dir_pin, en_pin;
 105     step_pin.from_string( THEKERNEL->config->value(extruder_checksum, this->identifier, step_pin_checksum          )->by_default("nc" )->as_string())->as_output();
 106     dir_pin.from_string(  THEKERNEL->config->value(extruder_checksum, this->identifier, dir_pin_checksum           )->by_default("nc" )->as_string())->as_output();
 107     en_pin.from_string(   THEKERNEL->config->value(extruder_checksum, this->identifier, en_pin_checksum            )->by_default("nc" )->as_string())->as_output();
 108
 109     float steps_per_millimeter = THEKERNEL->config->value(extruder_checksum, this->identifier, steps_per_mm_checksum)->by_default(1)->as_number();
 110     float acceleration         = THEKERNEL->config->value(extruder_checksum, this->identifier, acceleration_checksum)->by_default(1000)->as_number();
 111
 112     this->offset[X_AXIS] = THEKERNEL->config->value(extruder_checksum, this->identifier, x_offset_checksum          )->by_default(0)->as_number();
 113     this->offset[Y_AXIS] = THEKERNEL->config->value(extruder_checksum, this->identifier, y_offset_checksum          )->by_default(0)->as_number();
 114     this->offset[Z_AXIS] = THEKERNEL->config->value(extruder_checksum, this->identifier, z_offset_checksum          )->by_default(0)->as_number();
 115
 116     this->filament_diameter        = THEKERNEL->config->value(extruder_checksum, this->identifier, filament_diameter_checksum )->by_default(0)->as_number();
 117     this->retract_length           = THEKERNEL->config->value(extruder_checksum, this->identifier, retract_length_checksum)->by_default(3)->as_number();
 118     this->retract_feedrate         = THEKERNEL->config->value(extruder_checksum, this->identifier, retract_feedrate_checksum)->by_default(45)->as_number();
 119     this->retract_recover_length   = THEKERNEL->config->value(extruder_checksum, this->identifier, retract_recover_length_checksum)->by_default(0)->as_number();
 120     this->retract_recover_feedrate = THEKERNEL->config->value(extruder_checksum, this->identifier, retract_recover_feedrate_checksum)->by_default(8)->as_number();
 121     this->retract_zlift_length     = THEKERNEL->config->value(extruder_checksum, this->identifier, retract_zlift_length_checksum)->by_default(0)->as_number();
 122     this->retract_zlift_feedrate   = THEKERNEL->config->value(extruder_checksum, this->identifier, retract_zlift_feedrate_checksum)->by_default(100 * 60)->as_number()/60.0F; // mm/min
 123
 124     if(filament_diameter > 0.01F) {
 125         this->volumetric_multiplier = 1.0F / (powf(this->filament_diameter / 2, 2) * PI);
 126     }
 127
 128     // Stepper motor object for the extruder
 129     stepper_motor = new StepperMotor(step_pin, dir_pin, en_pin);
 130     motor_id= THEROBOT->register_motor(stepper_motor);
 131
 132     stepper_motor->set_max_rate(THEKERNEL->config->value(extruder_checksum, this->identifier, max_speed_checksum)->by_default(1000)->as_number());
 133     stepper_motor->set_acceleration(acceleration);
 134     stepper_motor->change_steps_per_mm(steps_per_millimeter);
 135     stepper_motor->set_selected(false); // not selected by default
 136 }
 137
 138 void Extruder::select()
 139 {
 140     selected= true;
 141     stepper_motor->set_selected(true);
 142 }
 143
 144 void Extruder::deselect()
 145 {
 146     selected= false;
 147     stepper_motor->set_selected(false);
 148 }
 149
 150 void Extruder::on_get_public_data(void *argument)
 151 {
 152     PublicDataRequest *pdr = static_cast<PublicDataRequest *>(argument);
 153
 154     if(!pdr->starts_with(extruder_checksum)) return;
 155
 156     if(this->selected) {
 157         pdr->set_data_ptr(&this->filament_diameter);
 158         pdr->set_taken();
 159     }
 160 }
 161
 162 // check against maximum speeds and return the rate modifier
 163 float Extruder::check_max_speeds(float delta, float isecs)
 164 {
 165     float rm = 1.0F; // default no rate modification
 166
 167     if(this->max_volumetric_rate > 0 && this->filament_diameter > 0.01F) {
 168         // volumetric enabled and check for volumetric rate
 169         float v = delta * isecs; // the flow rate in mm³/sec
 170
 171         // return the rate change needed to stay within the max rate
 172         if(v > max_volumetric_rate) {
 173             rm = max_volumetric_rate / v;
 174         }
 175         //THEKERNEL->streams->printf("requested flow rate: %f mm³/sec, corrected flow rate: %f  mm³/sec\n", v, v * rm);
 176     }
 177
 178     return rm;
 179 }
 180
 181 void Extruder::on_set_public_data(void *argument)
 182 {
 183     PublicDataRequest *pdr = static_cast<PublicDataRequest *>(argument);
 184
 185     if(!pdr->starts_with(extruder_checksum)) return;
 186
 187     // handle extrude rates request from robot
 188     if(pdr->second_element_is(target_checksum)) {
 189         // disabled extruders do not reply NOTE only one enabled extruder supported
 190         if(!this->selected) return;
 191
 192         float *d = static_cast<float *>(pdr->get_data_ptr());
 193         float delta = d[0]; // the E passed in on Gcode is the delta volume in mm³
 194         float isecs = d[1]; // inverted secs
 195
 196         // check against maximum speeds and return rate modifier
 197         d[1]= check_max_speeds(delta, isecs);
 198
 199         // also return the scale factor
 200         float s= volumetric_multiplier*extruder_multiplier;
 201         d[0]= (s == 1.0F ? NAN : s);
 202
 203         pdr->set_taken();
 204         return;
 205     }
 206
 207     // save or restore extruder state
 208     if(pdr->second_element_is(save_state_checksum)) {
 209         // we need to save these separately as they may have been scaled
 210         this->saved_position= std::make_tuple(THEROBOT->get_axis_position(motor_id), stepper_motor->get_last_milestone(), stepper_motor->get_last_milestone_steps());
 211         this->saved_selected= this->selected;
 212         pdr->set_taken();
 213
 214     } else if(pdr->second_element_is(restore_state_checksum)) {
 215         this->selected= this->saved_selected;
 216         // NOTE this only gets called when the queue is empty so the milestones will be the same
 217         THEROBOT->reset_axis_position(std::get<0>(this->saved_position), motor_id);
 218         stepper_motor->set_last_milestones(std::get<1>(this->saved_position), std::get<2>(this->saved_position));
 219         pdr->set_taken();
 220     }
 221 }
 222
 223 void Extruder::on_gcode_received(void *argument)
 224 {
 225     Gcode *gcode = static_cast<Gcode *>(argument);
 226
 227     // M codes most execute immediately, most only execute if enabled
 228     if (gcode->has_m) {
 229         if (gcode->m == 114 && this->selected) {
 230             char buf[16];
 231             if(gcode->subcode == 0) {
 232                 float pos[motor_id+1];
 233                 THEROBOT->get_axis_position(pos, motor_id+1);
 234                 int n = snprintf(buf, sizeof(buf), " E:%1.3f ", pos[motor_id]);
 235                 gcode->txt_after_ok.append(buf, n);
 236
 237             }else if(gcode->subcode == 1) { // realtime
 238                 int n = snprintf(buf, sizeof(buf), " E:%1.3f ", stepper_motor->get_current_position());
 239                 gcode->txt_after_ok.append(buf, n);
 240             }
 241
 242         } else if (gcode->m == 92 && ( (this->selected && !gcode->has_letter('P')) || (gcode->has_letter('P') && gcode->get_value('P') == this->identifier) ) ) {
 243             float spm = stepper_motor->get_steps_per_mm();
 244             if (gcode->has_letter('E')) {
 245                 spm = gcode->get_value('E');
 246                 stepper_motor->change_steps_per_mm(spm);
 247             }
 248
 249             gcode->stream->printf("E:%f ", spm);
 250             gcode->add_nl = true;
 251
 252         } else if (gcode->m == 200 && ( (this->selected && !gcode->has_letter('P')) || (gcode->has_letter('P') && gcode->get_value('P') == this->identifier)) ) {
 253             if (gcode->has_letter('D')) {
 254                 THEKERNEL->conveyor->wait_for_empty_queue(); // only apply after the queue has emptied
 255                 this->filament_diameter = gcode->get_value('D');
 256                 if(filament_diameter > 0.01F) {
 257                     this->volumetric_multiplier = 1.0F / (powf(this->filament_diameter / 2, 2) * PI);
 258                 } else {
 259                     this->volumetric_multiplier = 1.0F;
 260                 }
 261             } else {
 262                 if(filament_diameter > 0.01F) {
 263                     gcode->stream->printf("Filament Diameter: %f\n", this->filament_diameter);
 264                 } else {
 265                     gcode->stream->printf("Volumetric extrusion is disabled\n");
 266                 }
 267             }
 268
 269         } else if (gcode->m == 203 && ( (this->selected && !gcode->has_letter('P')) || (gcode->has_letter('P') && gcode->get_value('P') == this->identifier)) ) {
 270             // M203 Exxx Vyyy Set maximum feedrates xxx mm/sec and/or yyy mm³/sec
 271             if(gcode->get_num_args() == 0) {
 272                 gcode->stream->printf("E:%g V:%g", this->stepper_motor->get_max_rate(), this->max_volumetric_rate);
 273                 gcode->add_nl = true;
 274
 275             } else {
 276                 if(gcode->has_letter('E')) {
 277                     this->stepper_motor->set_max_rate(gcode->get_value('E'));
 278                 }
 279                 if(gcode->has_letter('V')) {
 280                     this->max_volumetric_rate = gcode->get_value('V');
 281                 }
 282             }
 283
 284         } else if (gcode->m == 204 && gcode->has_letter('E') &&
 285                    ( (this->selected && !gcode->has_letter('P')) || (gcode->has_letter('P') && gcode->get_value('P') == this->identifier)) ) {
 286             // extruder acceleration M204 Ennn mm/sec^2 (Pnnn sets the specific extruder for M500)
 287             stepper_motor->set_acceleration(gcode->get_value('E'));
 288
 289         } else if (gcode->m == 207 && ( (this->selected && !gcode->has_letter('P')) || (gcode->has_letter('P') && gcode->get_value('P') == this->identifier)) ) {
 290             // M207 - set retract length S[positive mm] F[feedrate mm/min] Z[additional zlift/hop] Q[zlift feedrate mm/min]
 291             if(gcode->has_letter('S')) retract_length = gcode->get_value('S');
 292             if(gcode->has_letter('F')) retract_feedrate = gcode->get_value('F') / 60.0F; // specified in mm/min converted to mm/sec
 293             if(gcode->has_letter('Z')) retract_zlift_length = gcode->get_value('Z') / 60.0F; // specified in mm/min converted to mm/sec
 294             if(gcode->has_letter('Q')) retract_zlift_feedrate = gcode->get_value('Q') / 60.0F; // specified in mm/min converted to mm/sec
 295
 296         } else if (gcode->m == 208 && ( (this->selected && !gcode->has_letter('P')) || (gcode->has_letter('P') && gcode->get_value('P') == this->identifier)) ) {
 297             // M208 - set retract recover length S[positive mm surplus to the M207 S*] F[feedrate mm/min]
 298             if(gcode->has_letter('S')) retract_recover_length = gcode->get_value('S');
 299             if(gcode->has_letter('F')) retract_recover_feedrate = gcode->get_value('F') / 60.0F; // specified in mm/min converted to mm/sec
 300
 301         } else if (gcode->m == 221 && this->selected) { // M221 S100 change flow rate by percentage
 302             if(gcode->has_letter('S')) {
 303                 this->extruder_multiplier = gcode->get_value('S') / 100.0F;
 304             } else {
 305                 gcode->stream->printf("Flow rate at %6.2f %%\n", this->extruder_multiplier * 100.0F);
 306             }
 307
 308         } else if (gcode->m == 500 || gcode->m == 503) { // M500 saves some volatile settings to config override file, M503 just prints the settings
 309             gcode->stream->printf(";E Steps per mm:\nM92 E%1.4f P%d\n", stepper_motor->get_steps_per_mm(), this->identifier);
 310             gcode->stream->printf(";E Filament diameter:\nM200 D%1.4f P%d\n", this->filament_diameter, this->identifier);
 311             gcode->stream->printf(";E retract length, feedrate:\nM207 S%1.4f F%1.4f Z%1.4f Q%1.4f P%d\n", this->retract_length, this->retract_feedrate * 60.0F, this->retract_zlift_length, this->retract_zlift_feedrate, this->identifier);
 312             gcode->stream->printf(";E retract recover length, feedrate:\nM208 S%1.4f F%1.4f P%d\n", this->retract_recover_length, this->retract_recover_feedrate * 60.0F, this->identifier);
 313             gcode->stream->printf(";E acceleration mm/sec²:\nM204 E%1.4f P%d\n", stepper_motor->get_acceleration(), this->identifier);
 314             gcode->stream->printf(";E max feed rate mm/sec:\nM203 E%1.4f P%d\n", stepper_motor->get_max_rate(), this->identifier);
 315             if(this->max_volumetric_rate > 0) {
 316                 gcode->stream->printf(";E max volumetric rate mm³/sec:\nM203 V%1.4f P%d\n", this->max_volumetric_rate, this->identifier);
 317             }
 318         }
 319
 320     }else if( gcode->has_g && this->selected ) {
 321
 322         if( (gcode->g == 10 || gcode->g == 11) && !gcode->has_letter('L') ) {
 323             // firmware retract command (Ignore if has L parameter that is not for us)
 324             // check we are in the correct state of retract or unretract
 325             if(gcode->g == 10 && !retracted) {
 326                 this->retracted = true;
 327                 this->cancel_zlift_restore = false;
 328             } else if(gcode->g == 11 && retracted) {
 329                 this->retracted = false;
 330             } else
 331                 return; // ignore duplicates
 332
 333             if(gcode->g == 10) {
 334                 // retract
 335                 float delta[motor_id+1];
 336                 for (int i = 0; i < motor_id; ++i) {
 337                     delta[i]= 0;
 338                 }
 339                 delta[motor_id]= -retract_length;
 340                 THEROBOT->solo_move(delta, retract_feedrate, motor_id+1);
 341
 342                 // zlift
 343                 if(retract_zlift_length > 0) {
 344                     float delta[3]{0,0,retract_zlift_length};
 345                     THEROBOT->solo_move(delta, retract_zlift_feedrate, 3);
 346                 }
 347
 348             }else if(gcode->g == 11) {
 349                 // unretract
 350                 if(retract_zlift_length > 0 && !this->cancel_zlift_restore) {
 351                     // reverse zlift happens before unretract
 352                     // NOTE we do not do this if cancel_zlift_restore is set to true, which happens if there is an absolute Z move inbetween G10 and G11
 353                     float delta[3]{0,0,-retract_zlift_length};
 354                     THEROBOT->solo_move(delta, retract_zlift_feedrate, 3);
 355                 }
 356
 357                 float delta[motor_id+1];
 358                 for (int i = 0; i < motor_id; ++i) {
 359                     delta[i]= 0;
 360                 }
 361                 delta[motor_id]= retract_length + retract_recover_length;
 362                 THEROBOT->solo_move(delta, retract_recover_feedrate, motor_id+1);
 363             }
 364
 365
 366         } else if( this->retracted && (gcode->g == 0 || gcode->g == 1) && gcode->has_letter('Z')) {
 367             // NOTE we cancel the zlift restore for the following G11 as we have moved to an absolute Z which we need to stay at
 368             this->cancel_zlift_restore = true;
 369         }
 370     }
 371
 372 }