 /**
  * motion control
  */
-#define CURVE_SECTION 0.5
-#define NUM_STEPS 20
 bool positionToGo()
 {
     long distX = xPositionToGo(_state.tx);

    if (_statesIndex > 0)
    {
        _state = _states[0];
        _targetDelays = 5000 / (1 + _commState.speed * 49);
        _currentAccel = _commState.accel;
        for (int i = 0; i < _statesIndex - 1; i++)
        {

    }
    if (_currentDelays > 2000)
    {
        delay((int)(_currentDelays / 1000));
        delayMicroseconds(_currentDelays % 1000);
    }
    else
