Fire car with obstacle avoidance

I have implement each part , except the obstacle avoidance. Also even if :thinking:, I implement each , I don't know how to integrate the whole part together