MPCNC/Firmware2
1
0
Fork 0
Code Issues 1 Pull Requests Releases Wiki Activity

Raise when not retracting

Browse Source 
Code to raise the probe before retraction is good, but the code should
always raise the probe, not just when retracting
This commit is contained in:
Scott Lahteine 2015-03-31 03:38:03 -07:00
parent cda4bd4ad9
commit 9a5a7a3f68
1 changed files with 11 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
Marlin/Marlin_main.cpp
View File

@ -1254,18 +1254,18 @@ inline void sync_plan_position() {
}
static void retract_z_probe(const float z_after=Z_RAISE_AFTER_PROBING) {
static void retract_z_probe() {
#ifdef SERVO_ENDSTOPS
// Retract Z Servo endstop if enabled
if (servo_endstops[Z_AXIS] >= 0) {
if (z_after > 0) {
do_blocking_move_to(current_position[X_AXIS], current_position[Y_AXIS], z_after);
#if Z_RAISE_AFTER_PROBING > 0
do_blocking_move_to(current_position[X_AXIS], current_position[Y_AXIS], Z_RAISE_AFTER_PROBING);
st_synchronize();
}
#endif
#if SERVO_LEVELING
servos[servo_endstops[Z_AXIS]].attach(0);
#endif
@ -1343,8 +1343,13 @@ inline void sync_plan_position() {
run_z_probe();
float measured_z = current_position[Z_AXIS];
#if Z_RAISE_AFTER_PROBING > 0
do_blocking_move_to(current_position[X_AXIS], current_position[Y_AXIS], Z_RAISE_AFTER_PROBING);
st_synchronize();
#endif
#if !defined(Z_PROBE_SLED) && !defined(Z_PROBE_ALLEN_KEY)
if (retract_action & ProbeRetract) retract_z_probe(z_before);
if (retract_action & ProbeRetract) retract_z_probe();
#endif
if (verbose_level > 2) {