From 3bb4f8d02d09c949ab9d5efe1468b358a697e377 Mon Sep 17 00:00:00 2001
From: Holger Weber <holger@webers-web.net>
Date: Sat, 7 Mar 2026 21:14:08 +0100
Subject: [PATCH] Save new pen up and down position only if changed.

---
 src/Functions.cpp | 27 ++++++++++++++-------------
 1 file changed, 14 insertions(+), 13 deletions(-)

diff --git a/src/Functions.cpp b/src/Functions.cpp
index bb42533..975f9e9 100644
--- a/src/Functions.cpp
+++ b/src/Functions.cpp
@@ -189,20 +189,12 @@ void setPen()
 void togglePen()
 {
    Log(__FUNCTION__);
-	int value;
 	char *arg;
-
-	// moveToDestination();
-
 	arg = nextCommandArg();
-	if (arg != NULL)
-		value = atoi(arg);
-	else
-		value = 500;
 
 	doTogglePen();
 	sendAck();
-	// delay(value);
+
 }
 
 void doTogglePen()
@@ -276,6 +268,7 @@ void stepperModeConfigure()
    Log(__FUNCTION__);
 	int cmd;
 	int value;
+   int iTmpPenPos;
 	char *arg;
 	arg = nextCommandArg();
 	if (arg != NULL)
@@ -289,13 +282,21 @@ void stepperModeConfigure()
 		switch (cmd)
 		{
 		case 4:
-			g_iPenDownPos = (int)((float)(value - 6000) / (float)133.3); // transformation from EBB to PWM-Servo
-			storePenDownPosInEE();
+			iTmpPenPos = (int)((float)(value - 6000) / (float)133.3); // transformation from EBB to PWM-Servo
+         if (g_iPenDownPos != iTmpPenPos)
+         {
+            g_iPenDownPos = iTmpPenPos;
+            storePenDownPosInEE();
+         }
 			sendAck();
 			break;
 		case 5:
-			g_iPenUpPos = (int)((float)(value - 6000) / (float)133.3); // transformation from EBB to PWM-Servo
-			storePenUpPosInEE();
+			iTmpPenPos = (int)((float)(value - 6000) / (float)133.3); // transformation from EBB to PWM-Servo
+         if (g_iPenUpPos != iTmpPenPos)
+         {
+            g_iPenUpPos = iTmpPenPos;
+            storePenUpPosInEE();
+         }
 			sendAck();
 			break;
 		case 6: // rotMin=value;    ignored