From 38231894aec98bde5093b3942d90034193b457d2 Mon Sep 17 00:00:00 2001
From: Filip Ayazi <filipayazi@gmail.com>
Date: Wed, 1 Mar 2023 04:25:30 +0000
Subject: [PATCH] only show 3 motor positions in p? for compatibility

---
 src/modules/stage/stage.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/src/modules/stage/stage.cpp b/src/modules/stage/stage.cpp
index b7b8a51..329cf86 100644
--- a/src/modules/stage/stage.cpp
+++ b/src/modules/stage/stage.cpp
@@ -220,6 +220,9 @@ void stage_mr(String command)
     parse_arguments(args, command, 3);
     EACH_MOTOR
     {
+        if (i>3)
+            continue;
+
         displacement[i] = atol(args[i]);
         free(args[i]);
     }