Design, Analysis, and Experiments of Preview Path Tracking Control for Autonomous Vehicles

This paper presents a preview steering control algorithm and its closed-loop system analysis and experimental validation for accurate, smooth, and computationally inexpensive path tracking of automated vehicles. The path tracking issue is formulated as an optimal control problem with dynamic disturbance, i.e., the future road curvature. A discrete-time preview controller is then designed on the top of a linear augmented error system, in which the disturbances within a finite preview window are augmented as part of the state vector. The obtained optimal steering control law is in an analytic form and consists of two parts: 1) a feedback control responding to tracking errors and 2) a feedforward control dealing with the future road curvatures. The designed control’s nature, capacity, computation load, and underlying mechanism are revealed by the analysis of system responses in the time domain and the frequency domain, theoretical steady-state error, and comparison with the model predictive control (MPC). The algorithm was implemented on an automated vehicle platform, a hybrid Lincoln MKZ. The experimental and simulation results are then presented to demonstrate the improved performance in tracking accuracy, steering smoothness, and computational efficiency compared to the MPC and the full-state feedback control.

[1]  Rajesh Rajamani,et al.  Vehicle dynamics and control , 2005 .

[2]  Shengbo Eben Li,et al.  A Unified Pseudospectral Computational Framework for Optimal Control of Road Vehicles , 2015, IEEE/ASME Transactions on Mechatronics.

[3]  Minyue Fu,et al.  Preview Control of Dual-Stage Actuator Systems for Superfast Transition Time , 2011, IEEE/ASME Transactions on Mechatronics.

[4]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[5]  Huei Peng,et al.  Accurate and Smooth Speed Control for an Autonomous Vehicle , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[6]  Kouhei Ohnishi,et al.  Biped Walking Pattern Generation by Using Preview Control Based on Three-Mass Model , 2013, IEEE Transactions on Industrial Electronics.

[7]  Bo Cheng,et al.  Eco-Departure of Connected Vehicles With V2X Communication at Signalized Intersections , 2015, IEEE Transactions on Vehicular Technology.

[8]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[9]  Maziah Mohamad,et al.  A Review of some Pure-Pursuit based Path Tracking Techniques for Control of Autonomous Vehicle , 2016 .

[10]  Xiang Li,et al.  Nonlinear model predictive control for path following problems , 2015 .

[11]  Riccardo Marino,et al.  Nested PID steering control for lane keeping in autonomous vehicles , 2011 .

[12]  Masayoshi Tomizuka,et al.  Design of simultaneously stabilizing controllers and its application to fault-tolerant lane-keeping controller design for automated vehicles , 2004, IEEE Transactions on Control Systems Technology.

[13]  J. Christian Gerdes,et al.  Lyapunov Based Performance Guarantees for the Potential Field Lane-keeping Assistance System , 2006 .

[14]  Tobias Weber,et al.  Implementation of Nonlinear Model Predictive Path-Following Control for an Industrial Robot , 2015, IEEE Transactions on Control Systems Technology.

[15]  B. Anderson,et al.  Linear Optimal Control , 1971 .

[16]  B. Anderson,et al.  Optimal control: linear quadratic methods , 1990 .

[17]  WächterAndreas,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006 .

[18]  Wouter Saeys,et al.  Robust Trajectory Tracking Error Model-Based Predictive Control for Unmanned Ground Vehicles , 2016, IEEE/ASME Transactions on Mechatronics.

[19]  David Q. Mayne,et al.  Model predictive control: Recent developments and future promise , 2014, Autom..

[20]  Akhilesh Swarup,et al.  Optimal preview control: A review , 2015 .

[21]  Masayoshi Tomizuka,et al.  The optimal finite preview problem and its application to man-machine systems. , 1974 .

[22]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[23]  MengChu Zhou,et al.  Front Sensor and GPS-Based Lateral Control of Automated Vehicles , 2013, IEEE Transactions on Intelligent Transportation Systems.

[24]  Mohamed Boukattaya,et al.  Adaptive Sliding-Mode Dynamic Control For Path Tracking of Nonholonomic Wheeled Mobile Robot , 2015 .

[25]  Masayoshi Tomizuka,et al.  Preview Control for Vehicle Lateral Guidance in Highway Automation , 1991, 1991 American Control Conference.

[26]  Dongpu Cao,et al.  Dual-envelop-oriented moving horizon path tracking control for fully automated vehicles , 2017 .