Obstacle avoidance working