自主驾驶车辆紧急避障的路径规划与轨迹跟踪控制

doi:10.3969/j.issn.1000-1093.2020.03.020

兵工学报 ›› 2020, Vol. 41 ›› Issue (3): 585-594.doi: 10.3969/j.issn.1000-1093.2020.03.020

自主驾驶车辆紧急避障的路径规划与轨迹跟踪控制

邓海鹏¹，麻斌¹，赵海光²，吕良¹，刘宇¹

(1.吉林大学汽车仿真与控制国家重点试验室，吉林长春 130025； 2.中国环境科学研究院，北京 100012)

收稿日期:2019-05-13 修回日期:2019-05-13 上线日期:2020-05-11
通讯作者: 刘宇（1981—），男，副教授，博士 E-mail:liuyu1981@jlu.edu.cn
作者简介:邓海鹏（1994—），男，硕士研究生。E-mail: denghp16@163.com
基金资助:
国家重点研发计划项目（2016YFB0100300）

Path Planning and Tracking Control of Autonomous Vehicle for Obstacle Avoidance

DENG Haipeng¹， MA Bin¹， ZHAO Haiguang²， L Liang¹, LIU Yu¹

(1.State Key Laboratory of Automobile Simulation and Control， Jilin University， Changchun 130025， Jilin， China；2.Chinese Research Academy of Environmental Science， Beijing 100012， China)

Received:2019-05-13 Revised:2019-05-13 Online:2020-05-11

摘要/Abstract

摘要： 为减少道路突发事故，提高车辆通行效率，需要研究车辆的紧急避障以实现自主驾驶。基于车辆点质量模型，设计了非线性模型预测控制（MPC）路径规划器；基于车辆动力学模型，设计了线性时变MPC轨迹跟踪器。在路径规划层引入避障功能函数，通过车辆与障碍物的距离调节函数值大小，综合避障函数权重和路径偏差权重，规划出一条既能避开障碍物又使路径偏差最小的临时轨迹。在轨迹跟踪层，利用该临时轨迹和航向角偏差作为车辆主动转向控制参考量，将线性时变MPC优化问题转化为二次规划问题，计算满足车辆动力学约束的前轮转向角最优解。结果表明：所设计的双层MPC紧急避障控制策略对低速(60 km/h)、中速(80 km/h)、高速(100 km/h)行驶车辆有很强的适应性，高速行驶时最大质心侧偏角不超过1.0°，最大航向角偏差不超过2.5°，车辆横向稳定性良好，随着车速增大，车辆避障响应时刻提前；在多车连续避障场景中，自主驾驶车辆的质心侧偏角和航向角偏差均能控制在较小范围内，在多目标连续避障的路径规划和轨迹跟踪问题上同样具有很好的控制效果。

关键词: 自主驾驶车辆, 紧急避障, 车辆点质量模型, 模型预测控制, 路径规划与轨迹跟踪

Abstract: Emergency obstacle avoidance is one of the key points for autonomous driving system. A path planning controller based on non-linear model predictive control and a path tracking controller based on linear time-varying model predictive control are designed.In path planning controller，an obstacle-avoiding function is used to adjust the distance between the intelligent vehicle and obstacles by calculating the value of obstacle-avoiding function.A new route is supposed to be planned，which can not only keep away from obstacles but also decrease the deviations from the global course，by considering the different weights of obstacle-avoiding function and the planning error. In path tracking controller，the solution of linear time-varying model predictive control is converted into a positive-definite quadratic program.And then the desired steering angles of front wheel are calculated by using the reference trajectory and orientation angle of vehicle center. The results show that the obstacle-avoiding controller has strong robustness and the path tracking controller has better performance in controlling accuracy and vehicle dynamics stability when a vehicle travels at 60 km/h，80 km/h，or 100 km/h. The maximal side-slip angle is no more than 1°，and the maximal deviation of yaw angle is less than 2.5°.Obstacle avoiding action occurs in advance with the increase in velocity of autonomous vehicle. In addition，the dual-MPC controller is adaptive to the circumstance of multi-obstacles avoidance as well，which can be easily demonstrated by the small deviation of yaw angles and small side-slip angles.Key

