Collision Avoidance for Automated Vehicles Using Occupancy Grid Map and Belief Theory