A Safe and Robust Autonomous Intersection Management System Using a Hierarchical Control Strategy and V2I Communication