高速无人驾驶车辆最优运动规划与控制的动力学建模分析

doi:10.3901/JME.2018.14.141

机械工程学报 ›› 2018, Vol. 54 ›› Issue (14): 141-151.doi: 10.3901/JME.2018.14.141

扫码分享

高速无人驾驶车辆最优运动规划与控制的动力学建模分析

刘凯, 龚建伟, 陈舒平, 张玉, 陈慧岩

北京理工大学智能车辆研究所北京 100081

收稿日期:2018-02-05 修回日期:2018-06-15 出版日期:2018-07-20 发布日期:2018-07-20
通讯作者: 龚建伟(通信作者),男,1969年出生,博士,教授,博士生导师。主要研究方向为无人驾驶车辆、路径规划与控制、环境感知、机器学习。E-mail:gongjianwei@bit.edu.cn
作者简介:刘凯,男,1985年出生,博士研究生。主要研究方向为无人驾驶车辆、路径规划与控制。E-mail:leoking1025@bit.edu.cn
基金资助:
国家自然科学基金（91420203，61703041，51275041）和中央高校基本科研业务费用专项资金资助项目。

Dynamic Modeling Analysis of Optimal Motion Planning and Control for High-speed Self-driving Vehicles

LIU Kai, GONG Jianwei, CHEN Shuping, ZHANG Yu, CHEN Huiyan

Intelligent Vehicle Research Center, Beijing Institute of Technology, Beijing 100081

Received:2018-02-05 Revised:2018-06-15 Online:2018-07-20 Published:2018-07-20

摘要/Abstract

摘要： 在高速无人驾驶车辆的运动规划与跟踪控制过程中，滑移和侧倾是很难克服的高度非线性约束，特别是在复杂地形条件下，容易导致车辆失稳甚至侧翻。通过研究地形因素对车辆转向特性和稳定性的影响，建立高速车辆的等效动力学模型，并提出了一种变步长的模型离散化方法，能够在保证及时动态响应的基础上，实现较长的轨迹预测时域以及计算的实时性。针对高速无人驾驶车辆的滑移和侧倾等动力学安全因素，通过对车辆稳定行驶状态进行分析，推导了基于包络线和零力矩点的高速车辆稳定性约束条件。根据在高速、滑移、侧倾等复杂约束下车辆安全行驶的要求，运用模型预测控制算法求解最优运动轨迹及跟踪控制序列，在保证道路环境约束的同时满足车辆的滑移和侧倾等稳定性约束。仿真试验表明，该方法可以有效的考虑道路曲率和地形对高速车辆动力学特性的影响，保证车辆无碰撞行驶，同时防止车辆出现滑移和侧倾等现象。

关键词: 操控稳定性, 等效动力学建模, 高速无人驾驶车辆, 模型预测控制

Abstract: Motion planning and control for high-speed self-driving vehicles is complicated since it involves highly nonlinear constraints such as sideslip and rollover. Inappropriate handling of these constraints, particularly under complex terrain conditions, will lead to loss control of vehicles or even fatal accidents. Through studies on the effect of road curvature and terrain to the vehicle steering characteristics and handling stability, a simplified equal dynamic model is developed for high-speed self-driving vehicles. And a model discretization method with variable time-steps in the prediction horizon is proposed to ensure immediate dynamical response while attaining a long enough prediction horizon and computational feasibility. Taking dynamical safety related concerns such as sideslip and rollover into account, vehicle handling stability constraints, including sideslip envelope and zero moment point, are concluded through vehicle steady-state analysis. A model predictive control problem is formulated and solved to find the optimal motion trajectory and control sequence, satisfying the road environmental constraints while ensuring handling stability. Simulation results validated the capability of the proposed approach under the influence of complex road curvature and terrain.

Key words: equal dynamic modeling, handling stability, high-speed self-driving vehicle, model predictive control

中图分类号:

U461

刘凯, 龚建伟, 陈舒平, 张玉, 陈慧岩. 高速无人驾驶车辆最优运动规划与控制的动力学建模分析[J]. 机械工程学报, 2018, 54(14): 141-151.

LIU Kai, GONG Jianwei, CHEN Shuping, ZHANG Yu, CHEN Huiyan. 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.

参考文献

