Research on Trajectory Tracking Control of Autonomous Vehicle Based on MPC with Variable Predictive Horizon

doi:10.3901/JME.2022.24.275

Abstract

Abstract: In order to ensure the trajectory tracking accuracy and driving stability of autonomous vehicles, a model predictive control with variable predictive horizon method was proposed based on on-line identification of vehicle lateral stability state and fuzzy algorithm. Aiming at the online recognition of vehicle stable state, k-means clustering algorithm was used to cluster the parameters of vehicle driving state and obtain the cluster centroid. The real-time safety level of vehicle was obtained by comparing the Euclidean distance between the current vehicle state quantity and different cluster centroids online. At the same time, the lateral offset of the current vehicle track tracking is calculated. With the two as inputs, the variation of prediction time domain is calculated online by fuzzy algorithm and output to MPC controller to realize adaptive adjustment of prediction time domain. Finally, the optimal control sequence of the track tracking of the autonomous vehicle is solved to achieve the goal of high precision trajectory tracking control under the premise of maintaining vehicle stability. The results of CarSim/Simulink co-simulation show that the improved MPC algorithm is superior to the traditional MPC controller in improving the trajectory tracking accuracy and lateral stability of autonomous vehicles.

Key words: automatic drive, trajectory tracking, k-means algorithm, fuzzy algorithm, model predictive control

CLC Number:

TP242

DU Ronghua, HU Hongfei, GAO Kai, HUANG Hao. Research on Trajectory Tracking Control of Autonomous Vehicle Based on MPC with Variable Predictive Horizon[J]. Journal of Mechanical Engineering, 2022, 58(24): 275-288.

References

