|
|
|
|
@ -490,8 +490,6 @@ static uint8_t target_extruder;
|
|
|
|
|
float zprobe_zoffset = Z_PROBE_OFFSET_FROM_EXTRUDER;
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#define PLANNER_XY_FEEDRATE() (min(planner.max_feedrate_mm_s[X_AXIS], planner.max_feedrate_mm_s[Y_AXIS]))
|
|
|
|
|
|
|
|
|
|
#if HAS_ABL
|
|
|
|
|
float xy_probe_feedrate_mm_s = MMM_TO_MMS(XY_PROBE_SPEED);
|
|
|
|
|
#define XY_PROBE_FEEDRATE_MM_S xy_probe_feedrate_mm_s
|
|
|
|
|
@ -2405,7 +2403,7 @@ static void clean_up_after_endstop_or_probe_move() {
|
|
|
|
|
|
|
|
|
|
#endif // HAS_BED_PROBE
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
/**
|
|
|
|
|
* Turn bed leveling on or off, fixing the current
|
|
|
|
|
* position as-needed.
|
|
|
|
|
@ -2426,7 +2424,12 @@ static void clean_up_after_endstop_or_probe_move() {
|
|
|
|
|
if (enable && mbl.has_mesh()) planner.unapply_leveling(current_position);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#elif HAS_ABL && !ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
#elif ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
|
|
|
|
|
ubl.state.active = enable;
|
|
|
|
|
//set_current_from_steppers_for_axis(Z_AXIS);
|
|
|
|
|
|
|
|
|
|
#else
|
|
|
|
|
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_BILINEAR)
|
|
|
|
|
const bool can_change = (!enable || (bilinear_grid_spacing[0] && bilinear_grid_spacing[1]));
|
|
|
|
|
@ -2454,9 +2457,6 @@ static void clean_up_after_endstop_or_probe_move() {
|
|
|
|
|
else
|
|
|
|
|
planner.unapply_leveling(current_position);
|
|
|
|
|
}
|
|
|
|
|
#elif ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
ubl.state.active = enable;
|
|
|
|
|
//set_current_from_steppers_for_axis(Z_AXIS);
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
@ -2513,7 +2513,7 @@ static void clean_up_after_endstop_or_probe_move() {
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#endif // PLANNER_LEVELING
|
|
|
|
|
#endif // HAS_LEVELING
|
|
|
|
|
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_BILINEAR) || ENABLED(MESH_BED_LEVELING)
|
|
|
|
|
|
|
|
|
|
@ -3749,10 +3749,7 @@ inline void gcode_G28() {
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// Disable the leveling matrix before homing
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
const bool bed_leveling_state_at_entry = ubl.state.active;
|
|
|
|
|
#endif
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
set_bed_leveling_enabled(false);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
@ -3895,25 +3892,6 @@ inline void gcode_G28() {
|
|
|
|
|
do_blocking_move_to_z(delta_clip_start_height);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
set_bed_leveling_enabled(bed_leveling_state_at_entry);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// Enable mesh leveling again
|
|
|
|
|
#if ENABLED(MESH_BED_LEVELING)
|
|
|
|
|
if (mbl.reactivate()) {
|
|
|
|
|
set_bed_leveling_enabled(true);
|
|
|
|
|
if (home_all_axis || (axis_homed[X_AXIS] && axis_homed[Y_AXIS] && homeZ)) {
|
|
|
|
|
#if ENABLED(MESH_G28_REST_ORIGIN)
|
|
|
|
|
current_position[Z_AXIS] = LOGICAL_Z_POSITION(Z_MIN_POS);
|
|
|
|
|
set_destination_to_current();
|
|
|
|
|
line_to_destination(homing_feedrate_mm_s[Z_AXIS]);
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
clean_up_after_endstop_or_probe_move();
|
|
|
|
|
|
|
|
|
|
// Restore the active tool after homing
|
|
|
|
|
@ -3928,6 +3906,8 @@ inline void gcode_G28() {
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void home_all_axes() { gcode_G28(); }
|
|
|
|
|
|
|
|
|
|
#if HAS_PROBING_PROCEDURE
|
|
|
|
|
|
|
|
|
|
void out_of_range_error(const char* p_edge) {
|
|
|
|
|
@ -3980,6 +3960,18 @@ inline void gcode_G28() {
|
|
|
|
|
);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void mesh_probing_done() {
|
|
|
|
|
mbl.set_has_mesh(true);
|
|
|
|
|
home_all_axes();
|
|
|
|
|
set_bed_leveling_enabled(true);
|
|
|
|
|
#if ENABLED(MESH_G28_REST_ORIGIN)
|
|
|
|
|
current_position[Z_AXIS] = LOGICAL_Z_POSITION(Z_MIN_POS);
|
|
|
|
|
set_destination_to_current();
|
|
|
|
|
line_to_destination(homing_feedrate_mm_s[Z_AXIS]);
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* G29: Mesh-based Z probe, probes a grid and produces a
|
|
|
|
|
* mesh to compensate for variable bed height
|
|
|
|
|
@ -4070,14 +4062,12 @@ inline void gcode_G28() {
|
|
|
|
|
line_to_current_position();
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
|
|
// After recording the last point, activate the mbl and home
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Mesh probing done.");
|
|
|
|
|
// After recording the last point, activate home and activate
|
|
|
|
|
mbl_probe_index = -1;
|
|
|
|
|
mbl.set_has_mesh(true);
|
|
|
|
|
mbl.set_reactivate(true);
|
|
|
|
|
enqueue_and_echo_commands_P(PSTR("G28"));
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Mesh probing done.");
|
|
|
|
|
BUZZ(100, 659);
|
|
|
|
|
BUZZ(100, 698);
|
|
|
|
|
mesh_probing_done();
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
@ -4368,7 +4358,7 @@ inline void gcode_G28() {
|
|
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
|
|
|
|
|
// Jettison bed leveling data
|
|
|
|
|
if (code_seen('J')) {
|
|
|
|
|
@ -5013,7 +5003,7 @@ inline void gcode_G28() {
|
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#endif // HAS_ABL && DISABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
#endif // HAS_ABL && !AUTO_BED_LEVELING_UBL
|
|
|
|
|
|
|
|
|
|
#if HAS_BED_PROBE
|
|
|
|
|
|
|
|
|
|
@ -5034,7 +5024,7 @@ inline void gcode_G28() {
|
|
|
|
|
if (!position_is_reachable(pos, true)) return;
|
|
|
|
|
|
|
|
|
|
// Disable leveling so the planner won't mess with us
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
set_bed_leveling_enabled(false);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
@ -5091,7 +5081,7 @@ inline void gcode_G28() {
|
|
|
|
|
|
|
|
|
|
stepper.synchronize();
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
set_bed_leveling_enabled(false);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
@ -6198,10 +6188,6 @@ inline void gcode_M42() {
|
|
|
|
|
* regenerated.
|
|
|
|
|
*/
|
|
|
|
|
inline void gcode_M48() {
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
bool bed_leveling_state_at_entry=0;
|
|
|
|
|
bed_leveling_state_at_entry = ubl.state.active;
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
if (axis_unhomed_error(true, true, true)) return;
|
|
|
|
|
|
|
|
|
|
@ -6220,8 +6206,8 @@ inline void gcode_M42() {
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
float X_current = current_position[X_AXIS],
|
|
|
|
|
Y_current = current_position[Y_AXIS];
|
|
|
|
|
float X_current = current_position[X_AXIS],
|
|
|
|
|
Y_current = current_position[Y_AXIS];
|
|
|
|
|
|
|
|
|
|
bool stow_probe_after_each = code_seen('E');
|
|
|
|
|
|
|
|
|
|
@ -6267,8 +6253,17 @@ inline void gcode_M42() {
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Positioning the probe...");
|
|
|
|
|
|
|
|
|
|
// Disable bed level correction in M48 because we want the raw data when we probe
|
|
|
|
|
#if HAS_ABL
|
|
|
|
|
const bool abl_was_enabled = planner.abl_enabled;
|
|
|
|
|
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
const bool was_enabled =
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
ubl.state.active
|
|
|
|
|
#elif ENABLED(MESH_BED_LEVELING)
|
|
|
|
|
mbl.active()
|
|
|
|
|
#else
|
|
|
|
|
planner.abl_enabled
|
|
|
|
|
#endif
|
|
|
|
|
;
|
|
|
|
|
set_bed_leveling_enabled(false);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
@ -6420,14 +6415,9 @@ inline void gcode_M42() {
|
|
|
|
|
|
|
|
|
|
clean_up_after_endstop_or_probe_move();
|
|
|
|
|
|
|
|
|
|
// Re-enable bed level correction if it has been on
|
|
|
|
|
// Re-enable bed level correction if it had been on
|
|
|
|
|
#if HAS_ABL
|
|
|
|
|
set_bed_leveling_enabled(abl_was_enabled);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#if ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
set_bed_leveling_enabled(bed_leveling_state_at_entry);
|
|
|
|
|
ubl.state.active = bed_leveling_state_at_entry;
|
|
|
|
|
set_bed_leveling_enabled(was_enabled);
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
report_current_position();
|
|
|
|
|
@ -7294,7 +7284,7 @@ inline void gcode_M115() {
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
// MESH_REPORT (M420 V)
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Cap:LEVELING_DATA:1");
|
|
|
|
|
#else
|
|
|
|
|
SERIAL_PROTOCOLLNPGM("Cap:LEVELING_DATA:0");
|
|
|
|
|
@ -8336,7 +8326,7 @@ void quickstop_stepper() {
|
|
|
|
|
SYNC_PLAN_POSITION_KINEMATIC();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
/**
|
|
|
|
|
* M420: Enable/Disable Bed Leveling and/or set the Z fade height.
|
|
|
|
|
*
|
|
|
|
|
@ -9857,12 +9847,12 @@ void process_next_command() {
|
|
|
|
|
gcode_G28();
|
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING || ENABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
case 29: // G29 Detailed Z probe, probes the bed at 3 or more points,
|
|
|
|
|
// or provides access to the UBL System if enabled.
|
|
|
|
|
gcode_G29();
|
|
|
|
|
break;
|
|
|
|
|
#endif // PLANNER_LEVELING
|
|
|
|
|
#endif // HAS_LEVELING
|
|
|
|
|
|
|
|
|
|
#if HAS_BED_PROBE
|
|
|
|
|
|
|
|
|
|
@ -10363,7 +10353,7 @@ void process_next_command() {
|
|
|
|
|
break;
|
|
|
|
|
#endif // FILAMENT_WIDTH_SENSOR
|
|
|
|
|
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
#if HAS_LEVELING
|
|
|
|
|
case 420: // M420: Enable/Disable Bed Leveling
|
|
|
|
|
gcode_M420();
|
|
|
|
|
break;
|
|
|
|
|
@ -10917,7 +10907,7 @@ void get_cartesian_from_steppers() {
|
|
|
|
|
*/
|
|
|
|
|
void set_current_from_steppers_for_axis(const AxisEnum axis) {
|
|
|
|
|
get_cartesian_from_steppers();
|
|
|
|
|
#if PLANNER_LEVELING && DISABLED(AUTO_BED_LEVELING_UBL)
|
|
|
|
|
#if PLANNER_LEVELING
|
|
|
|
|
planner.unapply_leveling(cartes);
|
|
|
|
|
#endif
|
|
|
|
|
if (axis == ALL_AXES)
|
|
|
|
|
|
Scott Lahteine
8 years ago
committed by