Obstacle avoidance during RTH