基于Tube MPC的多轴重型车辆全轮转向路径跟踪策略

doi:10.19562/j.chinasae.qcgc.2022.11.005

摘要/Abstract

摘要：

本文中为具有智能驾驶功能的五轴重型车辆提出一种基于鲁棒不变集的模型预测控制（Tube MPC）的全轮转向路径跟踪策略。首先提出了基于第1桥和第5桥转角控制的全轮转向路径跟踪策略，使多轴车的控制更灵活，侧向力响应可实现同步且能得到充分利用。接着控制模型考虑轮胎参数不确定和侧向风产生的有界干扰，采用 Tube MPC 求解路径跟踪问题。同时采用基于支撑函数计算的简化最小鲁棒正不变集（mRPI）代替了通用的基于Minkowski求和的mRPI运算，有效地节约了mRPI的离线计算时间，也减少了不变集的顶点个数，以保证Tube MPC的在线实现。最后进行硬件在环仿真，验证了所提基于Tube MPC的全轮转向策略对比普通的全轮转向策略具有更高的路径跟踪精度和车辆稳定性，面对未知干扰时有更强的鲁棒性。

关键词: 五轴重型车辆, Tube MPC, 全轮转向, 路径跟踪, 最小鲁棒正不变集

Abstract:

An all-wheel steering path tracking strategy based on model predictive control with robust invariant set is proposed for a five-axle heavy-duty vehicle in this paper. Firstly， an all-wheel steering path tracking strategy based on first-axle and fifth-axle steering angle control is put forward to make the multi-axle vehicle more flexible in control， with the lateral force response synchronized and fully utilized. Then with considerations of the uncertainty of tire parameters and the bounded disturbance caused by side-wind in the control model， the Tube MPC is used to solve the path tracking problem. Meanwhile， a simplified minimum robust positively invariant set （mRPI） based on support function calculation is adopted to replace the general Minkowski sum-based mRPI operation， effectively saving the offline computation time of mRPI， reducing the number of vertices in the invariant set， and ensuring the online implementation of Tube MPC. Finally， a hardware-in-the-loop simulation is carried out with a result verifying that the Tube MPC-based all-wheel steering strategy proposed has higher path tracking accuracy and vehicle stability and stronger robustness when facing unknown disturbance， compared with ordinary all-wheel steering strategy.

Key words: five-axle heavy-duty vehicle, Tube MPC, all-wheel steering, path tracking, minimum robust positively invariant set

王玮琛,李军求,孙逢春,宋健,吴永华. 基于Tube MPC的多轴重型车辆全轮转向路径跟踪策略[J]. 汽车工程, 2022, 44(11): 1665-1675.

Weichen Wang,Junqiu Li,Fengchun Sun,Jian Song,Yonghua Wu. Path Tracking Strategy for All-Wheel Steering of Multi-axle Heavy-Duty Vehicles Based on Tube MPC[J]. Automotive Engineering, 2022, 44(11): 1665-1675.

图/表 21

图1

图2

图3

图4

表1

高效mRPI计算流程"

算法：最小鲁棒正不变集的高效求解
1.先确定参数 $ε$ ，并求解满足式（29）的数组 $k *, ε$ 。
2.基于式（34），通过线性规划（LPs）求得集合 $C$ 。
3.基于式（38），通过 $k$ 次迭代求解集合 $P ∞$ ，即 $S m i n$ 。

表1

图5

图6

图7

表2

主要仿真参数"

参数	数值
整车质量m/kg	45 000
轮距B/m	2.6
整车转动惯量/（ $k g ? m 2$ ）	430 000
各轴到质心距离 $L 1 ~ L 5$ /m	6.9/4.5/0/-2.4/-4.8
轮胎侧偏刚度 $C f$ / $C r$ /（N·rad^-1）	374 000/580 000
预测步长N	10
采样时间T/s	0.1
权重系数 Q	diag（80，0，350， 550）
权重系数 R	diag（800， 800）

