From 244f67590ee9ebf6e6a7e6abaafaa2cd233e0c1d Mon Sep 17 00:00:00 2001 From: teemuatlut Date: Sat, 22 Apr 2017 02:23:56 +0300 Subject: [PATCH] Delta probe height bug solved --- Marlin/Marlin_main.cpp | 6 ++++++ 1 file changed, 6 insertions(+) diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp index 75c472ea87..18cb090d1f 100644 --- a/Marlin/Marlin_main.cpp +++ b/Marlin/Marlin_main.cpp @@ -1828,6 +1828,9 @@ static void clean_up_after_endstop_or_probe_move() { float z_dest = LOGICAL_Z_POSITION(z_raise); if (zprobe_zoffset < 0) z_dest -= zprobe_zoffset; + #if ENABLED(DELTA) + z_dest -= home_offset[Z_AXIS]; + #endif if (z_dest > current_position[Z_AXIS]) do_blocking_move_to_z(z_dest); @@ -2254,6 +2257,9 @@ static void clean_up_after_endstop_or_probe_move() { // move down quickly before doing the slow probe float z = LOGICAL_Z_POSITION(Z_CLEARANCE_BETWEEN_PROBES); if (zprobe_zoffset < 0) z -= zprobe_zoffset; + #if ENABLED(DELTA) + z -= home_offset[Z_AXIS]; + #endif if (z < current_position[Z_AXIS]) do_blocking_move_to_z(z, MMM_TO_MMS(Z_PROBE_SPEED_FAST));