Added obstacle avoidance code