表2

图8

图9

图10

图11

图12

图13

图14

图15

图16

图17

图18

图19

参考文献 17

1	ZOU Yan， GUO Ningyuan， ZHANG Xudong. An integrated control strategy of path following and lateral motion stabilization for autonomous distributed drive electric vehicles［J］. Proceedings of the Institution of Mechanical Engineers， Part D： Journal of Automobile Engineering， 2019.
2	WEI Chongfeng，ROMANO Richard， MERAT Natasha， et al. Risk-based autonomous vehicle motion control with considering human driver’s behavior［J］. Transportation Research Part C： Emerging Technologies， 2019，107： 1-14.
3	PARK Kwanwoo， JOA Eunhyek， YI Kyongsu. Rear-wheel steering control for enhanced steady-state and transient vehicle handling characteristics［J］. IEEE Access， 2020（8）.
4	VIGNATI M， SABBIONI E. A cooperative control strategy for yaw rate and sideslip angle control combining torque vectoring with rear wheel steering［J］. Vehicle System Dynamics，2021.
5	CHEN Yong， CHEN Sizhong， REN Hongbin， et al. Path tracking and handling stability control strategy with collision avoidance for the autonomous vehicle under extreme conditions［J］. IEEE Transactions on Vehicular Technology， 2020， 69（12）： 14602- 14617.
6	彭博，李军求，孙逢春，等. 多轴分布式电驱动车辆后桥差动转向控制策略研究［J］.汽车工程，2020，42（7）： 909-916.
	PENG Bo， LI Junqiu， SUN Fengchun， et al. Research on differential drive steering control strategy for rear axles of multi-Axle distributed electric drive vehicle［J］. Automotive Engineering，2020，42（7）： 909-916.
7	GALVANI M， BIRAL F， NGUYEN B M， et al. Four wheel optimal autonomous steering for improving safety in emergency collision avoidance manoeuvres［C］. IEEE International Workshop on Advanced Motion Control. IEEE， 2014.
8	HIRAOKA Toshihiro， NISHIHARA Osamu，KUMAMOTO Hiromitsu. Automatic path-tracking controller of a four-wheel steering vehicle［J］. Vehicle System Dynamics， 2009， 47（10）：1205-1227.
9	GUO Ningyuan， BASILIO Lenzo， ZHANG Xudong， et al. A real-time nonlinear model predictive controller for yaw motion optimization of distributed drive electric vehicles［J］. IEEE Transactions on Vehicular Technology， 2020，69（5）： 4935-4946.
10	SUN C Y， DONG H， ZHANG X， et al. Path tracking controller design for autonomous vehicle based on robust tube MPC［J］. International Journal of Vehicle Design， 2020.
11	MATA Sara， ZUBIZARRETA Asier， PINTO Charles. Robust tube-based model predictive control for lateral path tracking［J］. IEEE Transactions on Intelligent Vehicles，2019，4（4）：569-577.
12	GAO Yiqi， GRAY A， TSENG H E， et al. A tube-based robust nonlinear predictive control approach to semiautonomous ground vehicles［J］. Vehicle System Dynamics， 2014， 52（6）：802-823.
13	张军伟，杨波，李洪彪，等. 多工况下互连式油气悬架系统建模及特性研究［J］.汽车工程， 2016， 6（3）： 212-222.
	ZHANG Junwei，YANG Bo，LI Hongbiao， et al. Research on modeling and characteristics of interconnected hydropneumatic suspension in multiple modes［J］. Automotive Engineering，2016，6（3）：212-222.
14	杨国栋. 10×10 分布式电驱动车辆转矩分配策略研究［D］. 北京：北京理工大学，2019.
	YANG Guodong. Research on torque distribution strategy of 10×10 distributed electric drive vehicle［D］. Beijing：Beijing Institute of Technology，2019.
