|
|
@ -183,6 +183,9 @@
|
|
|
|
* M145 - Set the heatup state H<hotend> B<bed> F<fan speed> for S<material> (0=PLA, 1=ABS)
|
|
|
|
* M145 - Set the heatup state H<hotend> B<bed> F<fan speed> for S<material> (0=PLA, 1=ABS)
|
|
|
|
* M149 - Set temperature units
|
|
|
|
* M149 - Set temperature units
|
|
|
|
* M150 - Set BlinkM Color Output R: Red<0-255> U(!): Green<0-255> B: Blue<0-255> over i2c, G for green does not work.
|
|
|
|
* M150 - Set BlinkM Color Output R: Red<0-255> U(!): Green<0-255> B: Blue<0-255> over i2c, G for green does not work.
|
|
|
|
|
|
|
|
* M163 - Set a single proportion for a mixing extruder. Requires MIXING_EXTRUDER.
|
|
|
|
|
|
|
|
* M164 - Save the mix as a virtual extruder. Requires MIXING_EXTRUDER and MIXING_VIRTUAL_TOOLS.
|
|
|
|
|
|
|
|
* M165 - Set the proportions for a mixing extruder. Use parameters ABCDHI to set the mixing factors. Requires MIXING_EXTRUDER.
|
|
|
|
* M190 - Sxxx Wait for bed current temp to reach target temp. Waits only when heating
|
|
|
|
* M190 - Sxxx Wait for bed current temp to reach target temp. Waits only when heating
|
|
|
|
* Rxxx Wait for bed current temp to reach target temp. Waits when heating and cooling
|
|
|
|
* Rxxx Wait for bed current temp to reach target temp. Waits when heating and cooling
|
|
|
|
* M200 - Set filament diameter, D<diameter>, setting E axis units to cubic. (Use S0 to revert to linear units.)
|
|
|
|
* M200 - Set filament diameter, D<diameter>, setting E axis units to cubic. (Use S0 to revert to linear units.)
|
|
|
@ -397,17 +400,11 @@ static uint8_t target_extruder;
|
|
|
|
|
|
|
|
|
|
|
|
// Extruder offsets
|
|
|
|
// Extruder offsets
|
|
|
|
#if HOTENDS > 1
|
|
|
|
#if HOTENDS > 1
|
|
|
|
#ifndef HOTEND_OFFSET_X
|
|
|
|
|
|
|
|
#define HOTEND_OFFSET_X { 0 } // X offsets for each extruder
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifndef HOTEND_OFFSET_Y
|
|
|
|
|
|
|
|
#define HOTEND_OFFSET_Y { 0 } // Y offsets for each extruder
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
float hotend_offset[][HOTENDS] = {
|
|
|
|
float hotend_offset[][HOTENDS] = {
|
|
|
|
HOTEND_OFFSET_X,
|
|
|
|
HOTEND_OFFSET_X,
|
|
|
|
HOTEND_OFFSET_Y
|
|
|
|
HOTEND_OFFSET_Y
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
#ifdef HOTEND_OFFSET_Z
|
|
|
|
, { 0 } // Z offsets for each extruder
|
|
|
|
, HOTEND_OFFSET_Z
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
};
|
|
|
|
};
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
@ -507,6 +504,13 @@ static uint8_t target_extruder;
|
|
|
|
FilamentChangeMenuResponse filament_change_menu_response;
|
|
|
|
FilamentChangeMenuResponse filament_change_menu_response;
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(MIXING_EXTRUDER)
|
|
|
|
|
|
|
|
float mixing_factor[MIXING_STEPPERS];
|
|
|
|
|
|
|
|
#if MIXING_VIRTUAL_TOOLS > 1
|
|
|
|
|
|
|
|
float mixing_virtual_tool_mix[MIXING_VIRTUAL_TOOLS][MIXING_STEPPERS];
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
static bool send_ok[BUFSIZE];
|
|
|
|
static bool send_ok[BUFSIZE];
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_SERVOS
|
|
|
|
#if HAS_SERVOS
|
|
|
@ -952,6 +956,15 @@ void setup() {
|
|
|
|
lcd_init();
|
|
|
|
lcd_init();
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(MIXING_EXTRUDER) && MIXING_VIRTUAL_TOOLS > 1
|
|
|
|
|
|
|
|
// Initialize mixing to 100% color 1
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < MIXING_STEPPERS; i++)
|
|
|
|
|
|
|
|
mixing_factor[i] = (i == 0) ? 1 : 0;
|
|
|
|
|
|
|
|
for (uint8_t t = 0; t < MIXING_VIRTUAL_TOOLS; t++)
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < MIXING_STEPPERS; i++)
|
|
|
|
|
|
|
|
mixing_virtual_tool_mix[t][i] = mixing_factor[i];
|
|
|
|
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
@ -2544,6 +2557,39 @@ static void homeaxis(AxisEnum axis) {
|
|
|
|
|
|
|
|
|
|
|
|
#endif // FWRETRACT
|
|
|
|
#endif // FWRETRACT
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(MIXING_EXTRUDER)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void normalize_mix() {
|
|
|
|
|
|
|
|
float mix_total = 0.0;
|
|
|
|
|
|
|
|
for (int i = 0; i < MIXING_STEPPERS; i++) {
|
|
|
|
|
|
|
|
float v = mixing_factor[i];
|
|
|
|
|
|
|
|
if (v < 0) v = mixing_factor[i] = 0;
|
|
|
|
|
|
|
|
mix_total += v;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
// Scale all values if they don't add up to ~1.0
|
|
|
|
|
|
|
|
if (mix_total < 0.9999 || mix_total > 1.0001) {
|
|
|
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Warning: Mix factors must add up to 1.0. Scaling.");
|
|
|
|
|
|
|
|
float mix_scale = 1.0 / mix_total;
|
|
|
|
|
|
|
|
for (int i = 0; i < MIXING_STEPPERS; i++)
|
|
|
|
|
|
|
|
mixing_factor[i] *= mix_scale;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DIRECT_MIXING_IN_G1)
|
|
|
|
|
|
|
|
// Get mixing parameters from the GCode
|
|
|
|
|
|
|
|
// Factors that are left out are set to 0
|
|
|
|
|
|
|
|
// The total "must" be 1.0 (but it will be normalized)
|
|
|
|
|
|
|
|
void gcode_get_mix() {
|
|
|
|
|
|
|
|
const char* mixing_codes = "ABCDHI";
|
|
|
|
|
|
|
|
for (int i = 0; i < MIXING_STEPPERS; i++)
|
|
|
|
|
|
|
|
mixing_factor[i] = code_seen(mixing_codes[i]) ? code_value_float() : 0;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
normalize_mix();
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* ***************************************************************************
|
|
|
|
* ***************************************************************************
|
|
|
|
* ***************************** G-CODE HANDLING *****************************
|
|
|
|
* ***************************** G-CODE HANDLING *****************************
|
|
|
@ -2572,6 +2618,11 @@ void gcode_get_destination() {
|
|
|
|
if(!DEBUGGING(DRYRUN))
|
|
|
|
if(!DEBUGGING(DRYRUN))
|
|
|
|
print_job_timer.incFilamentUsed(destination[E_AXIS] - current_position[E_AXIS]);
|
|
|
|
print_job_timer.incFilamentUsed(destination[E_AXIS] - current_position[E_AXIS]);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Get ABCDHI mixing factors
|
|
|
|
|
|
|
|
#if ENABLED(MIXING_EXTRUDER) && ENABLED(DIRECT_MIXING_IN_G1)
|
|
|
|
|
|
|
|
gcode_get_mix();
|
|
|
|
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void unknown_command_error() {
|
|
|
|
void unknown_command_error() {
|
|
|
@ -4733,6 +4784,8 @@ inline void gcode_M109() {
|
|
|
|
|
|
|
|
|
|
|
|
KEEPALIVE_STATE(NOT_BUSY);
|
|
|
|
KEEPALIVE_STATE(NOT_BUSY);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
target_extruder = active_extruder; // for print_heaterstates
|
|
|
|
|
|
|
|
|
|
|
|
do {
|
|
|
|
do {
|
|
|
|
// Target temperature might be changed during the loop
|
|
|
|
// Target temperature might be changed during the loop
|
|
|
|
if (theTarget != thermalManager.degTargetBed()) {
|
|
|
|
if (theTarget != thermalManager.degTargetBed()) {
|
|
|
@ -5258,7 +5311,7 @@ inline void gcode_M200() {
|
|
|
|
if (volumetric_enabled) {
|
|
|
|
if (volumetric_enabled) {
|
|
|
|
filament_size[target_extruder] = code_value_linear_units();
|
|
|
|
filament_size[target_extruder] = code_value_linear_units();
|
|
|
|
// make sure all extruders have some sane value for the filament size
|
|
|
|
// make sure all extruders have some sane value for the filament size
|
|
|
|
for (int i = 0; i < EXTRUDERS; i++)
|
|
|
|
for (int i = 0; i < COUNT(filament_size); i++)
|
|
|
|
if (! filament_size[i]) filament_size[i] = DEFAULT_NOMINAL_FILAMENT_DIA;
|
|
|
|
if (! filament_size[i]) filament_size[i] = DEFAULT_NOMINAL_FILAMENT_DIA;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
@ -5496,7 +5549,7 @@ inline void gcode_M206() {
|
|
|
|
* T<tool>
|
|
|
|
* T<tool>
|
|
|
|
* X<xoffset>
|
|
|
|
* X<xoffset>
|
|
|
|
* Y<yoffset>
|
|
|
|
* Y<yoffset>
|
|
|
|
* Z<zoffset> - Available with DUAL_X_CARRIAGE
|
|
|
|
* Z<zoffset> - Available with DUAL_X_CARRIAGE and SWITCHING_EXTRUDER
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
inline void gcode_M218() {
|
|
|
|
inline void gcode_M218() {
|
|
|
|
if (get_target_extruder_from_command(218)) return;
|
|
|
|
if (get_target_extruder_from_command(218)) return;
|
|
|
@ -5504,7 +5557,7 @@ inline void gcode_M206() {
|
|
|
|
if (code_seen('X')) hotend_offset[X_AXIS][target_extruder] = code_value_axis_units(X_AXIS);
|
|
|
|
if (code_seen('X')) hotend_offset[X_AXIS][target_extruder] = code_value_axis_units(X_AXIS);
|
|
|
|
if (code_seen('Y')) hotend_offset[Y_AXIS][target_extruder] = code_value_axis_units(Y_AXIS);
|
|
|
|
if (code_seen('Y')) hotend_offset[Y_AXIS][target_extruder] = code_value_axis_units(Y_AXIS);
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE) || ENABLED(SWITCHING_EXTRUDER)
|
|
|
|
if (code_seen('Z')) hotend_offset[Z_AXIS][target_extruder] = code_value_axis_units(Z_AXIS);
|
|
|
|
if (code_seen('Z')) hotend_offset[Z_AXIS][target_extruder] = code_value_axis_units(Z_AXIS);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
@ -5515,7 +5568,7 @@ inline void gcode_M206() {
|
|
|
|
SERIAL_ECHO(hotend_offset[X_AXIS][e]);
|
|
|
|
SERIAL_ECHO(hotend_offset[X_AXIS][e]);
|
|
|
|
SERIAL_CHAR(',');
|
|
|
|
SERIAL_CHAR(',');
|
|
|
|
SERIAL_ECHO(hotend_offset[Y_AXIS][e]);
|
|
|
|
SERIAL_ECHO(hotend_offset[Y_AXIS][e]);
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE) || ENABLED(SWITCHING_EXTRUDER)
|
|
|
|
SERIAL_CHAR(',');
|
|
|
|
SERIAL_CHAR(',');
|
|
|
|
SERIAL_ECHO(hotend_offset[Z_AXIS][e]);
|
|
|
|
SERIAL_ECHO(hotend_offset[Z_AXIS][e]);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
@ -6528,6 +6581,60 @@ inline void gcode_M907() {
|
|
|
|
|
|
|
|
|
|
|
|
#endif // HAS_MICROSTEPS
|
|
|
|
#endif // HAS_MICROSTEPS
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(MIXING_EXTRUDER)
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
|
|
* M163: Set a single mix factor for a mixing extruder
|
|
|
|
|
|
|
|
* This is called "weight" by some systems.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* S[index] The channel index to set
|
|
|
|
|
|
|
|
* P[float] The mix value
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
inline void gcode_M163() {
|
|
|
|
|
|
|
|
int mix_index = code_seen('S') ? code_value_int() : 0;
|
|
|
|
|
|
|
|
float mix_value = code_seen('P') ? code_value_float() : 0.0;
|
|
|
|
|
|
|
|
if (mix_index < MIXING_STEPPERS) mixing_factor[mix_index] = mix_value;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if MIXING_VIRTUAL_TOOLS > 1
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
|
|
* M164: Store the current mix factors as a virtual tool.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* S[index] The virtual tool to store
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
inline void gcode_M164() {
|
|
|
|
|
|
|
|
int tool_index = code_seen('S') ? code_value_int() : 0;
|
|
|
|
|
|
|
|
if (tool_index < MIXING_VIRTUAL_TOOLS) {
|
|
|
|
|
|
|
|
normalize_mix();
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < MIXING_STEPPERS; i++)
|
|
|
|
|
|
|
|
mixing_virtual_tool_mix[tool_index][i] = mixing_factor[i];
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DIRECT_MIXING_IN_G1)
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
|
|
* M165: Set multiple mix factors for a mixing extruder.
|
|
|
|
|
|
|
|
* Factors that are left out will be set to 0.
|
|
|
|
|
|
|
|
* All factors together must add up to 1.0.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* A[factor] Mix factor for extruder stepper 1
|
|
|
|
|
|
|
|
* B[factor] Mix factor for extruder stepper 2
|
|
|
|
|
|
|
|
* C[factor] Mix factor for extruder stepper 3
|
|
|
|
|
|
|
|
* D[factor] Mix factor for extruder stepper 4
|
|
|
|
|
|
|
|
* H[factor] Mix factor for extruder stepper 5
|
|
|
|
|
|
|
|
* I[factor] Mix factor for extruder stepper 6
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
inline void gcode_M165() { gcode_get_mix(); }
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // MIXING_EXTRUDER
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* M999: Restart after being stopped
|
|
|
|
* M999: Restart after being stopped
|
|
|
|
*
|
|
|
|
*
|
|
|
@ -6548,6 +6655,20 @@ inline void gcode_M999() {
|
|
|
|
FlushSerialRequestResend();
|
|
|
|
FlushSerialRequestResend();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(SWITCHING_EXTRUDER)
|
|
|
|
|
|
|
|
inline void move_extruder_servo(uint8_t e) {
|
|
|
|
|
|
|
|
const int angles[2] = SWITCHING_EXTRUDER_SERVO_ANGLES;
|
|
|
|
|
|
|
|
MOVE_SERVO(SWITCHING_EXTRUDER_SERVO_NR, angles[e]);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
inline void invalid_extruder_error(const uint8_t &e) {
|
|
|
|
|
|
|
|
SERIAL_ECHO_START;
|
|
|
|
|
|
|
|
SERIAL_CHAR('T');
|
|
|
|
|
|
|
|
SERIAL_PROTOCOL_F(e, DEC);
|
|
|
|
|
|
|
|
SERIAL_ECHOLN(MSG_INVALID_EXTRUDER);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
* T0-T3: Switch tool, usually switching extruders
|
|
|
|
* T0-T3: Switch tool, usually switching extruders
|
|
|
|
*
|
|
|
|
*
|
|
|
@ -6555,264 +6676,314 @@ inline void gcode_M999() {
|
|
|
|
* S1 Don't move the tool in XY after change
|
|
|
|
* S1 Don't move the tool in XY after change
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
inline void gcode_T(uint8_t tmp_extruder) {
|
|
|
|
inline void gcode_T(uint8_t tmp_extruder) {
|
|
|
|
if (tmp_extruder >= EXTRUDERS) {
|
|
|
|
|
|
|
|
SERIAL_ECHO_START;
|
|
|
|
|
|
|
|
SERIAL_CHAR('T');
|
|
|
|
|
|
|
|
SERIAL_PROTOCOL_F(tmp_extruder, DEC);
|
|
|
|
|
|
|
|
SERIAL_ECHOLN(MSG_INVALID_EXTRUDER);
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
#if ENABLED(MIXING_EXTRUDER) && MIXING_VIRTUAL_TOOLS > 1
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
SERIAL_ECHOLNPGM(">>> gcode_T");
|
|
|
|
if (tmp_extruder >= MIXING_VIRTUAL_TOOLS) {
|
|
|
|
DEBUG_POS("BEFORE", current_position);
|
|
|
|
invalid_extruder_error(tmp_extruder);
|
|
|
|
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if HOTENDS > 1
|
|
|
|
// T0-Tnnn: Switch virtual tool by changing the mix
|
|
|
|
|
|
|
|
for (uint8_t j = 0; j < MIXING_STEPPERS; j++)
|
|
|
|
|
|
|
|
mixing_factor[j] = mixing_virtual_tool_mix[tmp_extruder][j];
|
|
|
|
|
|
|
|
|
|
|
|
float old_feedrate = feedrate;
|
|
|
|
#else //!MIXING_EXTRUDER || MIXING_VIRTUAL_TOOLS <= 1
|
|
|
|
|
|
|
|
|
|
|
|
if (code_seen('F')) {
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
float next_feedrate = code_value_axis_units(X_AXIS);
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
if (next_feedrate > 0.0) old_feedrate = feedrate = next_feedrate;
|
|
|
|
SERIAL_ECHOLNPGM(">>> gcode_T");
|
|
|
|
}
|
|
|
|
DEBUG_POS("BEFORE", current_position);
|
|
|
|
else
|
|
|
|
}
|
|
|
|
feedrate = XY_PROBE_FEEDRATE;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
if (tmp_extruder != active_extruder) {
|
|
|
|
#if HOTENDS > 1
|
|
|
|
bool no_move = code_seen('S') && code_value_bool();
|
|
|
|
|
|
|
|
if (!no_move && axis_unhomed_error(true, true, true)) {
|
|
|
|
if (tmp_extruder >= EXTRUDERS) {
|
|
|
|
SERIAL_ECHOLNPGM("No move on toolchange");
|
|
|
|
invalid_extruder_error(tmp_extruder);
|
|
|
|
no_move = true;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// Save current position to destination, for use later
|
|
|
|
float old_feedrate = feedrate;
|
|
|
|
set_destination_to_current();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
if (code_seen('F')) {
|
|
|
|
|
|
|
|
float next_feedrate = code_value_axis_units(X_AXIS);
|
|
|
|
|
|
|
|
if (next_feedrate > 0.0) old_feedrate = feedrate = next_feedrate;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
feedrate = XY_PROBE_FEEDRATE;
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
if (tmp_extruder != active_extruder) {
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
bool no_move = code_seen('S') && code_value_bool();
|
|
|
|
SERIAL_ECHOPGM("Dual X Carriage Mode ");
|
|
|
|
|
|
|
|
switch (dual_x_carriage_mode) {
|
|
|
|
if (!no_move && axis_unhomed_error(true, true, true)) {
|
|
|
|
case DXC_DUPLICATION_MODE: SERIAL_ECHOLNPGM("DXC_DUPLICATION_MODE"); break;
|
|
|
|
SERIAL_ECHOLNPGM("No move on toolchange");
|
|
|
|
case DXC_AUTO_PARK_MODE: SERIAL_ECHOLNPGM("DXC_AUTO_PARK_MODE"); break;
|
|
|
|
no_move = true;
|
|
|
|
case DXC_FULL_CONTROL_MODE: SERIAL_ECHOLNPGM("DXC_FULL_CONTROL_MODE"); break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
// Save current position to destination, for use later
|
|
|
|
#endif
|
|
|
|
set_destination_to_current();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
|
|
|
|
|
|
|
|
if (dual_x_carriage_mode == DXC_AUTO_PARK_MODE && IsRunning()
|
|
|
|
|
|
|
|
&& (delayed_move_time || current_position[X_AXIS] != x_home_pos(active_extruder))
|
|
|
|
|
|
|
|
) {
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
SERIAL_ECHOPAIR("Raise to ", current_position[Z_AXIS] + TOOLCHANGE_PARK_ZLIFT); SERIAL_EOL;
|
|
|
|
SERIAL_ECHOPGM("Dual X Carriage Mode ");
|
|
|
|
SERIAL_ECHOPAIR("MoveX to ", x_home_pos(active_extruder)); SERIAL_EOL;
|
|
|
|
switch (dual_x_carriage_mode) {
|
|
|
|
SERIAL_ECHOPAIR("Lower to ", current_position[Z_AXIS]); SERIAL_EOL;
|
|
|
|
case DXC_DUPLICATION_MODE: SERIAL_ECHOLNPGM("DXC_DUPLICATION_MODE"); break;
|
|
|
|
|
|
|
|
case DXC_AUTO_PARK_MODE: SERIAL_ECHOLNPGM("DXC_AUTO_PARK_MODE"); break;
|
|
|
|
|
|
|
|
case DXC_FULL_CONTROL_MODE: SERIAL_ECHOLNPGM("DXC_FULL_CONTROL_MODE"); break;
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
// Park old head: 1) raise 2) move to park position 3) lower
|
|
|
|
|
|
|
|
planner.buffer_line(current_position[X_AXIS], current_position[Y_AXIS], current_position[Z_AXIS] + TOOLCHANGE_PARK_ZLIFT,
|
|
|
|
|
|
|
|
current_position[E_AXIS], planner.max_feedrate[Z_AXIS], active_extruder);
|
|
|
|
|
|
|
|
planner.buffer_line(x_home_pos(active_extruder), current_position[Y_AXIS], current_position[Z_AXIS] + TOOLCHANGE_PARK_ZLIFT,
|
|
|
|
|
|
|
|
current_position[E_AXIS], planner.max_feedrate[X_AXIS], active_extruder);
|
|
|
|
|
|
|
|
planner.buffer_line(x_home_pos(active_extruder), current_position[Y_AXIS], current_position[Z_AXIS],
|
|
|
|
|
|
|
|
current_position[E_AXIS], planner.max_feedrate[Z_AXIS], active_extruder);
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// apply Y & Z extruder offset (x offset is already used in determining home pos)
|
|
|
|
if (dual_x_carriage_mode == DXC_AUTO_PARK_MODE && IsRunning() &&
|
|
|
|
current_position[Y_AXIS] -= hotend_offset[Y_AXIS][active_extruder] - hotend_offset[Y_AXIS][tmp_extruder];
|
|
|
|
(delayed_move_time || current_position[X_AXIS] != x_home_pos(active_extruder))
|
|
|
|
current_position[Z_AXIS] -= hotend_offset[Z_AXIS][active_extruder] - hotend_offset[Z_AXIS][tmp_extruder];
|
|
|
|
) {
|
|
|
|
active_extruder = tmp_extruder;
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR("Raise to ", current_position[Z_AXIS] + TOOLCHANGE_PARK_ZLIFT); SERIAL_EOL;
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR("MoveX to ", x_home_pos(active_extruder)); SERIAL_EOL;
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR("Lower to ", current_position[Z_AXIS]); SERIAL_EOL;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
// Park old head: 1) raise 2) move to park position 3) lower
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < 3; i++)
|
|
|
|
|
|
|
|
planner.buffer_line(
|
|
|
|
|
|
|
|
i == 0 ? current_position[X_AXIS] : x_home_pos(active_extruder),
|
|
|
|
|
|
|
|
current_position[Y_AXIS],
|
|
|
|
|
|
|
|
current_position[Z_AXIS] + (i == 2 ? 0 : TOOLCHANGE_PARK_ZLIFT),
|
|
|
|
|
|
|
|
current_position[E_AXIS],
|
|
|
|
|
|
|
|
planner.max_feedrate[i == 1 ? X_AXIS : Z_AXIS],
|
|
|
|
|
|
|
|
active_extruder
|
|
|
|
|
|
|
|
);
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// This function resets the max/min values - the current position may be overwritten below.
|
|
|
|
// apply Y & Z extruder offset (x offset is already used in determining home pos)
|
|
|
|
set_axis_is_at_home(X_AXIS);
|
|
|
|
current_position[Y_AXIS] -= hotend_offset[Y_AXIS][active_extruder] - hotend_offset[Y_AXIS][tmp_extruder];
|
|
|
|
|
|
|
|
current_position[Z_AXIS] -= hotend_offset[Z_AXIS][active_extruder] - hotend_offset[Z_AXIS][tmp_extruder];
|
|
|
|
|
|
|
|
active_extruder = tmp_extruder;
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
// This function resets the max/min values - the current position may be overwritten below.
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("New Extruder", current_position);
|
|
|
|
set_axis_is_at_home(X_AXIS);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
switch (dual_x_carriage_mode) {
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
case DXC_FULL_CONTROL_MODE:
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("New Extruder", current_position);
|
|
|
|
current_position[X_AXIS] = inactive_extruder_x_pos;
|
|
|
|
#endif
|
|
|
|
inactive_extruder_x_pos = destination[X_AXIS];
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
case DXC_DUPLICATION_MODE:
|
|
|
|
|
|
|
|
active_extruder_parked = (active_extruder == 0); // this triggers the second extruder to move into the duplication position
|
|
|
|
|
|
|
|
if (active_extruder_parked)
|
|
|
|
|
|
|
|
current_position[X_AXIS] = inactive_extruder_x_pos;
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
current_position[X_AXIS] = destination[X_AXIS] + duplicate_extruder_x_offset;
|
|
|
|
|
|
|
|
inactive_extruder_x_pos = destination[X_AXIS];
|
|
|
|
|
|
|
|
extruder_duplication_enabled = false;
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
|
|
|
// record raised toolhead position for use by unpark
|
|
|
|
|
|
|
|
memcpy(raised_parked_position, current_position, sizeof(raised_parked_position));
|
|
|
|
|
|
|
|
raised_parked_position[Z_AXIS] += TOOLCHANGE_UNPARK_ZLIFT;
|
|
|
|
|
|
|
|
active_extruder_parked = true;
|
|
|
|
|
|
|
|
delayed_move_time = 0;
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
switch (dual_x_carriage_mode) {
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
case DXC_FULL_CONTROL_MODE:
|
|
|
|
SERIAL_ECHOPAIR("Active extruder parked: ", active_extruder_parked ? "yes" : "no");
|
|
|
|
current_position[X_AXIS] = inactive_extruder_x_pos;
|
|
|
|
SERIAL_EOL;
|
|
|
|
inactive_extruder_x_pos = destination[X_AXIS];
|
|
|
|
DEBUG_POS("New extruder (parked)", current_position);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case DXC_DUPLICATION_MODE:
|
|
|
|
|
|
|
|
active_extruder_parked = (active_extruder == 0); // this triggers the second extruder to move into the duplication position
|
|
|
|
|
|
|
|
if (active_extruder_parked)
|
|
|
|
|
|
|
|
current_position[X_AXIS] = inactive_extruder_x_pos;
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
current_position[X_AXIS] = destination[X_AXIS] + duplicate_extruder_x_offset;
|
|
|
|
|
|
|
|
inactive_extruder_x_pos = destination[X_AXIS];
|
|
|
|
|
|
|
|
extruder_duplication_enabled = false;
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
|
|
|
// record raised toolhead position for use by unpark
|
|
|
|
|
|
|
|
memcpy(raised_parked_position, current_position, sizeof(raised_parked_position));
|
|
|
|
|
|
|
|
raised_parked_position[Z_AXIS] += TOOLCHANGE_UNPARK_ZLIFT;
|
|
|
|
|
|
|
|
active_extruder_parked = true;
|
|
|
|
|
|
|
|
delayed_move_time = 0;
|
|
|
|
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// No extra case for AUTO_BED_LEVELING_FEATURE in DUAL_X_CARRIAGE. Does that mean they don't work together?
|
|
|
|
|
|
|
|
#else // !DUAL_X_CARRIAGE
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
|
|
|
* Set current_position to the position of the new nozzle.
|
|
|
|
|
|
|
|
* Offsets are based on linear distance, so we need to get
|
|
|
|
|
|
|
|
* the resulting position in coordinate space.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* - With grid or 3-point leveling, offset XYZ by a tilted vector
|
|
|
|
|
|
|
|
* - With mesh leveling, update Z for the new position
|
|
|
|
|
|
|
|
* - Otherwise, just use the raw linear distance
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* Software endstops are altered here too. Consider a case where:
|
|
|
|
|
|
|
|
* E0 at X=0 ... E1 at X=10
|
|
|
|
|
|
|
|
* When we switch to E1 now X=10, but E1 can't move left.
|
|
|
|
|
|
|
|
* To express this we apply the change in XY to the software endstops.
|
|
|
|
|
|
|
|
* E1 can move farther right than E0, so the right limit is extended.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* Note that we don't adjust the Z software endstops. Why not?
|
|
|
|
|
|
|
|
* Consider a case where Z=0 (here) and switching to E1 makes Z=1
|
|
|
|
|
|
|
|
* because the bed is 1mm lower at the new position. As long as
|
|
|
|
|
|
|
|
* the first nozzle is out of the way, the carriage should be
|
|
|
|
|
|
|
|
* allowed to move 1mm lower. This technically "breaks" the
|
|
|
|
|
|
|
|
* Z software endstop. But this is technically correct (and
|
|
|
|
|
|
|
|
* there is no viable alternative).
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
// Offset extruder, make sure to apply the bed level rotation matrix
|
|
|
|
|
|
|
|
vector_3 tmp_offset_vec = vector_3(hotend_offset[X_AXIS][tmp_extruder],
|
|
|
|
|
|
|
|
hotend_offset[Y_AXIS][tmp_extruder],
|
|
|
|
|
|
|
|
0),
|
|
|
|
|
|
|
|
act_offset_vec = vector_3(hotend_offset[X_AXIS][active_extruder],
|
|
|
|
|
|
|
|
hotend_offset[Y_AXIS][active_extruder],
|
|
|
|
|
|
|
|
0),
|
|
|
|
|
|
|
|
offset_vec = tmp_offset_vec - act_offset_vec;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
tmp_offset_vec.debug("tmp_offset_vec");
|
|
|
|
SERIAL_ECHOPAIR("Active extruder parked: ", active_extruder_parked ? "yes" : "no");
|
|
|
|
act_offset_vec.debug("act_offset_vec");
|
|
|
|
SERIAL_EOL;
|
|
|
|
offset_vec.debug("offset_vec (BEFORE)");
|
|
|
|
DEBUG_POS("New extruder (parked)", current_position);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
offset_vec.apply_rotation(planner.bed_level_matrix.transpose(planner.bed_level_matrix));
|
|
|
|
// No extra case for AUTO_BED_LEVELING_FEATURE in DUAL_X_CARRIAGE. Does that mean they don't work together?
|
|
|
|
|
|
|
|
#else // !DUAL_X_CARRIAGE
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) offset_vec.debug("offset_vec (AFTER)");
|
|
|
|
#if ENABLED(SWITCHING_EXTRUDER)
|
|
|
|
|
|
|
|
// <0 if the new nozzle is higher, >0 if lower. A bigger raise when lower.
|
|
|
|
|
|
|
|
float z_diff = hotend_offset[Z_AXIS][active_extruder] - hotend_offset[Z_AXIS][tmp_extruder],
|
|
|
|
|
|
|
|
z_raise = 0.3 + (z_diff > 0.0 ? z_diff : 0.0);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Always raise by some amount
|
|
|
|
|
|
|
|
planner.buffer_line(
|
|
|
|
|
|
|
|
current_position[X_AXIS],
|
|
|
|
|
|
|
|
current_position[Y_AXIS],
|
|
|
|
|
|
|
|
current_position[Z_AXIS] + z_raise,
|
|
|
|
|
|
|
|
current_position[E_AXIS],
|
|
|
|
|
|
|
|
planner.max_feedrate[Z_AXIS],
|
|
|
|
|
|
|
|
active_extruder
|
|
|
|
|
|
|
|
);
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
move_extruder_servo(active_extruder);
|
|
|
|
|
|
|
|
delay(500);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Move back down, if needed
|
|
|
|
|
|
|
|
if (z_raise != z_diff) {
|
|
|
|
|
|
|
|
planner.buffer_line(
|
|
|
|
|
|
|
|
current_position[X_AXIS],
|
|
|
|
|
|
|
|
current_position[Y_AXIS],
|
|
|
|
|
|
|
|
current_position[Z_AXIS] + z_diff,
|
|
|
|
|
|
|
|
current_position[E_AXIS],
|
|
|
|
|
|
|
|
planner.max_feedrate[Z_AXIS],
|
|
|
|
|
|
|
|
active_extruder
|
|
|
|
|
|
|
|
);
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// Adjustments to the current position
|
|
|
|
/**
|
|
|
|
float xydiff[2] = { offset_vec.x, offset_vec.y };
|
|
|
|
* Set current_position to the position of the new nozzle.
|
|
|
|
current_position[Z_AXIS] += offset_vec.z;
|
|
|
|
* Offsets are based on linear distance, so we need to get
|
|
|
|
|
|
|
|
* the resulting position in coordinate space.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* - With grid or 3-point leveling, offset XYZ by a tilted vector
|
|
|
|
|
|
|
|
* - With mesh leveling, update Z for the new position
|
|
|
|
|
|
|
|
* - Otherwise, just use the raw linear distance
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* Software endstops are altered here too. Consider a case where:
|
|
|
|
|
|
|
|
* E0 at X=0 ... E1 at X=10
|
|
|
|
|
|
|
|
* When we switch to E1 now X=10, but E1 can't move left.
|
|
|
|
|
|
|
|
* To express this we apply the change in XY to the software endstops.
|
|
|
|
|
|
|
|
* E1 can move farther right than E0, so the right limit is extended.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* Note that we don't adjust the Z software endstops. Why not?
|
|
|
|
|
|
|
|
* Consider a case where Z=0 (here) and switching to E1 makes Z=1
|
|
|
|
|
|
|
|
* because the bed is 1mm lower at the new position. As long as
|
|
|
|
|
|
|
|
* the first nozzle is out of the way, the carriage should be
|
|
|
|
|
|
|
|
* allowed to move 1mm lower. This technically "breaks" the
|
|
|
|
|
|
|
|
* Z software endstop. But this is technically correct (and
|
|
|
|
|
|
|
|
* there is no viable alternative).
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
// Offset extruder, make sure to apply the bed level rotation matrix
|
|
|
|
|
|
|
|
vector_3 tmp_offset_vec = vector_3(hotend_offset[X_AXIS][tmp_extruder],
|
|
|
|
|
|
|
|
hotend_offset[Y_AXIS][tmp_extruder],
|
|
|
|
|
|
|
|
0),
|
|
|
|
|
|
|
|
act_offset_vec = vector_3(hotend_offset[X_AXIS][active_extruder],
|
|
|
|
|
|
|
|
hotend_offset[Y_AXIS][active_extruder],
|
|
|
|
|
|
|
|
0),
|
|
|
|
|
|
|
|
offset_vec = tmp_offset_vec - act_offset_vec;
|
|
|
|
|
|
|
|
|
|
|
|
#else // !AUTO_BED_LEVELING_FEATURE
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
tmp_offset_vec.debug("tmp_offset_vec");
|
|
|
|
|
|
|
|
act_offset_vec.debug("act_offset_vec");
|
|
|
|
|
|
|
|
offset_vec.debug("offset_vec (BEFORE)");
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
float xydiff[2] = {
|
|
|
|
offset_vec.apply_rotation(planner.bed_level_matrix.transpose(planner.bed_level_matrix));
|
|
|
|
hotend_offset[X_AXIS][tmp_extruder] - hotend_offset[X_AXIS][active_extruder],
|
|
|
|
|
|
|
|
hotend_offset[Y_AXIS][tmp_extruder] - hotend_offset[Y_AXIS][active_extruder]
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(MESH_BED_LEVELING)
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) offset_vec.debug("offset_vec (AFTER)");
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
if (mbl.active()) {
|
|
|
|
// Adjustments to the current position
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
float xydiff[2] = { offset_vec.x, offset_vec.y };
|
|
|
|
if (DEBUGGING(LEVELING)) SERIAL_ECHOPAIR("Z before MBL: ", current_position[Z_AXIS]);
|
|
|
|
current_position[Z_AXIS] += offset_vec.z;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
float xpos = RAW_CURRENT_POSITION(X_AXIS),
|
|
|
|
|
|
|
|
ypos = RAW_CURRENT_POSITION(Y_AXIS);
|
|
|
|
|
|
|
|
current_position[Z_AXIS] += mbl.get_z(xpos + xydiff[X_AXIS], ypos + xydiff[Y_AXIS]) - mbl.get_z(xpos, ypos);
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR(" after: ", current_position[Z_AXIS]);
|
|
|
|
|
|
|
|
SERIAL_EOL;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // MESH_BED_LEVELING
|
|
|
|
#else // !AUTO_BED_LEVELING_FEATURE
|
|
|
|
|
|
|
|
|
|
|
|
#endif // !AUTO_BED_LEVELING_FEATURE
|
|
|
|
float xydiff[2] = {
|
|
|
|
|
|
|
|
hotend_offset[X_AXIS][tmp_extruder] - hotend_offset[X_AXIS][active_extruder],
|
|
|
|
|
|
|
|
hotend_offset[Y_AXIS][tmp_extruder] - hotend_offset[Y_AXIS][active_extruder]
|
|
|
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
#if ENABLED(MESH_BED_LEVELING)
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR("Offset Tool XY by { ", xydiff[X_AXIS]);
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR(", ", xydiff[X_AXIS]);
|
|
|
|
|
|
|
|
SERIAL_ECHOLNPGM(" }");
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// The newly-selected extruder XY is actually at...
|
|
|
|
if (mbl.active()) {
|
|
|
|
current_position[X_AXIS] += xydiff[X_AXIS];
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
current_position[Y_AXIS] += xydiff[Y_AXIS];
|
|
|
|
if (DEBUGGING(LEVELING)) SERIAL_ECHOPAIR("Z before MBL: ", current_position[Z_AXIS]);
|
|
|
|
for (uint8_t i = X_AXIS; i <= Y_AXIS; i++) {
|
|
|
|
#endif
|
|
|
|
position_shift[i] += xydiff[i];
|
|
|
|
float xpos = RAW_CURRENT_POSITION(X_AXIS),
|
|
|
|
update_software_endstops((AxisEnum)i);
|
|
|
|
ypos = RAW_CURRENT_POSITION(Y_AXIS);
|
|
|
|
}
|
|
|
|
current_position[Z_AXIS] += mbl.get_z(xpos + xydiff[X_AXIS], ypos + xydiff[Y_AXIS]) - mbl.get_z(xpos, ypos);
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR(" after: ", current_position[Z_AXIS]);
|
|
|
|
|
|
|
|
SERIAL_EOL;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// Set the new active extruder
|
|
|
|
#endif // MESH_BED_LEVELING
|
|
|
|
active_extruder = tmp_extruder;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // !DUAL_X_CARRIAGE
|
|
|
|
#endif // !AUTO_BED_LEVELING_FEATURE
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("Sync After Toolchange", current_position);
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
#endif
|
|
|
|
SERIAL_ECHOPAIR("Offset Tool XY by { ", xydiff[X_AXIS]);
|
|
|
|
|
|
|
|
SERIAL_ECHOPAIR(", ", xydiff[X_AXIS]);
|
|
|
|
|
|
|
|
SERIAL_ECHOLNPGM(" }");
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// Tell the planner the new "current position"
|
|
|
|
// The newly-selected extruder XY is actually at...
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
current_position[X_AXIS] += xydiff[X_AXIS];
|
|
|
|
|
|
|
|
current_position[Y_AXIS] += xydiff[Y_AXIS];
|
|
|
|
|
|
|
|
for (uint8_t i = X_AXIS; i <= Y_AXIS; i++) {
|
|
|
|
|
|
|
|
position_shift[i] += xydiff[i];
|
|
|
|
|
|
|
|
update_software_endstops((AxisEnum)i);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Set the new active extruder
|
|
|
|
|
|
|
|
active_extruder = tmp_extruder;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // !DUAL_X_CARRIAGE
|
|
|
|
|
|
|
|
|
|
|
|
// Move to the "old position" (move the extruder into place)
|
|
|
|
|
|
|
|
if (!no_move && IsRunning()) {
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("Move back", destination);
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("Sync After Toolchange", current_position);
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
prepare_move_to_destination();
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
} // (tmp_extruder != active_extruder)
|
|
|
|
// Tell the planner the new "current position"
|
|
|
|
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
// Move to the "old position" (move the extruder into place)
|
|
|
|
|
|
|
|
if (!no_move && IsRunning()) {
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) DEBUG_POS("Move back", destination);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
prepare_move_to_destination();
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(EXT_SOLENOID)
|
|
|
|
} // (tmp_extruder != active_extruder)
|
|
|
|
disable_all_solenoids();
|
|
|
|
|
|
|
|
enable_solenoid_on_active_extruder();
|
|
|
|
|
|
|
|
#endif // EXT_SOLENOID
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
feedrate = old_feedrate;
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
|
|
|
|
#else // !HOTENDS > 1
|
|
|
|
#if ENABLED(EXT_SOLENOID)
|
|
|
|
|
|
|
|
disable_all_solenoids();
|
|
|
|
|
|
|
|
enable_solenoid_on_active_extruder();
|
|
|
|
|
|
|
|
#endif // EXT_SOLENOID
|
|
|
|
|
|
|
|
|
|
|
|
// Set the new active extruder
|
|
|
|
feedrate = old_feedrate;
|
|
|
|
active_extruder = tmp_extruder;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#else // HOTENDS <= 1
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
// Set the new active extruder
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
active_extruder = tmp_extruder;
|
|
|
|
DEBUG_POS("AFTER", current_position);
|
|
|
|
|
|
|
|
SERIAL_ECHOLNPGM("<<< gcode_T");
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
SERIAL_ECHO_START;
|
|
|
|
#endif // HOTENDS <= 1
|
|
|
|
SERIAL_ECHOPGM(MSG_ACTIVE_EXTRUDER);
|
|
|
|
|
|
|
|
SERIAL_PROTOCOLLN((int)active_extruder);
|
|
|
|
#if ENABLED(DEBUG_LEVELING_FEATURE)
|
|
|
|
|
|
|
|
if (DEBUGGING(LEVELING)) {
|
|
|
|
|
|
|
|
DEBUG_POS("AFTER", current_position);
|
|
|
|
|
|
|
|
SERIAL_ECHOLNPGM("<<< gcode_T");
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
SERIAL_ECHO_START;
|
|
|
|
|
|
|
|
SERIAL_ECHOPGM(MSG_ACTIVE_EXTRUDER);
|
|
|
|
|
|
|
|
SERIAL_PROTOCOLLN((int)active_extruder);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif //!MIXING_EXTRUDER || MIXING_VIRTUAL_TOOLS <= 1
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
@ -7219,6 +7390,22 @@ void process_next_command() {
|
|
|
|
|
|
|
|
|
|
|
|
#endif //EXPERIMENTAL_I2CBUS
|
|
|
|
#endif //EXPERIMENTAL_I2CBUS
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(MIXING_EXTRUDER)
|
|
|
|
|
|
|
|
case 163: // M163 S<int> P<float> set weight for a mixing extruder
|
|
|
|
|
|
|
|
gcode_M163();
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
#if MIXING_VIRTUAL_TOOLS > 1
|
|
|
|
|
|
|
|
case 164: // M164 S<int> save current mix as a virtual extruder
|
|
|
|
|
|
|
|
gcode_M164();
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if ENABLED(DIRECT_MIXING_IN_G1)
|
|
|
|
|
|
|
|
case 165: // M165 [ABCDHI]<float> set multiple mix weights
|
|
|
|
|
|
|
|
gcode_M165();
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
case 200: // M200 D<diameter> Set filament diameter and set E axis units to cubic. (Use S0 to revert to linear units.)
|
|
|
|
case 200: // M200 D<diameter> Set filament diameter and set E axis units to cubic. (Use S0 to revert to linear units.)
|
|
|
|
gcode_M200();
|
|
|
|
gcode_M200();
|
|
|
|
break;
|
|
|
|
break;
|
|
|
@ -8033,14 +8220,14 @@ void prepare_move_to_destination() {
|
|
|
|
nextMotorCheck = ms + 2500UL; // Not a time critical function, so only check every 2.5s
|
|
|
|
nextMotorCheck = ms + 2500UL; // Not a time critical function, so only check every 2.5s
|
|
|
|
if (X_ENABLE_READ == X_ENABLE_ON || Y_ENABLE_READ == Y_ENABLE_ON || Z_ENABLE_READ == Z_ENABLE_ON || thermalManager.soft_pwm_bed > 0
|
|
|
|
if (X_ENABLE_READ == X_ENABLE_ON || Y_ENABLE_READ == Y_ENABLE_ON || Z_ENABLE_READ == Z_ENABLE_ON || thermalManager.soft_pwm_bed > 0
|
|
|
|
|| E0_ENABLE_READ == E_ENABLE_ON // If any of the drivers are enabled...
|
|
|
|
|| E0_ENABLE_READ == E_ENABLE_ON // If any of the drivers are enabled...
|
|
|
|
#if EXTRUDERS > 1
|
|
|
|
#if E_STEPPERS > 1
|
|
|
|
|| E1_ENABLE_READ == E_ENABLE_ON
|
|
|
|
|| E1_ENABLE_READ == E_ENABLE_ON
|
|
|
|
#if HAS_X2_ENABLE
|
|
|
|
#if HAS_X2_ENABLE
|
|
|
|
|| X2_ENABLE_READ == X_ENABLE_ON
|
|
|
|
|| X2_ENABLE_READ == X_ENABLE_ON
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#if EXTRUDERS > 2
|
|
|
|
#if E_STEPPERS > 2
|
|
|
|
|| E2_ENABLE_READ == E_ENABLE_ON
|
|
|
|
|| E2_ENABLE_READ == E_ENABLE_ON
|
|
|
|
#if EXTRUDERS > 3
|
|
|
|
#if E_STEPPERS > 3
|
|
|
|
|| E3_ENABLE_READ == E_ENABLE_ON
|
|
|
|
|| E3_ENABLE_READ == E_ENABLE_ON
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
@ -8303,25 +8490,29 @@ void manage_inactivity(bool ignore_stepper_queue/*=false*/) {
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(EXTRUDER_RUNOUT_PREVENT)
|
|
|
|
#if ENABLED(EXTRUDER_RUNOUT_PREVENT)
|
|
|
|
if (ELAPSED(ms, previous_cmd_ms + (EXTRUDER_RUNOUT_SECONDS) * 1000UL))
|
|
|
|
if (ELAPSED(ms, previous_cmd_ms + (EXTRUDER_RUNOUT_SECONDS) * 1000UL)
|
|
|
|
if (thermalManager.degHotend(active_extruder) > EXTRUDER_RUNOUT_MINTEMP) {
|
|
|
|
&& thermalManager.degHotend(active_extruder) > EXTRUDER_RUNOUT_MINTEMP) {
|
|
|
|
|
|
|
|
#if ENABLED(SWITCHING_EXTRUDER)
|
|
|
|
|
|
|
|
bool oldstatus = E0_ENABLE_READ;
|
|
|
|
|
|
|
|
enable_e0();
|
|
|
|
|
|
|
|
#else // !SWITCHING_EXTRUDER
|
|
|
|
bool oldstatus;
|
|
|
|
bool oldstatus;
|
|
|
|
switch (active_extruder) {
|
|
|
|
switch (active_extruder) {
|
|
|
|
case 0:
|
|
|
|
case 0:
|
|
|
|
oldstatus = E0_ENABLE_READ;
|
|
|
|
oldstatus = E0_ENABLE_READ;
|
|
|
|
enable_e0();
|
|
|
|
enable_e0();
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
#if EXTRUDERS > 1
|
|
|
|
#if E_STEPPERS > 1
|
|
|
|
case 1:
|
|
|
|
case 1:
|
|
|
|
oldstatus = E1_ENABLE_READ;
|
|
|
|
oldstatus = E1_ENABLE_READ;
|
|
|
|
enable_e1();
|
|
|
|
enable_e1();
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
#if EXTRUDERS > 2
|
|
|
|
#if E_STEPPERS > 2
|
|
|
|
case 2:
|
|
|
|
case 2:
|
|
|
|
oldstatus = E2_ENABLE_READ;
|
|
|
|
oldstatus = E2_ENABLE_READ;
|
|
|
|
enable_e2();
|
|
|
|
enable_e2();
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
#if EXTRUDERS > 3
|
|
|
|
#if E_STEPPERS > 3
|
|
|
|
case 3:
|
|
|
|
case 3:
|
|
|
|
oldstatus = E3_ENABLE_READ;
|
|
|
|
oldstatus = E3_ENABLE_READ;
|
|
|
|
enable_e3();
|
|
|
|
enable_e3();
|
|
|
@ -8330,37 +8521,43 @@ void manage_inactivity(bool ignore_stepper_queue/*=false*/) {
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
float oldepos = current_position[E_AXIS], oldedes = destination[E_AXIS];
|
|
|
|
#endif // !SWITCHING_EXTRUDER
|
|
|
|
planner.buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS],
|
|
|
|
|
|
|
|
destination[E_AXIS] + (EXTRUDER_RUNOUT_EXTRUDE) * (EXTRUDER_RUNOUT_ESTEPS) / planner.axis_steps_per_mm[E_AXIS],
|
|
|
|
float oldepos = current_position[E_AXIS], oldedes = destination[E_AXIS];
|
|
|
|
(EXTRUDER_RUNOUT_SPEED) / 60. * (EXTRUDER_RUNOUT_ESTEPS) / planner.axis_steps_per_mm[E_AXIS], active_extruder);
|
|
|
|
planner.buffer_line(destination[X_AXIS], destination[Y_AXIS], destination[Z_AXIS],
|
|
|
|
|
|
|
|
destination[E_AXIS] + (EXTRUDER_RUNOUT_EXTRUDE) * (EXTRUDER_RUNOUT_ESTEPS) / planner.axis_steps_per_mm[E_AXIS],
|
|
|
|
|
|
|
|
(EXTRUDER_RUNOUT_SPEED) / 60. * (EXTRUDER_RUNOUT_ESTEPS) / planner.axis_steps_per_mm[E_AXIS], active_extruder);
|
|
|
|
current_position[E_AXIS] = oldepos;
|
|
|
|
current_position[E_AXIS] = oldepos;
|
|
|
|
destination[E_AXIS] = oldedes;
|
|
|
|
destination[E_AXIS] = oldedes;
|
|
|
|
planner.set_e_position_mm(oldepos);
|
|
|
|
planner.set_e_position_mm(oldepos);
|
|
|
|
previous_cmd_ms = ms; // refresh_cmd_timeout()
|
|
|
|
previous_cmd_ms = ms; // refresh_cmd_timeout()
|
|
|
|
stepper.synchronize();
|
|
|
|
stepper.synchronize();
|
|
|
|
switch (active_extruder) {
|
|
|
|
#if ENABLED(SWITCHING_EXTRUDER)
|
|
|
|
case 0:
|
|
|
|
E0_ENABLE_WRITE(oldstatus);
|
|
|
|
E0_ENABLE_WRITE(oldstatus);
|
|
|
|
#else
|
|
|
|
break;
|
|
|
|
switch (active_extruder) {
|
|
|
|
#if EXTRUDERS > 1
|
|
|
|
case 0:
|
|
|
|
case 1:
|
|
|
|
E0_ENABLE_WRITE(oldstatus);
|
|
|
|
E1_ENABLE_WRITE(oldstatus);
|
|
|
|
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
#if EXTRUDERS > 2
|
|
|
|
#if E_STEPPERS > 1
|
|
|
|
case 2:
|
|
|
|
case 1:
|
|
|
|
E2_ENABLE_WRITE(oldstatus);
|
|
|
|
E1_ENABLE_WRITE(oldstatus);
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
#if EXTRUDERS > 3
|
|
|
|
#if E_STEPPERS > 2
|
|
|
|
case 3:
|
|
|
|
case 2:
|
|
|
|
E3_ENABLE_WRITE(oldstatus);
|
|
|
|
E2_ENABLE_WRITE(oldstatus);
|
|
|
|
break;
|
|
|
|
break;
|
|
|
|
|
|
|
|
#if E_STEPPERS > 3
|
|
|
|
|
|
|
|
case 3:
|
|
|
|
|
|
|
|
E3_ENABLE_WRITE(oldstatus);
|
|
|
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif // !SWITCHING_EXTRUDER
|
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif // EXTRUDER_RUNOUT_PREVENT
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
#if ENABLED(DUAL_X_CARRIAGE)
|
|
|
|
// handle delayed move timeout
|
|
|
|
// handle delayed move timeout
|
|
|
@ -8498,6 +8695,6 @@ float calculate_volumetric_multiplier(float diameter) {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void calculate_volumetric_multipliers() {
|
|
|
|
void calculate_volumetric_multipliers() {
|
|
|
|
for (int i = 0; i < EXTRUDERS; i++)
|
|
|
|
for (int i = 0; i < COUNT(filament_size); i++)
|
|
|
|
volumetric_multiplier[i] = calculate_volumetric_multiplier(filament_size[i]);
|
|
|
|
volumetric_multiplier[i] = calculate_volumetric_multiplier(filament_size[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|