基于自适应变参数MPC的分布式驱动智能车轨迹跟踪控制

doi:10.3901/JME.2024.06.363

机械工程学报 ›› 2024, Vol. 60 ›› Issue (6): 363-377.doi: 10.3901/JME.2024.06.363

扫码分享

基于自适应变参数MPC的分布式驱动智能车轨迹跟踪控制

杨泽坤^1,2, 李韶华², 王振峰³

1. 湖南大学机械与运载工程学院长沙 410082;
2. 石家庄铁道大学省部共建交通工程结构力学行为与系统安全国家重点实验室石家庄 050043;
3. 中汽研(天津)汽车工程研究院有限公司天津 300300

收稿日期:2023-04-05 修回日期:2023-11-26 出版日期:2024-03-20 发布日期:2024-06-07
通讯作者: 李韶华，女，1973年出生，博士，教授，博士研究生导师。主要研究方向为车辆系统动力学与控制。E-mail：lishaohua@stdu.edu.cn
作者简介:杨泽坤，男，1996年出生。主要研究方向为车辆系统动力学与控制。E-mail：yzk@stdu.edu.cn;王振峰，男，1987年出生，博士，高级工程师。主要研究方向为智能线控底盘与控制器开发。E-mail：wangzhenfeng44827@163.com
基金资助:
国家自然科学基金(U22A20246)、河北省重点研发计划(21342202D)和河北省省级科技计划(225676162GH)资助项目。

Trajectory Tracking Control of Distributed Driving Intelligent Vehicles Based on Adaptive Variable Parameter MPC

YANG Zekun^1,2, LI Shaohua², WANG Zhenfeng³

1. College of Mechanical and Vehicle Engineering, Hunan University, Changsha 410082;
2. State Key Laboratory of Mechanical Behavior and System Safety of Traffic Engineering Structures, Shijiazhuang Tiedao University, Shijiazhuang 050043;
3. CATARC(Tianjin) Automotive Engineering Research Institute Co., Ltd., Tianjing 300300

Received:2023-04-05 Revised:2023-11-26 Online:2024-03-20 Published:2024-06-07

摘要/Abstract

摘要： 为了协调分布式驱动智能驾驶车辆的轨迹跟踪精确性和稳定性，提高控制算法对车速扰动和路面附着系数变化等不确定性因素的自适应能力，基于平方根容积卡尔曼滤波(Square rooting cubature Kalman filter，SRCKF)估计轮胎侧向力以在线修正轮胎侧偏刚度，并基于T-S模糊变权重的MPC控制策略以实现轨迹跟踪控制。针对分布式驱动智能车全轮独立可控的特点，以前轮转角和各轮纵向驱动力为控制变量，以实时横向误差和横摆角误差为模糊输入，通过T-S模糊控制在线优化MPC目标函数权重，协调权重矩阵对轨迹跟踪精确性和稳定性的影响。通过仿真和试验数据，验证所提控制策略在多种工况下的有效性。研究表明，相比于传统MPC控制，所提出的自适应变参数MPC(Adaptive variable parameter MPC，AMPC)对80～120 km/h双移线湿滑路面、对接路面工况均有良好的跟踪效果，可有效提高轨迹跟踪精度，并能够协调控制跟踪精确性和稳定性，减少控制输出量的波动。

关键词: 智能驾驶, 轨迹跟踪, 轮胎力估计, 分布式驱动, 工况自适应

Abstract: To coordinate the trajectory tracking accuracy and stability of distributed drive intelligent driving vehicles and improve the adaptive capability of the control algorithm to uncertainties such as speed perturbations or road surface adhesion coefficient changes, the square rooting cubature Kalman filter (SRCKF) based tire lateral force estimation is used to online correct the tire cornering stiffness. The MPC control strategy based on T-S fuzzy variable weight is proposed to realize the trajectory tracking control. The front wheel steering angle and longitudinal drive force of each wheel are used as control variables under the characteristics of distributed drive intelligent vehicle with all-wheel independent controllability. The real-time lateral error and yaw error are used as fuzzy inputs to optimize the MPC objective function weights online by T-S fuzzy control and coordinate the influence of the weight matrix on the trajectory tracking accuracy and stability. The effectiveness of the proposed control strategy under various operating conditions is verified by simulation and experimental data. It is shown that compared with the traditional MPC control, the proposed adaptive variable parameter MPC (AMPC) has good tracking effect on 80-120 km/h double lane change, wet road and docking road conditions. AMPC can effectively improve the trajectory tracking accuracy, and can coordinate the control tracking accuracy and stability, meanwhile reduce the fluctuation of control output volume.

