|
|
@ -202,6 +202,16 @@
|
|
|
|
CardReader card;
|
|
|
|
CardReader card;
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool Running = true;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static float feedrate = 1500.0, next_feedrate, saved_feedrate;
|
|
|
|
|
|
|
|
float current_position[NUM_AXIS] = { 0.0 };
|
|
|
|
|
|
|
|
static float destination[NUM_AXIS] = { 0.0 };
|
|
|
|
|
|
|
|
bool axis_known_position[3] = { false };
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
static long gcode_N, gcode_LastN, Stopped_gcode_LastN = 0;
|
|
|
|
|
|
|
|
static char cmdbuffer[BUFSIZE][MAX_CMD_SIZE];
|
|
|
|
|
|
|
|
|
|
|
|
float homing_feedrate[] = HOMING_FEEDRATE;
|
|
|
|
float homing_feedrate[] = HOMING_FEEDRATE;
|
|
|
|
bool axis_relative_modes[] = AXIS_RELATIVE_MODES;
|
|
|
|
bool axis_relative_modes[] = AXIS_RELATIVE_MODES;
|
|
|
|
int feedmultiply = 100; //100->1 200->2
|
|
|
|
int feedmultiply = 100; //100->1 200->2
|
|
|
@ -210,23 +220,20 @@ int extruder_multiply[EXTRUDERS] = ARRAY_BY_EXTRUDERS(100, 100, 100, 100);
|
|
|
|
bool volumetric_enabled = false;
|
|
|
|
bool volumetric_enabled = false;
|
|
|
|
float filament_size[EXTRUDERS] = ARRAY_BY_EXTRUDERS(DEFAULT_NOMINAL_FILAMENT_DIA, DEFAULT_NOMINAL_FILAMENT_DIA, DEFAULT_NOMINAL_FILAMENT_DIA, DEFAULT_NOMINAL_FILAMENT_DIA);
|
|
|
|
float filament_size[EXTRUDERS] = ARRAY_BY_EXTRUDERS(DEFAULT_NOMINAL_FILAMENT_DIA, DEFAULT_NOMINAL_FILAMENT_DIA, DEFAULT_NOMINAL_FILAMENT_DIA, DEFAULT_NOMINAL_FILAMENT_DIA);
|
|
|
|
float volumetric_multiplier[EXTRUDERS] = ARRAY_BY_EXTRUDERS(1.0, 1.0, 1.0, 1.0);
|
|
|
|
float volumetric_multiplier[EXTRUDERS] = ARRAY_BY_EXTRUDERS(1.0, 1.0, 1.0, 1.0);
|
|
|
|
float current_position[NUM_AXIS] = { 0.0 };
|
|
|
|
|
|
|
|
float home_offset[3] = { 0 };
|
|
|
|
float home_offset[3] = { 0 };
|
|
|
|
float min_pos[3] = { X_MIN_POS, Y_MIN_POS, Z_MIN_POS };
|
|
|
|
float min_pos[3] = { X_MIN_POS, Y_MIN_POS, Z_MIN_POS };
|
|
|
|
float max_pos[3] = { X_MAX_POS, Y_MAX_POS, Z_MAX_POS };
|
|
|
|
float max_pos[3] = { X_MAX_POS, Y_MAX_POS, Z_MAX_POS };
|
|
|
|
bool axis_known_position[3] = { false };
|
|
|
|
|
|
|
|
uint8_t active_extruder = 0;
|
|
|
|
uint8_t active_extruder = 0;
|
|
|
|
int fanSpeed = 0;
|
|
|
|
int fanSpeed = 0;
|
|
|
|
bool cancel_heatup = false;
|
|
|
|
bool cancel_heatup = false;
|
|
|
|
|
|
|
|
|
|
|
|
const char errormagic[] PROGMEM = "Error:";
|
|
|
|
const char errormagic[] PROGMEM = "Error:";
|
|
|
|
const char echomagic[] PROGMEM = "echo:";
|
|
|
|
const char echomagic[] PROGMEM = "echo:";
|
|
|
|
const char axis_codes[NUM_AXIS] = {'X', 'Y', 'Z', 'E'};
|
|
|
|
const char axis_codes[NUM_AXIS] = {'X', 'Y', 'Z', 'E'};
|
|
|
|
static float destination[NUM_AXIS] = { 0 };
|
|
|
|
|
|
|
|
static float offset[3] = { 0 };
|
|
|
|
static float offset[3] = { 0 };
|
|
|
|
static float feedrate = 1500.0, next_feedrate, saved_feedrate;
|
|
|
|
|
|
|
|
static long gcode_N, gcode_LastN, Stopped_gcode_LastN = 0;
|
|
|
|
|
|
|
|
static bool relative_mode = false; //Determines Absolute or Relative Coordinates
|
|
|
|
static bool relative_mode = false; //Determines Absolute or Relative Coordinates
|
|
|
|
static char cmdbuffer[BUFSIZE][MAX_CMD_SIZE];
|
|
|
|
|
|
|
|
static int bufindr = 0;
|
|
|
|
static int bufindr = 0;
|
|
|
|
static int bufindw = 0;
|
|
|
|
static int bufindw = 0;
|
|
|
|
static int buflen = 0;
|
|
|
|
static int buflen = 0;
|
|
|
@ -243,7 +250,6 @@ static unsigned long stepper_inactive_time = DEFAULT_STEPPER_DEACTIVE_TIME*1000l
|
|
|
|
unsigned long starttime = 0; ///< Print job start time
|
|
|
|
unsigned long starttime = 0; ///< Print job start time
|
|
|
|
unsigned long stoptime = 0; ///< Print job stop time
|
|
|
|
unsigned long stoptime = 0; ///< Print job stop time
|
|
|
|
static uint8_t target_extruder;
|
|
|
|
static uint8_t target_extruder;
|
|
|
|
bool Stopped = false;
|
|
|
|
|
|
|
|
bool CooldownNoWait = true;
|
|
|
|
bool CooldownNoWait = true;
|
|
|
|
bool target_direction;
|
|
|
|
bool target_direction;
|
|
|
|
|
|
|
|
|
|
|
@ -743,7 +749,7 @@ void get_command()
|
|
|
|
case 1:
|
|
|
|
case 1:
|
|
|
|
case 2:
|
|
|
|
case 2:
|
|
|
|
case 3:
|
|
|
|
case 3:
|
|
|
|
if (Stopped == true) {
|
|
|
|
if (IsStopped()) {
|
|
|
|
SERIAL_ERRORLNPGM(MSG_ERR_STOPPED);
|
|
|
|
SERIAL_ERRORLNPGM(MSG_ERR_STOPPED);
|
|
|
|
LCD_MESSAGEPGM(MSG_STOPPED);
|
|
|
|
LCD_MESSAGEPGM(MSG_STOPPED);
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -1240,7 +1246,7 @@ inline void set_destination_to_current() { memcpy(destination, current_position,
|
|
|
|
if (z_min_endstop)
|
|
|
|
if (z_min_endstop)
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
{
|
|
|
|
{
|
|
|
|
if (!Stopped) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
SERIAL_ERRORLNPGM("Z-Probe failed to engage!");
|
|
|
|
SERIAL_ERRORLNPGM("Z-Probe failed to engage!");
|
|
|
|
LCD_ALERTMESSAGEPGM("Err: ZPROBE");
|
|
|
|
LCD_ALERTMESSAGEPGM("Err: ZPROBE");
|
|
|
@ -1315,7 +1321,7 @@ inline void set_destination_to_current() { memcpy(destination, current_position,
|
|
|
|
if (!z_min_endstop)
|
|
|
|
if (!z_min_endstop)
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
{
|
|
|
|
{
|
|
|
|
if (!Stopped) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
SERIAL_ERRORLNPGM("Z-Probe failed to retract!");
|
|
|
|
SERIAL_ERRORLNPGM("Z-Probe failed to retract!");
|
|
|
|
LCD_ALERTMESSAGEPGM("Err: ZPROBE");
|
|
|
|
LCD_ALERTMESSAGEPGM("Err: ZPROBE");
|
|
|
@ -1650,7 +1656,7 @@ static void homeaxis(AxisEnum axis) {
|
|
|
|
* G0, G1: Coordinated movement of X Y Z E axes
|
|
|
|
* G0, G1: Coordinated movement of X Y Z E axes
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
inline void gcode_G0_G1() {
|
|
|
|
inline void gcode_G0_G1() {
|
|
|
|
if (!Stopped) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
get_coordinates(); // For X Y Z E F
|
|
|
|
get_coordinates(); // For X Y Z E F
|
|
|
|
#ifdef FWRETRACT
|
|
|
|
#ifdef FWRETRACT
|
|
|
|
if (autoretract_enabled)
|
|
|
|
if (autoretract_enabled)
|
|
|
@ -1675,7 +1681,7 @@ inline void gcode_G0_G1() {
|
|
|
|
* G3: Counterclockwise Arc
|
|
|
|
* G3: Counterclockwise Arc
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
inline void gcode_G2_G3(bool clockwise) {
|
|
|
|
inline void gcode_G2_G3(bool clockwise) {
|
|
|
|
if (!Stopped) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
get_arc_coordinates();
|
|
|
|
get_arc_coordinates();
|
|
|
|
prepare_arc_move(clockwise);
|
|
|
|
prepare_arc_move(clockwise);
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -4119,7 +4125,7 @@ inline void gcode_M303() {
|
|
|
|
bool SCARA_move_to_cal(uint8_t delta_x, uint8_t delta_y) {
|
|
|
|
bool SCARA_move_to_cal(uint8_t delta_x, uint8_t delta_y) {
|
|
|
|
//SoftEndsEnabled = false; // Ignore soft endstops during calibration
|
|
|
|
//SoftEndsEnabled = false; // Ignore soft endstops during calibration
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
//SERIAL_ECHOLN(" Soft endstops disabled ");
|
|
|
|
if (! Stopped) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
//get_coordinates(); // For X Y Z E F
|
|
|
|
delta[X_AXIS] = delta_x;
|
|
|
|
delta[X_AXIS] = delta_x;
|
|
|
|
delta[Y_AXIS] = delta_y;
|
|
|
|
delta[Y_AXIS] = delta_y;
|
|
|
@ -4617,7 +4623,7 @@ inline void gcode_M907() {
|
|
|
|
* M999: Restart after being stopped
|
|
|
|
* M999: Restart after being stopped
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
inline void gcode_M999() {
|
|
|
|
inline void gcode_M999() {
|
|
|
|
Stopped = false;
|
|
|
|
Running = true;
|
|
|
|
lcd_reset_alert_level();
|
|
|
|
lcd_reset_alert_level();
|
|
|
|
gcode_LastN = Stopped_gcode_LastN;
|
|
|
|
gcode_LastN = Stopped_gcode_LastN;
|
|
|
|
FlushSerialRequestResend();
|
|
|
|
FlushSerialRequestResend();
|
|
|
@ -4652,7 +4658,7 @@ inline void gcode_T() {
|
|
|
|
// Save current position to return to after applying extruder offset
|
|
|
|
// Save current position to return to after applying extruder offset
|
|
|
|
set_destination_to_current();
|
|
|
|
set_destination_to_current();
|
|
|
|
#ifdef DUAL_X_CARRIAGE
|
|
|
|
#ifdef DUAL_X_CARRIAGE
|
|
|
|
if (dual_x_carriage_mode == DXC_AUTO_PARK_MODE && Stopped == false &&
|
|
|
|
if (dual_x_carriage_mode == DXC_AUTO_PARK_MODE && IsRunning() &&
|
|
|
|
(delayed_move_time != 0 || current_position[X_AXIS] != x_home_pos(active_extruder))) {
|
|
|
|
(delayed_move_time != 0 || current_position[X_AXIS] != x_home_pos(active_extruder))) {
|
|
|
|
// Park old head: 1) raise 2) move to park position 3) lower
|
|
|
|
// Park old head: 1) raise 2) move to park position 3) lower
|
|
|
|
plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS] + TOOLCHANGE_PARK_ZLIFT,
|
|
|
|
plan_buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS] + TOOLCHANGE_PARK_ZLIFT,
|
|
|
@ -4710,7 +4716,7 @@ inline void gcode_T() {
|
|
|
|
sync_plan_position();
|
|
|
|
sync_plan_position();
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
// Move to the old position if 'F' was in the parameters
|
|
|
|
// Move to the old position if 'F' was in the parameters
|
|
|
|
if (make_move && !Stopped) prepare_move();
|
|
|
|
if (make_move && IsRunning()) prepare_move();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef EXT_SOLENOID
|
|
|
|
#ifdef EXT_SOLENOID
|
|
|
@ -5877,7 +5883,7 @@ void manage_inactivity(bool ignore_stepper_queue/*=false*/) {
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef DUAL_X_CARRIAGE
|
|
|
|
#ifdef DUAL_X_CARRIAGE
|
|
|
|
// handle delayed move timeout
|
|
|
|
// handle delayed move timeout
|
|
|
|
if (delayed_move_time && ms > delayed_move_time + 1000 && !Stopped) {
|
|
|
|
if (delayed_move_time && ms > delayed_move_time + 1000 && IsRunning()) {
|
|
|
|
// travel moves have been received so enact them
|
|
|
|
// travel moves have been received so enact them
|
|
|
|
delayed_move_time = 0xFFFFFFFFUL; // force moves to be done
|
|
|
|
delayed_move_time = 0xFFFFFFFFUL; // force moves to be done
|
|
|
|
set_destination_to_current();
|
|
|
|
set_destination_to_current();
|
|
|
@ -5928,8 +5934,8 @@ void kill()
|
|
|
|
void Stop()
|
|
|
|
void Stop()
|
|
|
|
{
|
|
|
|
{
|
|
|
|
disable_heater();
|
|
|
|
disable_heater();
|
|
|
|
if(Stopped == false) {
|
|
|
|
if (IsRunning()) {
|
|
|
|
Stopped = true;
|
|
|
|
Running = false;
|
|
|
|
Stopped_gcode_LastN = gcode_LastN; // Save last g_code for restart
|
|
|
|
Stopped_gcode_LastN = gcode_LastN; // Save last g_code for restart
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
SERIAL_ERROR_START;
|
|
|
|
SERIAL_ERRORLNPGM(MSG_ERR_STOPPED);
|
|
|
|
SERIAL_ERRORLNPGM(MSG_ERR_STOPPED);
|
|
|
@ -5937,8 +5943,6 @@ void Stop()
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
bool IsStopped() { return Stopped; };
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef FAST_PWM_FAN
|
|
|
|
#ifdef FAST_PWM_FAN
|
|
|
|
void setPwmFrequency(uint8_t pin, int val)
|
|
|
|
void setPwmFrequency(uint8_t pin, int val)
|
|
|
|
{
|
|
|
|
{
|
|
|
|