[1] PADEN B, ČÁP M, YONG S, et al.A survey of motion planning and control techniques for self-driving urban vehicles[J].IEEE Transactions on Intelligent Vehicles, 2016, 1(1):33-55.
[2] WANG Huiran, WANG Qidong, CHEN Wuwei, et al.Path tracking based on model predictive control with variable predictive horizon[J].Transactions of the Institute of Measurement and Control, 2021, 43(12):2676-2688.
[3] ELBANHAWI M, SIMIC M, JAZAR R.Receding horizon lateral vehicle control for pure pursuit path tracking[J].Journal of Vibration and Control, 2018, 24(3):619-642.
[4] 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.
[5] KIM S, CHANG H W, KIM C.Path tracking motion control using fuzzy inference for a parking-assist system[J].Transactions of the Korean Society of Automotive Engineers, 2009, 17(2):1-9.
[6] 王艺, 蔡英凤, 陈龙, 等.基于模型预测控制的智能网联汽车路径跟踪控制器设计[J].机械工程学报, 2019, 55(8):136-144, 153.WANG Yi, CAI Yingfeng, CHEN Long, et al.Design of intelligent and connected vehicle path tracking controller based on model predictive control[J].Journal of Mechanical Engineering, 2019, 55(8):136-144, 153.
[7] ZHANG Wenbin, BAI Wenhao, WANG Jinyan, et al.Research on path tracking of intelligent vehicle based on optimal deviation control[J].Integrated Ferroelectrics, 2018, 191(1):80-91.
[8] WURTS J, STEIN J, ERSAL T.Collision imminent steering at high speed using nonlinear model predictive control[J].IEEE Transactions on Vehicular Technology, 2020, 69(8):8278-8289.
[9] XI Yugeng, LI Deweili, LIN Shu.Model predictive control-status and challenges[J].Acta Automatica Sinica, 2013, 39(3):222-236.
[10] GUO Hongyan, LIU Feng, YU Ru, et al.Regional path moving horizon tracking controller design for autonomous ground vehicles[J].Science China Information Sciences, 2017, 60(1):1-7.
[11] JI Jie, KHAJEPOUR A, MELEK W, et al.Path planning and tracking for vehicle collision avoidance based on model predictive control with multiconstraints[J].IEEE Transactions on Vehicular Technology, 2016, 66(2):952-964.
[12] GUO Hongyan, CAO Dongpu, CHEN Hong, et al.Model predictive path following control for autonomous cars considering a measurable disturbance:Implementation, testing, and verification[J].Mechanical Systems and Signal Processing, 2019, 118:41-60.
[13] PENG Haonan, WANG Weida, AN Quan, et al.Path tracking and direct yaw moment coordinated control based on robust MPC with the finite time horizon for autonomous independent-drive vehicles[J].IEEE Transactions on Vehicular Technology, 2020, 69(6):6053-6066.
[14] ZHANG Bing, ZONG Changfu, CHEN Guoying, et al.An adaptive-prediction-horizon model prediction control for path tracking in a four-wheel independent control electric vehicle[J].Proceedings of the Institution of Mechanical Engineers, Part D:Journal of Automobile Engineering, 2019, 233(12):3246-3262.
[15] EGGIMANN M, CRISALLE O, LONGCHAMP R.A linear-programming predictive controller with variable horizon[C]//1992 American Control Conference.IEEE, 1992:1568-1575.
[16] 范贤波, 彭育辉, 钟聪.基于自适应MPC的自动驾驶汽车轨迹跟踪控制[J].福州大学学报(自然科学版), 2021, 49(4):500-507.FAN Xianbo, PENG Yuhui, ZHONG Cong.Trajectory tracking control of autonomous vehicles based on adaptive MPC[J].Journal of Fuzhou University(Natural Science Edition), 2021, 49(4):500-507.
[17] 荆林国, 荆仲毅, 张韶晶, 等.考虑随机影响因素的电网饱和负荷概率预测方法[J].电气工程学报, 2021, 16(3):99-105.JING Linguo, JING Zhongyi, ZHANG Shaojing, et al.Power grid saturation load probability prediction method considering random influencing factors[J].Journal of Electrical Engineering, 2021, 16(3):99-105.
[18] 谢林, 李红伟, 袁岳, 等.基于K-Means聚类和改进多分类相关向量机的台区线损计算方法[J].电气工程学报, 2021, 16(1):62-69.XIE Lin, LI Hongwei, YUAN Yue, et al.Calculation of line loss in transformer district based on K-means clustering algorithm and improved MRVM[J].Journal of Electrical Engineering, 2021, 16(1):62-69.
[19] 刘凯, 龚建伟, 陈舒平, 等.高速无人驾驶车辆最优运动规划与控制的动力学建模分析[J].机械工程学报, 2018, 54(14):141-151.LIU Kai, GONG Jianwei, CHENG Shuping, et al.Dynamic modeling analysis of optimal motion planning and control for high-speed self-driving vehicles[J].Journal of Mechanical Engineering, 2018, 54(14):141-151.
[20] 龚建伟, 姜岩, 徐威.无人驾驶车辆模型预测控制[M].北京:北京理工大学出版社, 2014.GONG Jianwei, JIANG Yan, XU Wei.Model predictive control for autonomous vehicles[M].Beijing:Beijing Institute of Technology Press, 2014.
[21] 刘宏飞, 徐强, 许洪国, 等.基于k均值聚类分析的车辆横向稳定性判定方法[J].湖南大学学报(自然科学版), 2018, 45(8):48-53.LIU Hongfei, XU Qiang, XU Hongguo, et al.Judgment method of vehicle lateral stability based on k means clustering analysis[J].Journal of Hunan University(Natural Sciences), 2018, 45(8):48-53.
[22] 韩家炜, MICHELINE K.数据挖掘:概念与技术[M].北京:机械工业出版社, 2012.HAN Jiawei, MICHELINE K.Data mining concepts and techniques[M].Beijing:China Machine Press, 2012.
[23] 陈慧, 高博麟, 徐帆.车辆质心侧偏角估计综述[J].机械工程学报, 2013, 49(24):76-94.CHEN Hui, GAO Bolin, XU Fan.Review on vehicle sideslip angle estimation[J].Journal of Mechanical Engineering, 2013, 49(24):76-94
[24] 夏秋, 陈特, 陈龙, 等.基于冗余信息融合的车辆质心侧偏角估计方法[J].汽车工程, 2022, 44(2):280-289.XIA Qiu, CHEN Te, CHEN Long, et al.Vehicle sideslip angle estimation method based on redundant information fusion[J].Automotive Engineering, 2022, 44(2):280-289.
[25] 王银, 张灏琦, 孙前来, 等.基于自适应MPC算法的轨迹跟踪控制研究[J].计算机工程与应用, 2021, 57(14):251-258.WANG Yin, ZHANG Haoqi, SUN Qianlai, et al.Research on trajectory tracking control based on adaptive MPC algorithm[J].Computer Engineering and Applications, 2021, 57(14):251-258.
[26] 马浩通.基于模糊控制的Y形管内高压成形加载路径优化研究[D].长春:吉林大学, 2020.MA Haotong.Research on the optimization of loading path in Y-shape tube hydroforming based on fuzzy control[D].Changchun:Jilin University, 2020.