A Hierarchical Control System for Autonomous Driving Towards Urban Challeng