 }
 void nextWait()
 {
-    if (tt % 2 == 0)
-    {
-        if (_points[0].totalCount > _points[0].accelCount)
-        {
-            _sys.isRunningState = MOTION_ACCELETING;
-        }
-        else if (_points[0].totalCount > _points[0].decelCount)
-        {
-            _sys.isRunningState = MOTION_NORMAL;
-        }
-        else
-        {
-            _sys.isRunningState = MOTION_DECELETING;
-        }
-        switch (_sys.isRunningState)
-        {
-        case MOTION_ACCELETING:
-        {
-            if (_sys.currentSpeed < _points[0].speed)
-            {
-                _sys.currentSpeed += _points[0].acceleration;
-                if (_sys.currentSpeed > _points[0].speed)
-                {
-                    _sys.currentSpeed = _points[0].speed;
-                }
-            }
-            break;
-        }
-        case MOTION_DECELETING:
-        {
-            if (_sys.currentSpeed > _points[0].exitSpeed)
-            {
-                _sys.currentSpeed -= _points[0].acceleration;
-                if (_sys.currentSpeed < _points[0].exitSpeed)
-                {
-                    _sys.currentSpeed = _points[0].exitSpeed;
-                }
-            }
-            break;
-        }
-        case MOTION_NORMAL:
-        {
-            // OCR1A;
-            break;
-        }
-        }
-        tt = 0;
-        OCR1A = 1600000 / _sys.currentSpeed - 1;
-    }
-    tt++;
+    if (_points[0].totalCount > _points[0].accelCount)
+    {
+        _sys.isRunningState = MOTION_ACCELETING;
+    }
+    else if (_points[0].totalCount > _points[0].decelCount)
+    {
+        _sys.isRunningState = MOTION_NORMAL;
+    }
+    else
+    {
+        _sys.isRunningState = MOTION_DECELETING;
+    }
+    switch (_sys.isRunningState)
+    {
+    case MOTION_ACCELETING:
+    {
+        if (_sys.currentSpeed < _points[0].speed)
+        {
+            _sys.currentSpeed += _points[0].acceleration;
+            if (_sys.currentSpeed > _points[0].speed)
+            {
+                _sys.currentSpeed = _points[0].speed;
+            }
+        }
+        break;
+    }
+    case MOTION_DECELETING:
+    {
+        if (_sys.currentSpeed > _points[0].exitSpeed)
+        {
+            _sys.currentSpeed -= _points[0].acceleration;
+            if (_sys.currentSpeed < _points[0].exitSpeed)
+            {
+                _sys.currentSpeed = _points[0].exitSpeed;
+            }
+        }
+        break;
+    }
+    case MOTION_NORMAL:
+    {
+        // OCR1A;
+        break;
+    }
+    }
+    tt = 0;
+    _sys.during = 1600000 / _sys.currentSpeed - 1;
+    _sys.during = _sys.during > 10000 ? 10000 : (_sys.during < 10 ? 10 : _sys.during);
 }
 /**
  * Motion Parse

    {
        return false;
    }
    firePower(_points[0].power);
    long distX = _points[0].delta[0];
    long distY = _points[0].delta[1];
    if (distX <= 0 && distY <= 0)

        _sys.plannedLength -= 1;
    }
}
uint8_t isRunningState()
{
    return _sys.isRunningState;
