A Two-layer MPC Approach for Consistent Planning and Control of Autonomous Vehicles | IEEE Conference Publication | IEEE Xplore