Hierarchical Motion Planning and Offline Robust Model Predictive Control for Autonomous Vehicles