Development And Testing Of The Icacc Intersection Controller For Automated Vehicles