基于可变预测时域及速度的车辆路径跟踪控制

摘要/Abstract

摘要：

非线性模型预测控制（NMPC）在车辆路径跟踪控制中的应用日益广泛，但目前的研究成果中尚未深入考虑预测时域和速度对车辆路径跟踪控制性能的影响。为此，分析了预测时域、速度与车辆路径跟踪控制性能之间的关系；采用三次多项式拟合获得了能够保证车辆路径跟踪横向误差小于0.1 m的最佳预测时域和参考速度的控制律；改进了用于车辆路径跟踪控制的NMPC控制器, 且改进后的NMPC控制器的性能通过仿真进行了验证。仿真结果表明：改进后的NMPC控制器的横向误差在0.092 8 m以内，航向误差在0.072 4 rad以内。相比传统NMPC控制器，改进后的NMPC控制器将最大横向误差减小了4.267 1 m以上，将最大航向误差减小了0.392 7 rad以上，路径跟踪控制性能得到了较大幅度的提高。

关键词: 路径跟踪, 非线性模型预测控制, 预测时域, 速度

Abstract: NMPC was widely applied to the path tracking control of vehicles. However, the impacts of prediction horizon and velocity on the performances of path tracking control were not considered in reported researches. Thus, the relationship among prediction horizon, velocity and the performances of path tracking control was analyzed. Through the cubic polynomial fitting, the control laws of the optimal prediction horizon and reference velocity were obtained, which may guarantee the lateral error of path tracking less than 0.1 m. Then, the NMPC controller for path tracking control was improved, and the performances of the NMPC controller were vertified by simulation. The simulation results show that, for the improved NMPC controller, the lateral error is within 0.092 8 m and the heading error is within 0.072 4 rad. Compared with the traditional NMPC controller, the improved NMPC controller reduces the maximum lateral error by more than 4.267 1 m and reduces the maximum heading error by more than 0.392 7 rad, and the performances of path tracking control are improved.

Key words: path tracking, nonlinear model predictive control(NMPC), prediction horizon, velocity

中图分类号:

U471

白国星1;孟宇1,2;刘立1;顾青1;罗维东1;甘鑫1. 基于可变预测时域及速度的车辆路径跟踪控制[J]. 中国机械工程.

BAI Guoxing1;MENG Yu1,2;LIU Li1;GU Qing1;LUO Weidong1;GAN Xin1. Path Tracking Control of Vehicles Based on Variable Prediction Horizon and Velocity[J]. China Mechanical Engineering.

参考文献

[1]JI X, LIU Y, HE X, et al. Interactive Control Paradigm Based Robust Lateral Stability Controller Design for Autonomous Automobile Path Tracking with Uncertain Disturbance: a Dynamic Game Approach[J]. IEEE Transactions on Vehicular Technology, 2018, 67(8):6906-6920.
[2]CHEEIN F A. Intelligent Sampling Technique for Path Tracking Controllers[J]. IEEE Transactions on Control Systems Technology, 2016, 24(2):747-755.
[3]陈慧岩, 张玉. 军用地面无人机动平台技术发展综述[J]. 兵工学报, 2014, 35(10):1696-1706.
CHEN Huiyan, ZHANG Yu. An Overview of Research on Military Unmanned Ground Vehicles[J]. Acta Armamentarii, 2014, 35(10):1696-1706.
[4]李逃昌. 农业轮式移动机器人自适应滑模路径跟踪控制[J]. 中国机械工程, 2018, 29(5):579-584.
LI Taochang. Adaptive Sliding Mode Path Tracking Control of Agricultural Wheeled Mobile Robots[J]. China Mechanical Engineering, 2018, 29(5):579-584.
[5]GONG J W, XU W, JIANG Y, et al. Multi-constrained Model Predictive Control for Autonomous Ground Vehicle Trajectory Tracking[J]. Journal of Beijing Institute of Technology, 2015, 24(4):441-443.
[6]武星, 楼佩煌. 基于运动预测的路径跟踪最优控制研究[J]. 控制与决策, 2009, 24(4):565-569.
WU Xing, LOU Peihuang. Optimal Path Tracking Control Based on Motion Prediction[J]. Control and Decision, 2009, 24(4):565-569.
[7]MACIEJOWSKI J M. Predictive Control with Constraints[M]. New York: Pearson Education, 2002.
[8]席裕庚，李德伟，林姝.模型预测控制——现状与挑战[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.
[9]龚建伟，姜岩，徐威.无人驾驶车辆模型预测控制[M].北京：北京理工大学出版社，2014：18-65.
GONG Jianwei, JIANG Yan, XU Wei. Model Predictive Control for Self-driving Vehicles[M]. Beijing: Beijing Institute of Technology Press, 2014:18-65.
[10]OYELERE S S. The Application of Model Predictive Control(MPC) to Fast Systems Such as Autonomous Ground Vehicles(AGV)[J]. IOSR Journal of Computer Engineering, 2014, 3(3):27-37.
[11]ATTIA R, ORJUELA R, BASSET M. Combined Longitudinal and Lateral Control for Automated Vehicle Guidance[J]. Vehicle System Dynamics, 2014, 52(2):261-279.
[12]DU X, HTET K K K, TAN K K. Development of a Genetic-algorithm-based Nonlinear Model Predictive Control Scheme on Velocity and Steering of Autonomous Vehicles[J]. IEEE Transactions on Industrial Electronics, 2016, 63(11):6970-6977.
[13]OSTAFEW C J, SCHOELLIG A P, BARFOOT T D, et al. Learning-based Nonlinear Model Predictive Control to Improve Vision-based Mobile Robot Path Tracking[J]. Journal of Field Robotics, 2016, 33(1):133-152.
[14]OSTAFEW C J, SCHOELLIG A P, BARFOOT T D. Robust Constrained Learning-based NMPC Enabling Reliable Mobile Robot Path Tracking[J]. The International Journal of Robotics Research, 2016, 35(13):1547-1563.
[15]YOON Y, SHIN J, KIM H J, et al. Model-predictive Active Steering and Obstacle Avoidance for Autonomous Ground Vehicles[J]. Control Engineering Practice, 2009, 17(7):741-750.
[16]王怿, 祝小平, 周洲,等. 3维动态环境下的无人机路径跟踪算法[J]. 机器人, 2014, 36(1):83-91.
WANG Yi, ZHU Xiaoping, ZHOU Zhou, et al. UAV Path Following in 3-D Dynamic Environment[J]. Robot, 2014, 36(1):83-91.
[17]KRAUS T, FERREAU H J, KAYACAN E, et al. Moving Horizon Estimation and Nonlinear Model Predictive Control for Autonomous Agricultural Vehicles[J]. Computers and Electronics in Agriculture, 2013, 98:25-33.
[18]FRUCHARD M, ALLIBERT G, COURTIAL E. Choice of the Control Horizon in an NMPC Strategy for the Full-state Control of Nonholonomic Systems[C]//2012 American Control Conference (ACC). Montreal: IEEE Press, 2012:4149-4154.
[19]SCIUTTO S J. Polyfit:a Package for Polynomial Fitting[J]. Computer Physics Communications, 1989, 52(3):427-442.
[20]苏金明, 张莲花, 刘波. MATLAB工具箱应用[M]. 北京：电子工业出版社, 2004.
SU Jinming, ZHANG Lianhua, LIU Bo. Application of MATLAB Toolbox[M]. Beijing: Publishing House of Electronics Industry, 2004.