Yang Lu, Xinglong Zhang, Xin Xu, Wenzhuo Zhang: A Two-layer MPC Approach for Consistent Planning and Control of Autonomous Vehicles. ICARM 2022: 717-724