Save new pen up and down position only if changed.
This commit is contained in:
@@ -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
|
||||
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
|
||||
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
|
||||
|
||||
Reference in New Issue
Block a user