             if (_sys.time < _sys.maxTime)
             {
                 _sys.time += _sys.defaultAcceleration;
-                Serial.print("state:");
-                Serial.print(_sys.isRunningState);
-                Serial.print(" - ");
-                Serial.print("time:");
-                Serial.println(_sys.time);
+            }
+            else
+            {
             }
             break;
         }

void lineTo(long x, long y)
{
    waitingPushPoint();
    // #ifdef DEBUG
    //     String str = "line:";
    //     str += x;
    //     str += ",";
    //     str += y;
    //     str += ",";
    //     str += _sys.speed;
    //     Serial.println(str);
    // #endif
    addMotion(x, y, _sys.power, _sys.speed, _sys.acceleration);
}
void addMotion(long x, long y, uint8_t power, uint8_t speed, uint8_t accelaration)

 * */
void shiftPlanned()
{
    if (_sys.plannedLength > 0)
    {
        for (int i = 0; i < _sys.plannedLength - 1; i++)
        {
            _sys.points[i] = _sys.points[i + 1];
        }
        _sys.plannedIndex--;
        _sys.plannedLength--;
    }
    if (_sys.statesLength <= 0 && _sys.plannedLength <= 0)
    {
        finishCommand();
    }
}
void lockTimer()
{
