Measure time needed from first to second speed, to adapt position command