From 3aefa043861388c2e21500cf7b016ae6641a84e0 Mon Sep 17 00:00:00 2001
From: lrpirlet <lrpirlet@gmail.com>
Date: Wed, 1 Jun 2016 20:41:49 +0200
Subject: [PATCH] Raise the servo probe before stow outside ABL context

---
 Marlin/Marlin_main.cpp | 11 +++++++++++
 1 file changed, 11 insertions(+)

diff --git a/Marlin/Marlin_main.cpp b/Marlin/Marlin_main.cpp
index 6ddd0d2ea2..dcc7af09e2 100644
--- a/Marlin/Marlin_main.cpp
+++ b/Marlin/Marlin_main.cpp
@@ -2327,6 +2327,17 @@ static void homeaxis(AxisEnum axis) {
         #if ENABLED(DEBUG_LEVELING_FEATURE)
           if (DEBUGGING(LEVELING)) SERIAL_ECHOLNPGM("> SERVO_ENDSTOPS > Stow with servo.move()");
         #endif
+        // Raise the servo probe before stow outside ABL context... This is a workaround that allows the use of a Servo Probe without ABL until a more global probe handling is implemented.
+        #if DISABLED(AUTO_BED_LEVELING_FEATURE)
+          #ifndef Z_RAISE_AFTER_PROBING
+            #define Z_RAISE_AFTER_PROBING 15                 // default height
+          #endif
+          current_position[Z_AXIS] = Z_RAISE_AFTER_PROBING;
+          feedrate = homing_feedrate[Z_AXIS];
+          line_to_current_position();
+          stepper.synchronize();
+        #endif
+
         servo[servo_endstop_id[axis]].move(servo_endstop_angle[axis][1]);
         if (_Z_PROBE_SUBTEST) endstops.enable_z_probe(false);
       }
-- 
GitLab