Obstacle avoidance during Return-to-Home