Modifying defines (maximum instead of stepsize)
Adding checks for MovementQuadruple
two switches in interpolator
Stabilizing: from startphase till thrustchange