[1] FU L,YAZICI A,OZGUNER U. Route planning for osu-act autonomous vehicle in darpa urban challenge[C]//Proceedings of the Intelligent Vehicles Symposium. Eindhoven,Netherlands:IEEE,2008:781-786.
[2] THRUN S,MONTEMERLO M,DAHLKAMP H,et al. Stanley:The robot that won the darpa grand challenge[J]. Journal of field Robotics,2006,23(9):661-692.
[3] 姜岩,赵熙俊,龚建伟,等.简单城市环境下地面无人驾驶系统的设计研究[J].机械工程学报,2012,48(20):103-112. JIANG Yan,ZHAO Xijun,GONG Jianwei,et al. System design of self-driving in simplified urban environments[J]. Journal of Mechanical Engineering,2012,48(20):103-112.
[4] 姜岩,龚建伟,熊光明,等. 基于运动微分约束的无人车辆纵横向协同规划算法的研究[J]. 自动化学报,2013,39(12):2012-2020. JIANG Yan,GONG Jianwei,XIONG Guangming,et al. Research on differential constraints-based planning algorithm for autonomous-driving vehicles[J]. Acta Automatica Sinica,2013,39(12):2012-2020.
[5] GREENBALTT N A. Self-driving cars and the law[J]. IEEE Spectrum,2016,53(2):46-51.
[6] 余卓平,章仁燮,熊璐,等. 基于条件积分方法的无人差动转向车辆动力学控制[J]. 机械工程学报,2017,53(14):39-38. YU Zhuoping,ZHANG Renxie,XIONG Lu,et al. Dynamic control for unmanned skid-steering vehicle with conditional integartors[J]. Journal of Mechanical Engineering,2017,53(14):29-38.
[7] JEON J,COWLAGI R,PETERS S,et al. Optimal motion planning with the half-car dynamical model for autonomous high-speed driving[C]//Proceedings of the American Control Conference. Washington,DC,USA:2013:188-193.
[8] SHIMODA S,KURODA Y,IAGNEMMA K. High-speed navigation of unmanned ground vehicles on uneven terrain using potential fields[J]. Robotica,2007,25(4):409-424.
[9] LIU Kai,GONG Jianwei,KURT A,et al. A model predictive-based approach for longitudinal control in autonomous driving with lateral interruptions[C]//International Conference on Vehicles Symposium. Los Angeles,USA:IEEE,2017:359-364.
[10] BROWN M,FUNKE J,ERLIEN S. Safe driving envelopes for path tracking in autonomous vehicles[J]. Control Engineering Practice,2016,61:307-316.
[11] BEAL C,GERDES J. Model predictive control for vehicle stabilization at the limits of handling[J]. IEEE Transactions on Control Systems Technology,2013,21(4):1258-1269.
[12] BROWN M,ERLIEN S.M,FUNKE J,et al. Collision avoidance and stabilization for autonomous vehicles in emergency scenarios[J]. IEEE Transactions on Control Systems Technology,2017,25:1204-1216.
[13] PARIDA N,RAHA S,RAMANI A. Rollover-preventive force synthesis at active suspensions in a vehicle performing a severe maneuver with wheels lifted off[J]. IEEE Transactions on Intelligent Transportation Systems,2014,15(6):2583-2594.
[14] LI Liang,LU Yishi,WANG Rongrong,et al. A three-dimentional dynamics control framework of vehicle lateral stability and rollover prevention via active braking with MPC[J]. IEEE Transactions on Industrial Electronics,2017,64(4):3389-3401.
[15] LAPAPONG S,BRENNAN S. Terrain-aware rollover prediction for ground vehicles using the zero-moment point method[C]//Proceedings of the 2010 American Control Conference. Baltimore,MD,USA:2010:1501-1507.
[16] STANKIEWICZ P,BROWN A,BRENNAN S. Preview horizon analysis for vehicle rollover prevention using the zero-moment point[J]. Journal of Dynamic Systems,Measurement,and Control,2015,137(9):1-12.
[17] LI Shengbo,XU Shaobing,KUM D. Efficient and accurate computation of model predictive control using pseudospectral discretization[J]. Neuro Computing,2015,172:363-372.
[18] LI Shengbo,JIA Zhenzhong,Li Keqiang,et al. Fast online computation of a model predictive controller and its application to fuel economy-oriented adaptive cruise control[J]. IEEE Transactions on Intelligent Transportation System,2015,16(3):1199-1209.
[19] 李升波,王建强,李克强. 软约束线性模型预测控制系统的稳定性方法[J]. 清华大学学报,2010,50(11):1848-1852. LI Shengbo,WANG Jianqiang,LI Keqiang. Stabilization of linear predictive control systems with softening constraints[J]. Journal of Tsinghua University,2010,50(11):1848-1852.
[20] PACEJKA H B. Tyre and vehicle dynamics[M]. Oxford:Butterworth-Heinemann,2006.
[21] CHENG Shuo,LI Liang,CHEN Jie. Fusion algorithm design based on adaptive SCKF and integral correction for side-slip angle observation[J]. IEEE Transactions on Industrial Electronics,2018,65(7):5754-5763.
[22] BECHTOFF J,KOENIG L,ISERMANN R. Cornering stiffness and sideslip angle estimation for integrated vehicle dynamics control[J]. IFAC-PapersOnLine,2016,49(11):297-304.
[23] MATTINGLEY J,BOYD S. CVXGEN:a code generator for embedded convex optimization[J]. Optimization and Engineering,2012,13(1):1-27.