Key words: autonomousvehicle, obstacleavoidance, pointmassmodelofvehicle, modelpredictivecontrol, pathplanningandtracking

中图分类号:

邓海鹏，麻斌，赵海光，吕良，刘宇. 自主驾驶车辆紧急避障的路径规划与轨迹跟踪控制[J]. 兵工学报, 2020, 41(3): 585-594.

DENG Haipeng， MA Bin， ZHAO Haiguang， L Liang, LIU Yu. Path Planning and Tracking Control of Autonomous Vehicle for Obstacle Avoidance[J]. Acta Armamentarii, 2020, 41(3): 585-594.

参考文献

［1］ HILGERT J，HIRSCH K，BERTRAM T，et al.Emergency path planning for autonomous vehicles using elastic band theory[C]∥Proceedings of IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Kobe， Japan:IEEE，2003:1390-1395.
[2］ SCHOUWENAARS T，HOW J，FERON E.Receding horizon path planning with implicit safety guarantees[C]∥Proceedings of American Control Conference.Boston，MA，US:IEEE，2004:5576-5581.
[3］ YU H，GONG J，IAGNEMMA K，et al.Robotic wheeled vehicle ripple tentacles motion planning method[C]∥Proceedings of Intelligent Vehicles Symposium. Alcala de Henares，Spain:IEEE，2012:1156-1161.
[4］张纯刚，席裕庚.动态未知环境中移动机器人的滚动路径规划[J].机器人，2002，24(1):71-75.
ZHANG C G，XI Y G.Rolling path planning of mobile robot in dynamic unknown environment[J].Robot，2002，24(1):71-75.（in Chinese）
[5］阮久宏，李贻斌，杨福广，等.高速4WID-4WIS自主车路径跟踪控制[J].机器人，2011，33(4):411-418.
RUAN J H，LI Y B，YANG F G，et al.Path tracking control of high-speed 4WID-4WIS autonomous vehicle[J].Robot，2011，33(4): 411-418.(in Chinese)
[6］李琳辉，伦智梅，连静，等.基于卷积神经网络的道路车辆检测方法[J].吉林大学学报(工学版)，2017，47(2):384-391.
LI L H，LUN Z M，LIAN J，et al. Convolution neural network-based vehicle detection method[J].Journal of Jilin University (Engineering and Technology Edition)， 2017，47(2):384-391. (in Chinese)
[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］ WANG R J，YIN G D，JIN X J. Robust adaptive sliding mode control for nonlinear four-wheel steering autonomous vehicles path tracking systems[C]∥Proceedings of the 8th International Power Electronics and Motion Control Conference. Hefei，China:IEEE，2016:1-8.
[9］ ANTONELLI G，CHIAVERINI S，FUSCO G. A fuzzy-logic-based approach for mobile robot path tracking[J].IEEE Transactions on Fuzzy Systems，2007，15(2):211-221.

[10］ HAJJAJI A E， BENTALBA S. Fuzzy path tracking control for automatic steering of vehicles[J].Robotics & Autonomous Systems，2003，43(4):203-213.
[11］ LIANG L，LU Y S，WANG R R，et al. A 3-dimentional dynamics control framework of vehicle lateral stability and rollover prevention via active braking with MPC[J].IEEE Transactions on Industrial Electronics，2016，64(4):3389-3401.
[12］宗长富，陈国迎，梁赫奇，等.基于模型预测控制的汽车底盘协调控制策略[J].农业机械学报，2011，42(2):1-7.
ZONG C F，CHEN G Y，LIANG H Q，et al.Vehicle chassis coordination control strategy based on model predictive control[J].Transactions of the Chinese Society for Agricultural Machinery，2011，42(2):1-7.(in Chinese)
[13］ LI S B，LI K Q，RAJAMARRI R，et al.Model predictive multi-objective vehicular adaptive cruise control[J].IEEE Transactions on Control Systems Technology，2011，19(3):556-566.
[14］ WANG H，HUANG Y J，KHAJEPOUR A，et al.Crash mitigation in motion planning for autonomous vehicles[J]. IEEE Transactions on Intelligent Transportation Systems， 2019， 20(9): 3313-3323.
[15］ BRUSCHETTA M，MARAN F，BEGHI A. A fast implementation of MPC-based motion cueing algorithms for mid-size road vehicle motion simulators[J].Vehicle System Dynamics，2017，55(6):802-826.
[16］胡家铭，胡宇辉，陈慧岩，等.基于模型预测控制的无人驾驶履带车辆轨迹跟踪方法研究[J].兵工学报，2019，40(3):456-463.
HU J M，HU Y H，CHEN H Y，et al. Research on trajectory tracking of unmanned tracked vehicles based on model predictive control[J].Acta Armamentarii，2019，40(3):456-463.(in Chinese)
[17］ PRACH A，KAYACAN E.An MPC-based position controller for a tilt-rotor tricopter VTOL UAV[J].Optimal Control Applications and Methods，2018，39(4):343-356.
[18］陈虹.模型预测控制[M].北京:科学出版社，2013.
CHEN H. Model predictive control[M].Beijing:Science Press，2013.(in Chinese)
[19］余志生.汽车理论[M].第3版.北京：机械工业出版社，2000.
YU Z S. Automotive theory[M].3rd ed.Beijing：China Machine Press，2000.(in Chinese)
[20］ PACEJKA H B，EGBERT B.The magic formula tyre model[C]∥Proceedings of Tyre Models for Vehicle Dynamic Analysis: International Colloquium on Tyre Models for Vehicle Dynamics.London，UK:Taylor & Francis，1991：1-18.
[21］ GAO Y Q. Model predictive control for autonomous and semiautonomous vehicles[D].Berkeley，CA，US:University of California，2014:1-10.
[22］雷强顺，彭友余，汪国胜，等.车辆电控空气悬挂结构优化模型与优化设计方法研究[J].兵工学报，2018，39(7):1259-1267.
LEI Q S，PENG Y Y，WANG G S，et al.Study of optimal model and optimizing method for the electronically controlled air suspension system structure[J].Acta Armamentarii，2018，39(7):1259-1267.(in Chinese)

第41卷
第3期2020 年3月兵工学报ACTA
ARMAMENTARIIVol.41No.3Mar.2020

[1]	陈路明，廖自力，马晓军，刘春光. 基于分层控制的混合动力车辆实时能量管理策略[J]. 兵工学报, 2021, 42(8): 1580-1591.
[2]	刘聪，刘辉，韩立金，陈科. 分布式电驱动车辆极限越野环境下高速避障与稳定性控制[J]. 兵工学报, 2021, 42(10): 2102-2113.
[3]	王志福，白金，黄康伦，王军，王阳，梁常春，王瑞. 基于模型预测控制的轮毂电机驱动车辆防侧翻控制[J]. 兵工学报, 2021, 42(1): 11-25.
[4]	胡家铭，胡宇辉，陈慧岩，刘凯. 基于模型预测控制的无人驾驶履带车辆轨迹跟踪方法研究[J]. 兵工学报, 2019, 40(3): 456-463.
[5]	王威，陈慧岩，马建昊，刘凯，龚建伟. 基于Frenet坐标系和控制延时补偿的智能车辆路径跟踪[J]. 兵工学报, 2019, 40(11): 2336-2351.
[6]	修观，王良明₁，孙瑞胜₁，杨荣军₁. 一种快速非线性模型预测控制律研究[J]. 兵工学报, 2011, 32(10): 1189-1194.

自主驾驶车辆紧急避障的路径规划与轨迹跟踪控制

Path Planning and Tracking Control of Autonomous Vehicle for Obstacle Avoidance

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 6

编辑推荐

Metrics

本文评价