Design of a robust trajectory tracking controller for autonomous vehicles based on conditional integration method is proposed to make the vehicle track a given reference trajectory. The controller consists of two sub controllers:kinematic controller and dynamic controller. Based on conditional integration method, according to the kinematics of reference trajectory, a desired yaw rate is calculated by kinematic controller to make the lateral displacement of the autonomous vehicle global asymptotic stability. And the kinematic controller considers the error of the centre of mass and limit of vehicle yaw rate. Then, to meet the demand of the desired yaw rate, vehicle dynamic controller is designed. Based on conditional integration method, desired steering angle is calculated by a vehicle dynamic controller from vehicle dynamics to make the yaw rate error asymptotic stability. the dynamic controller considers the uncertainty of vehicle parameters and limit of actuators. Meanwhile, the steady vehicle heading angle and slip angle is given. Finally, the simulation results show that the trajectory can be tracked with relative large initial displacement error, heading angle error and lateral acceleration, and the effectiveness of the control method is also verified by real vehicle test.
ZHANG Renxie
,
XIONG Lu
,
YU Zhuoping
,
BAI Manfei
,
FU Zhiqiang
. Robust Trajectory Tracking Control of Autonomous Vehicles Based on Conditional Integration Method[J]. Journal of Mechanical Engineering, 2018
, 54(18)
: 129
-139
.
DOI: 10.3901/JME.2018.18.129
[1] Buehler M,Iagnemma K,Singh S. The DARPA urban challenge:Autonomous vehicles in city traffic[M].[S.l.]:Springer Publishing Company,2009.
[2] Thrun S,Montemerlo M,Dahlkamp H,et al. Stanley:The robot that won the DARPA grand challenge[J]. Journal of Robotic Systems,2006,23(9):661-692.
[3] 吕文杰,马戎,李岁劳,等. 基于纯追踪模型的路径跟踪改进算法[J]. 测控技术,2011(30):93-96. LÜ Wenjie,MA Rong,LI Suilao,et al. An improved algorithm based on pure pursuit model for path tracking[J]. Measurement & Control Technology,2011(30):93-96.
[4] Zhao P,Chen J,Mei T,et al. Dynamic motion planning for autonomous vehicle in unknown environments[C]//Intelligent Vehicles Symposium. IEEE,2011:284-289.
[5] Chaib S,Netto M S,Mammar S. H∞,adaptive,PID and fuzzy control:a comparison of controllers for vehicle lane keeping[C]//Intelligent Vehicles Symposium. IEEE,2004:139-144.
[6] Hima S,Lusseti B,Vanholme B,et al. Trajectory tracking for highly automated passenger vehicles[J]. IFAC Proceedings Volumes,2011,44(1):12958-12963.
[7] Marino R,Scalzi S,Netto M. Nested PID steering control for lane keeping in autonomous vehicles[J]. Control Engineering Practice,2011,19(12):1459-1467.
[8] Tagne G,Talj R,Charara A. Higher-order sliding mode control for lateral dynamics of autonomous vehicles,with experimental validation[C]//Intelligent Vehicles Symposium. IEEE,2013:678-683.
[9] Tagne G,Talj R,Charara A. Design and validation of a robust immersion and invariance controller for the lateral dynamics of intelligent vehicles[J]. Control Engineering Practice,2015(40):81-92.
[10] Benine-Neto A,Scalzi S,Mammar S,et al. Dynamic controller for lane keeping and obstacle avoidance assistance system[C]//International IEEE Conference on Intelligent Transportation Systems. IEEE,2010:1363-1368.
[11] Levinson J,Askeland J,Becker J,et al. Towards fully autonomous driving:Systems and algorithms[C]//Intelligent Vehicles Symposium. IEEE,2011:163-168.
[12] 丛岩峰,安向京,陈虹,等. 基于滚动优化原理的类车机器人路径跟踪控制[J]. 吉林大学学报,2012,42(1):182-187. CONG Yanfeng,AN Xiangjing,CHEN Hong,et al. Path following control of car-like robot based on rolling windows[J]. Journal of Jilin University,2012,42(1):182-187.
[13] CAO H, SONG X, HUANG Z. A switched MPC lateral steering controller which considered tracking quality and handling quality for autonomous vehicle[R]. SAE,2017-01-1591,2017.
[14] Ji J,Khajepour A,Melek W W,et al. Path planning and tracking for vehicle collision avoidance based on model predictive control with multiconstraints[J]. IEEE Transactions on Vehicular Technology,2017,66(2):952-964.
[15] 席裕庚,李德伟,林姝. 模型预测控制——现状与挑战[J]. 自动化学报,2013,39(3):222-236. XI Yugeng,LI Dewei,LIN Shu. Model predictive control-status and challenges[J]. Acta Automatica Sinica,2013,39(3):222-236.
[16] Kay H S,Khalil H K. Universal controllers with nonlinear integrators[C]//Proceedings of the American Control Conference. Anchorage,2002,116-121.
[17] 余卓平,章仁燮,熊璐,等. 考虑线控转向非线性和不确定性的转向角控制[J]. 同济大学学报,2017,45(1):1-8. YU Zuoping,ZHANG Renxie, XIONG Lu,et al. Steering angle control of steer-by-wire systems considering the nonlinear characteristic and uncertainty parameters[J]. Journal of Tongji University,2017,45(1):1-8.
