Obstacle avoidance in formation