The method and calculation unit to restore a safe trajectory.