Inserting recalculated trajectories immediately and not after 3 steps