got obstacle avoidance working