高速无人驾驶车辆最优运动规划与控制的动力学建模分析

Dynamic Modeling Analysis of Optimal Motion Planning and Control for High-speed Self-driving Vehicles

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	王艺, 蔡英凤, 陈龙, 王海, 何友国, 李健. 基于模型预测控制的智能网联汽车路径跟踪控制器设计[J]. 机械工程学报, 2019, 55(8): 136-144,153.
[2]	闫涵,吕建国,丁金勇,马丙辉,阎亦然. 非理想电网下NPC三电平逆变器多目标模型预测控制方法研究 ^*[J]. 电气工程学报, 2019, 14(3): 23-32.
[3]	林程, 曹放, 梁晟, 高翔, 董爱道. 双电机后驱车辆操纵稳定性分层混杂模型预测控制[J]. 机械工程学报, 2019, 55(22): 123-130.
[4]	赵治国, 倪润宇, 姜斯文, 雷丹. DCT变速四驱HEV混动至纯电动模式切换优化控制[J]. 机械工程学报, 2019, 55(22): 140-152.
[5]	高振刚, 陈无畏, 谈东奎, 赵林峰, 汪洪波. 考虑驾驶员操纵失误的车道偏离辅助人机协同控制[J]. 机械工程学报, 2019, 55(16): 91-103.
[6]	韩玲, 刘鸿祥, 王金武, 刘畅. 基于MPC的无级变速器控制优化策略研究[J]. 机械工程学报, 2019, 55(10): 158-167.
[7]	张风奇, 胡晓松, 许康辉, 唐小林, 崔亚辉. 混合动力汽车模型预测能量管理研究现状与展望[J]. 机械工程学报, 2019, 55(10): 86-108.
[8]	张永昌,蔡倩,彭玉宾,杨海涛. 带参数辨识功能的三电平变换器高效模型预测控制方法[J]. 电气工程学报, 2018, 13(4): 1-10.
[9]	朱敏, 陈慧岩. 无人驾驶越野车辆纵向速度跟踪控制试验[J]. 机械工程学报, 2018, 54(24): 111-117.
[10]	梅杨,李晓晴,黄伟超. 级联式双向DC-DC变换器的模型预测控制[J]. 电气工程学报, 2017, 12(3): 10-15.
[11]	刘丛伟,林跻云. 三相PWM整流器模型预测控制的研究[J]. 电气工程学报, 2017, 12(3): 16-23.
[12]	朱敏, 陈慧岩. 考虑车间反应时距的汽车自适应巡航控制策略[J]. 机械工程学报, 2017, 53(24): 144-150.
[13]	姜丹娜, 黄英. 通过道路并联混合动力车辆的低频纵振主动控制[J]. 机械工程学报, 2017, 53(14): 68-76.
[14]	王付胜,文鹏,张兴. 三电平环宽自适应准定频滞环模型预测控制研究[J]. 电气工程学报, 2016, 11(4): 9-14.
[15]	刘丛伟,肖佳松. 单相光伏并网逆变系统基于球形译码多步模型预测控制的研究[J]. 电气工程学报, 2016, 11(11): 26-32.