Key words: Intelligent driving, trajectory tracking, tire force estimation, distributed driving, condition adaption

中图分类号:

U461

杨泽坤, 李韶华, 王振峰. 基于自适应变参数MPC的分布式驱动智能车轨迹跟踪控制[J]. 机械工程学报, 2024, 60(6): 363-377.

YANG Zekun, LI Shaohua, WANG Zhenfeng. Trajectory Tracking Control of Distributed Driving Intelligent Vehicles Based on Adaptive Variable Parameter MPC[J]. Journal of Mechanical Engineering, 2024, 60(6): 363-377.

参考文献

[1] 张雷，赵宪华，王震坡. 四轮轮毂电机独立驱动电动汽车轨迹跟踪与横摆稳定性协调控制研究[J]. 汽车工程，2020，42(11)：1513-1521. ZHANG Lei，ZHAO Xianhua，WANG Zhenpo. Study on coordinated control of trajectory tracking and yaw stability for autonomous four-wheel-independent-driving electric vehicles[J]. Automotive Engineering，2020，42(11)：1513-1521.
[2] 邹渊，郭宁远，张旭东，等. 分布式电驱动车辆力矩分配控制研究现状综述[J]. 中国公路学报，2021，34(9)：1-24. ZOU Yuan，GUO Ningyuan，ZHANG Xudong，et al. Review of torque allocation control for distributed-drive electric vehicles.[J]. China J. Highw. Transp.，2021，34(9)：1-24.
[3] XIA Y，PU F，LI S，et al. Lateral path tracking control of autonomous land vehicle based on ADRC and differential flatness[J]. IEEE Transactions on Industrial Electronics，2016，63(5)：3091-3099.
[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] XU S，PENG H. Design，Analysis，and experiments of preview path tracking control for autonomous vehicles[J]. IEEE Transactions on Intelligent Transportation Systems，2020，21(1)：48-58.
[6] HU C，WANG R，YAN F. Integral sliding mode-based composite nonlinear feedback control for path following of four-wheel independently actuated autonomous vehicles[J]. IEEE Transactions on Transportation Electrification，2016，2(2)：221-230.
[7] GUO J，HU P，LI L，et al. Design of automatic steering controller for trajectory tracking of unmanned vehicles using genetic algorithms[J]. IEEE Transactions on Vehicular Technology，2012，61(7)：2913-2924.
[8] ROKONUZZAMAN M，MOHAJER N，NAHAVANDI S，et al. Review and performance evaluation of path tracking controllers of autonomous vehicles[J]. IET Intelligent Transport Systems，2021，15(5)：646-670.
[9] ATAEI M，KHAJEPOUR A，JEON S. Model predictive control for integrated lateral stability ，traction / braking control ，and rollover prevention of electric vehicles[J]. Vehicle System Dynamics，2019，58(1)：1-25.
[10] GUO H，CAO D，CHEN H，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.
[11] CUI Q，DING R，WEI C，et al. Path-tracking and lateral stabilisation for autonomous vehicles by using the steering angle envelope ABSTRACT[J]. Vehicle System Dynamics，2020.
[12] 吴西涛，魏超，翟建坤，等. 考虑横摆稳定性的无人车轨迹跟踪控制优化研究[J]. 机械工程学报，2022，58(6)：130-142. WU Xitao，WEI Chao，ZHAI Jiankun，et al. Study on the optimization of autonomous vehicle on path-following considering yaw stability[J]. Journal of Mechanical Engineering，2022，58(6)：130-142.
[13] CHENG S，LI L，MEMBER S，et al. Model-predictive-control-based path tracking controller of autonomous vehicle considering parametric uncertainties and velocity-varying[J]. IEEE Transactions on Industrial Electronics，2021，68(9)：8698-8707.
[14] PENG H，WANG W，AN Q，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，2019，69(6)：6053-6066.
[15] REN Y，ZHENG L，KHAJEPOUR A. Integrated model predictive and torque vectoring control for path tracking of 4-wheel-driven autonomous vehicles[J]. IET Intelligent Transport Systems，2019，13(1)：98-107.
[16] AMIR M，GIVARGIS T. Hybrid state machine model for fast model predictive control：application to path tracking[C]//2017 IEEE/ACM International Conference on Computer-Aided Design (ICCAD). IEEE，2017：185-192.
[17] FUNKE J，BROWN M，ERLIEN S M，et al. Collision avoidance and stabilization for autonomous vehicles in emergency scenarios[J]. IEEE Transactions on Control Systems Technology，2017，25(4)：1204-1216.
[18] ZHANG B，ZONG C，CHEN G，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.
[19] XUE W，ZHENG L. Active collision avoidance system design based on model predictive control with varying sampling time[J]. Automotive Innovation，2020，3(1)：62-72.
[20] WANG J，TENG F，LI J，et al. Intelligent vehicle lane change trajectory control algorithm based on weight coefficient adaptive adjustment[J]. Advances in Mechanical Engineering，2021，13(3)：1-16.
[21] KOBAYASHI T，KATSUYAMA E，SUGIURA H，et al. Theoretical analysis of tyre slip power dissipation mechanism using brush model[J]. Vehicle System Dynamics，2020，58(8)：1242-1256.
[22] NGUYEN A T，SENTOUH C，ZHANG H，et al. Fuzzy static output feedback control for path following of autonomous vehicles with transient performance improvements[J]. IEEE Transactions on Intelligent Transportation Systems，2020，21(7)：3069-3079.
[23] GUO J，LUO Y，LI K. Robust gain-scheduling automatic steering control of unmanned ground vehicles under velocity-varying motion[J]. Vehicle System Dynamics，2019，57(4)：595-616.
[24] LIANG Y，LI Y，KHAJEPOUR A，et al. Holistic adaptive multi-model predictive control for the path following of 4WID autonomous vehicles[J]. IEEE Transactions on Vehicular Technology，2020，70(1)：69-81.
[25] BEAL C E. Rapid road friction estimation using independent left/right steering torque measurements[J]. Vehicle System Dynamics，2020，58(3)：377-403.
[26] LIAO Y W，BORRELLI F. An adaptive approach to real-time estimation of vehicle sideslip，road bank angles，and sensor bias[J]. IEEE Transactions on Vehicular Technology，2019，68(8)：7443-7454.
[27] LI W，LI H，XU K，et al. Estimation of vehicle dynamic parameters based on the two-stage estimation method[J]. Sensors，2021，21(11)：3711.
[28] ZHANG Z，ZHENG L，WU H，et al. An estimation scheme of road friction coefficient based on novel tyre model and improved SCKF[J]. Vehicle System Dynamics，2022，60(8)：2775-2804.
[29] ARASARATNAM I，HAYKIN S. Cubature kalman filters[J]. IEEE Transactions on Automatic Control，2009，54(6)：1254-1269.
[30] RAY L R. Nonlinear state and tire force estimation for advanced vehicle control[J]. IEEE Transactions on Control Systems Technology，1995，3(1)：117-124.
[31] BHAUMIK S. Square-root cubature-quadrature Kalman filter[J]. Asian Journal of Control，2014，16(2)：617-622.
[32] 张志达，郑玲，李以农，等. 基于鲁棒自适应SCKF的智能汽车目标状态跟踪研究[J]. 机械工程学报，2021，57(20)：181-193. ZHANG Zhida，ZHENG Ling，LI Yinong，et al. Research on intelligent vehicle target state tracking based on robust adaptive SCKF[J]. Journal of Mechanical Engineering，2021，57(20)：181-193.
[33] HAN Y，LU Y，CHEN N，et al. Research on the identification of tyre-road peak friction coefficient under full slip rate range based on normalized tyre model[J]. Actuators，2022，11(2)：59.
[34] 龚建伟，姜岩，徐威. 无人驾驶车辆模型预测控制[M]. 北京：北京理工大学出版社，2014. GONG Jianwei，JIANG Yan，XU Wei，et al. Model predictive control for self-driving vehicles[M]. Beijing：Beijing Inst. Technol. Press，2014.