15	孙传扬. 智能汽车紧急避障轨迹规划与路径跟踪控制策略研究［D］. 北京：北京交通大学，2021.
	SUN Chuanyang. Research on trajectory planning and path tracking control strategy for intelligent vehicle emergency collision avoidance［D］. Beijing： Beijing Jiaotong University，2021.
16	RAKOVI´C S V， KERRIGAN E C， KOURAMAS K I， et al. Invariant approximations of the minimal robust positively invariantset［J］. IEEE Trans. Autom. Control：，2005，50（3）： 406-410.
17	DARUP M S， TEICHRIB D. Efficient computation of RPI sets for tube-based robust MPC［C］. 2019 18th European Control Conference （ECC）， 2019.

[1]	边有钢,张田田,谢和平,秦洪懋,杨泽宇. 车辆队列抗扰抗内切协同路径跟踪控制[J]. 汽车工程, 2023, 45(8): 1320-1332.
[2]	张新荣,谭宇航,贾一帆,黄晋,许权宁. 四轮独立驱动电动汽车路径跟踪鲁棒控制[J]. 汽车工程, 2023, 45(2): 253-262.
[3]	吕颖,祁旭,刘秋铮,王鑫煜,陈国迎. 考虑转向延迟特性的自动驾驶车辆路径跟踪控制方法[J]. 汽车工程, 2023, 45(12): 2234-2241.
[4]	胡杰,陈锐鹏,张志豪,向博文,刘昊岩,朱琪,郭启翔. 基于RMPC的自动驾驶货车路径跟踪控制[J]. 汽车工程, 2023, 45(11): 2092-2103.
[5]	赵越,胡纪滨,吴维,魏超. 无人车全轮蟹行转向稳定性鲁棒控制与试验验证[J]. 汽车工程, 2022, 44(8): 1126-1135.
[6]	李骏,万文星,郝三强,秦武,刘霏霏. 复杂路况下无人驾驶路径跟踪模型预测控制研究[J]. 汽车工程, 2022, 44(5): 664-674.
[7]	关龙新,顾祖飞,张超,王爱春,彭晨若,江会华,吴晓建. 考虑系统复杂扰动的智能车模型预测路径跟踪控制[J]. 汽车工程, 2022, 44(12): 1844-1855.
[8]	胡杰,钟鑫凯,陈瑞楠,朱令磊,徐文才,张敏超. 基于模糊LQR的智能汽车路径跟踪控制[J]. 汽车工程, 2022, 44(1): 17-25.
[9]	李斯旭,徐彪,胡满江,边有钢,陈晓龙,孙宁. 基于动力学模型预测控制的铰接车辆多点预瞄路径跟踪方法[J]. 汽车工程, 2021, 43(8): 1187-1194.
[10]	高强,陆洲,段晨东,徐婷. 汽车垂直泊车路径规划与路径跟踪研究[J]. 汽车工程, 2021, 43(7): 987-994.
[11]	金立生,谢宪毅,司法,郭柏苍,石健. 考虑驾驶人特性的智能驾驶路径跟踪算法[J]. 汽车工程, 2021, 43(4): 553-561.
[12]	任玥,冀杰,赵颖,梁艺潇,郑玲. 基于最小模型误差估计的智能汽车路径跟踪控制[J]. 汽车工程, 2021, 43(4): 580-587.
[13]	梁军,朱方博,蔡英凤,陈小波,陈龙. 面向复杂曲率变化的智能车路径跟踪控制[J]. 汽车工程, 2021, 43(12): 1771-1779.
[14]	裴晓飞, 李朋, 陈祯福, 过学迅. 不同紧急工况下的汽车主动避撞控制的研究^*[J]. 汽车工程, 2020, 42(12): 1647-1654.
[15]	苏树华, 陈刚. 机器人驾驶车辆的横向自适应反演切换控制^*[J]. 汽车工程, 2020, 42(1): 11-19.