Add step size adapation based on angle

[floiseau]

The step size could be adapted to avoid a change a angle that is to large between two steps. Classic formula to adapt the step could directly using $\Delta \varphi$.