基于自适应变参数MPC的分布式驱动智能车轨迹跟踪控制

Trajectory Tracking Control of Distributed Driving Intelligent Vehicles Based on Adaptive Variable Parameter MPC

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	汪首坤, 许永康, 陈志华, 司金戈, 李斌, 王军政. 无人机移动自主回收着陆原理及控制方法[J]. 机械工程学报, 2024, 60(3): 34-46.
[2]	姚建均, 张宜坤, 柯运, 钱琛, 王超. 基于模型预测控制的机器人姿态控制策略研究[J]. 机械工程学报, 2024, 60(19): 88-100.
[3]	何华, 刘全, 申屠舒展, 宫昭. 轮式多机协同搬运机器人轨迹跟踪控制器设计[J]. 机械工程学报, 2024, 60(11): 145-155.
[4]	胡林, 杨冬兆, 张新, 章杰, 廖家才. 基于DQP-LMPC的智能车超车换道动态路径规划[J]. 机械工程学报, 2024, 60(10): 171-181.
[5]	刘聪, 刘辉, 韩立金, 聂士达. 基于学习型滑模预测控制的无人驾驶车辆非结构化环境轨迹跟踪及稳定性控制[J]. 机械工程学报, 2024, 60(10): 399-412.
[6]	张雷, 王祺, 王震坡, 丁晓林, 孙逢春. 基于线控制动的分布式驱动电动汽车制动俯仰角舒适控制研究[J]. 机械工程学报, 2024, 60(10): 463-475.
[7]	李韶华, 杨泽坤, 王雪玮. 基于T-S模糊变权重MPC的智能车轨迹跟踪控制[J]. 机械工程学报, 2023, 59(4): 199-212.
[8]	张雷, 徐同良, 李嗣阳, 程树辉, 丁晓林, 王震坡, 孙逢春. 全线控分布式驱动电动汽车底盘协同控制研究综述[J]. 机械工程学报, 2023, 59(20): 261-280.
[9]	林棻, 蔡亦璋, 赵又群, 臧利国, 王少博. 匹配机械弹性车轮的分布式驱动电动汽车稳定性控制[J]. 机械工程学报, 2022, 58(8): 236-243.
[10]	吴西涛, 魏超, 翟建坤, 苑士华. 考虑横摆稳定性的无人车轨迹跟踪控制优化研究[J]. 机械工程学报, 2022, 58(6): 130-142.
[11]	庞辉, 刘楠, 刘敏豪, 张风奇. 基于线性时变模型预测控制的自主车辆轨迹跟踪控制器设计与验证[J]. 机械工程学报, 2022, 58(24): 264-274.
[12]	杜荣华, 胡鸿飞, 高凯, 黄浩. 基于变预测时域MPC的自动驾驶汽车轨迹跟踪控制研究[J]. 机械工程学报, 2022, 58(24): 275-288.
[13]	卢宗兴, 苏永生, 东辉, 李胤增, 赵栋哲. 基于足底力反馈的踝关节主被动康复策略[J]. 机械工程学报, 2022, 58(21): 50-59.
[14]	陶永, 兰江波, 刘海涛, 王田苗, 高赫, 温宇方, 段练. 基于滑模和模糊算法相融合的人机协作机器人轨迹跟踪方法[J]. 机械工程学报, 2022, 58(18): 181-191.
[15]	张雷, 王子浩, 孙逢春, 王震坡. 四轮轮毂电机驱动智能电动汽车转向失效容错控制研究[J]. 机械工程学报, 2021, 57(20): 141-152.