From: Jim Morris <morris@wolfman.com>
Date: Tue, 28 Jun 2016 20:35:34 +0000 (-0700)
Subject: allow restoration of G28.1 position
X-Git-Url: https://git.hcoop.net/clinton/Smoothieware.git/commitdiff_plain/08beee45efd75a9ce61f7ff23688d22367b44c07

allow restoration of G28.1 position
---

diff --git a/src/modules/tools/endstops/Endstops.cpp b/src/modules/tools/endstops/Endstops.cpp
index 8002de66..09fa079c 100644
--- a/src/modules/tools/endstops/Endstops.cpp
+++ b/src/modules/tools/endstops/Endstops.cpp
@@ -557,7 +557,11 @@ void Endstops::process_home_command(Gcode* gcode)
 
     } else if(gcode->subcode == 1) { // G28.1 set pre defined position
         // saves current position in absolute machine coordinates
-        THEROBOT->get_axis_position(saved_position);
+        THEROBOT->get_axis_position(saved_position); // Only XY are used
+        // Note the following is only meant to be used for recovering a saved position from config-override
+        // Not a standard Gcode and notto be relied on
+        if (gcode->has_letter('X')) saved_position[X_AXIS] = gcode->get_value('X');
+        if (gcode->has_letter('Y')) saved_position[Y_AXIS] = gcode->get_value('Y');
         return;
 
     } else if(gcode->subcode == 3) { // G28.3 is a smoothie special it sets manual homing