     long targetPosition[NUM_AXIS];
     long startPosition[NUM_AXIS];
     long timerCount = 0;
-    long time = 2500;
-    long defaultTime = 2500;
-    long maxTime = 2500;
+    long time = 1250;
+    long defaultTime = 1250;
+    long defaultAcceleration = 25;
+    long defaultAccelCount = 50;
+    long defaultDecelCount = 50;
+    long maxTime = 1250;
     long minTime = 25;
     PlannerPoint points[POINTS_COUNT];
     MotionState states[STATES_COUNT];

    str += y2;
    Serial.println(str);
#endif
    long x0 = _sys.states[_sys.statesIndex - 1].targetPosition[0];
    long y0 = _sys.states[_sys.statesIndex - 1].targetPosition[1];
    int step = NUM_STEPS;
    double fx, fy;
    for (int i = 0; i < step; i++)

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