基于模糊LQR的智能汽车路径跟踪控制

doi:10.19562/j.chinasae.qcgc.2022.01.003

摘要/Abstract

摘要：

为保证智能汽车在不同车速下路径跟踪的精确性与稳定性，本文中设计了一种带有预瞄PID转角补偿的模糊线性二次型调节器（LQR）以进行路径跟踪控制。首先，基于路径跟踪误差模型设计了LQR控制器，并采用预瞄PID方法进行转角补偿，消除稳态误差，提高跟踪精度。接着，针对固定权重系数的控制器对于不同车速适应性较差的问题，提出了一种基于车速的权重系数模糊调节策略。最后，通过实车试验，验证了控制器在实车环境中的控制性能。结果表明，设计的控制器具有较高的跟踪精度，且在不同车速下均能保持良好的精确性与稳定性。

关键词: 智能汽车, 路径跟踪, 预瞄PID, 模糊LQR

Abstract:

In order to ensure the accuracy and stability of the path tracking of intelligent vehicles under different speeds, a fuzzy linear quadratic regulator (LQR) with rotation angle compensation using preview PID for path tracking control is designed in this paper. Firstly, the LQR controller is designed based on the path tracking error model, and the preview PID algorithm is used to compensate the rotation angle，eliminate the steady-state error and enhance the tracking accuracy. Then, aiming at the problem of poor adaptability to different speeds of the controller with fixed weighting factors, a speed-based fuzzy adjustment strategy of weighting factors is proposed. Finally, a real vehicle test is conducted to verify the control performance of the controller in real world environment. The results show that the controller designed has high tracking accuracy, and can maintain good accuracy and stability under different vehicle speeds.

Key words: intelligent vehicles, path tracking, preview PID, fuzzy LQR

胡杰,钟鑫凯,陈瑞楠,朱令磊,徐文才,张敏超. 基于模糊LQR的智能汽车路径跟踪控制[J]. 汽车工程, 2022, 44(1): 17-25.

Jie Hu,Xinkai Zhong,Ruinan Chen,Linglei Zhu,Wencai Xu,Minchao Zhang. Path Tracking Control of Intelligent Vehicles Based on Fuzzy LQR[J]. Automotive Engineering, 2022, 44(1): 17-25.

图/表 16

图1

图2

图3

表1

变量论域"

变量	论域
$v x$	（0，6）
$Δ q 1$	（-3.6，3.6）
$Δ r$	（-5.6，5.6）

表1

图4

表2

模糊规则"

变量	模糊子集
$v x$	NB	NS	O	PS	PB
$Δ q 1$	PB	PS	O	NS	NB
$Δ r$	NB	NS	O	PS	PB

表2

图5

表3

整车结构参数"

参数	数值
整车质量 $m / k g$	2 176
前轴到质心距离 $l f / m$	1.37
后轴到质心距离 $l r / m$	1.37
绕z轴转动惯量 $I z / (k g ? m 2)$	2 800
前轴侧偏刚度 $c f / (N ? r a d - 1)$	150 000
后轴侧偏刚度 $c r / (N ? r a d - 1)$	150 000
转向传动比i	20.5

表3

图6

图7

图8

图9

图10

图11

图12

图13

参考文献 15

1	陈特，陈龙，徐兴，等. 分布式驱动无人车路径跟踪与稳定性协调控制［J］. 汽车工程，2019， 41（10）：1109-1116.
	CHEN T， CHEN L， XU X， et al. Integrated control of unmanned distributed driven vehicles path tracking and stability［J］. Automotive Engineering， 2019， 41（10）：1109-1116.
2	白国星，孟宇，刘立，等. 无人驾驶车辆路径跟踪控制研究现状［J］. 工程科学学报，2021， 43（4）：475-485.
	BAI G X， MENG Y， LIU L， et al. Current status of path tracking control of unmanned driving vehicles［J］. Chinese Journal of Engineering， 2021， 43（4）：475-485.
3	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.
4	唐传茵，赵懿峰，赵亚峰，等. 智能汽车轨迹跟踪控制方法研究［J］. 东北大学学报（自然科学版），2020，41（9）：1297-1303.
	TANG C Y， ZHAO Y F， ZHAO Y F， et al. Research on the trajectory tracking control method of intelligent vehicles［J］. Journal of Northeastern University （Natural Science）， 2020，41（9）：1297-1303.
5	LI Yibo， YU Jianlin， GUO Xiaonan， et al. Path tracking method of unmanned agricultural vehicle based on compound fuzzy control［C］. 2020 IEEE 9th Joint International Information Technology and Artificial Intelligence Conference ， 2020：1301-1305.
6	段建民，杨晨，石慧. 基于Pure Pursuit算法的智能车路径跟踪［J］. 北京工业大学学报，2016， 42（9）：1301-1306.
	DUAN J M， YANG C， SHI H. Path tracking based on pure pursuit algorithm for intelligent vehicles［J］. Journal of Beijing University of Technology， 2016， 42（9）：1301-1306.
7	HOFFMANN G M， TOMLIN C J. Autonomous automobile trajectory tracking for off-road driving： controller design， experimental validation and racing［C］. Proceedings of the 2007 American Control Conference， 2007：2296-2301.
8	梁忠超，张欢，赵晶，等. 基于自适应MPC的无人驾驶车辆轨迹跟踪控制［J］. 东北大学学报（自然科学版），2020， 41（6）：835-840.
	LIANG Z C， ZHANG H， ZHAO J， et al. Trajectory tracking control of unmanned vehicles based on adaptive MPC［J］. Journal of Northeastern University （Natural Science）， 2020， 41（6）：835-840.
9	周维，过学迅，裴晓飞，等. 基于RRT与MPC的智能车辆路径规划与跟踪控制研究［J］. 汽车工程，2020， 42（9）：1151-1158.
	ZHOU W， GUO X X， PEI X F， et al. Study on path planning and tracking control for intelligent vehicle based on RRT and MPC［J］. Automotive Engineering， 2020， 42（9）：1151-1158.
10	XU Hang， ZHU Jin. Interval trajectory tracking for AGV based on MPC［C］. Proceedings of the 38th Chinese Control Conference， 2019：2835-2839.
11	林棻，倪兰青，赵又群，等. 考虑横向稳定性的智能汽车路径跟踪控制［J］. 华南理工大学学报（自然科学版），2018， 46（1）：78-84.
	LIN F， NI L Q， ZHAO Y Q， et al. Path following control of intelligent vehicles considering lateral stability［J］. Journal of South China University of Technology （ Natural Science Edition）， 2018， 46（1）：78-84.
12	CHEN Xinbo，PENG Yibing，HANG Peng，et al. Path tracking control of four-wheel independent steering electric vehicles based on optimal control［C］. Proceedings of the 39^th Chinese Control Conference，2020.
13	陈亮，秦兆博，孔伟伟，等. 基于最优前轮侧偏力的智能汽车LQR横向控制［J］. 清华大学学报（自然科学版），https：//kns.cnki.net/kcms/detail/11.2223.N.20200820.1136.001.html.
	CHEN L， QING Z B， KONG W W， et al. Lateral control using LQR for intelligent vehicles based on the optimal front-tire lateral force［J］. J Tsinghua Univ （Sci & Technol）， https：//kns.cnki.net/kcms/detail/11.2223.N.20200820.1136.001.html.
14	高琳琳，唐风敏，郭蓬，等. 自动驾驶横向运动控制的改进LQR方法研究［J］. 机械科学与技术，https：//doi.org/10.13433/j.cnki.1003-8728.20200066.
	GAO L L， TANG F M， GUO P， et al. Research on the improved LQR control for self-driving vehicle lateral motion［J］. Mechanical Science and Technology for Aerospace Engineering， https：//doi.org/10.13433/j.cnki.10 03- 8728.20200066.
15	熊璐，杨兴，卓桂荣，等. 无人驾驶车辆的运动控制发展现状综述［J］. 机械工程学报，2020， 56（10）：127-143.
	XIONG L， YANG X， ZHUO G R， et al. Review on motion control of autonomous vehicles［J］. Journal of Mechanical Engineering， 2020， 56（10）：127-143.

[1]	郝建平,苏炎召,钟志华,黄晋. 面向智能汽车的SOA架构及服务调度机制研究[J]. 汽车工程, 2023, 45(9): 1563-1572.
[2]	赵高士,陈龙,蔡英凤,廉玉波,王海,刘擎超,滕成龙. 融合复杂网络和记忆增强网络的轨迹预测技术[J]. 汽车工程, 2023, 45(9): 1608-1616.
[3]	边有钢,张田田,谢和平,秦洪懋,杨泽宇. 车辆队列抗扰抗内切协同路径跟踪控制[J]. 汽车工程, 2023, 45(8): 1320-1332.
[4]	胡启慧,蔡英凤,王海,陈龙,董钊志,刘擎超. 基于层次图注意的异构多目标轨迹预测方法[J]. 汽车工程, 2023, 45(8): 1448-1456.
[5]	高翔,陈龙,王歆叶,熊晓夏,李祎承,陈月霞. 基于轨迹预测的智能汽车行驶风险评估方法[J]. 汽车工程, 2023, 45(4): 588-597.
[6]	胡杰,朱琪,陈锐鹏,张敏超,张志豪,刘昊岩. 引入必经点约束的智能汽车全局路径规划[J]. 汽车工程, 2023, 45(3): 350-360.
[7]	张紫微,郑玲,李以农,乔旭强,郑浩,王戡. 考虑前车运动不确定性的多目标自适应巡航控制[J]. 汽车工程, 2023, 45(3): 361-371.
[8]	张新荣,谭宇航,贾一帆,黄晋,许权宁. 四轮独立驱动电动汽车路径跟踪鲁棒控制[J]. 汽车工程, 2023, 45(2): 253-262.
[9]	吕颖,祁旭,刘秋铮,王鑫煜,陈国迎. 考虑转向延迟特性的自动驾驶车辆路径跟踪控制方法[J]. 汽车工程, 2023, 45(12): 2234-2241.
[10]	刘正发,吴亚,刘佩根,顾荣琦,陈广. 基于特征和标签联合分布匹配的智能驾驶跨域自适应目标检测[J]. 汽车工程, 2023, 45(11): 2082-2091.
[11]	胡杰,陈锐鹏,张志豪,向博文,刘昊岩,朱琪,郭启翔. 基于RMPC的自动驾驶货车路径跟踪控制[J]. 汽车工程, 2023, 45(11): 2092-2103.
[12]	赵树廉,来飞,李克强,陈涛,孟璋劼,唐逸超,吴思宇,田浩东. 基于数字孪生技术的智能汽车测试方法研究[J]. 汽车工程, 2023, 45(1): 42-51.
[13]	邵文博,李骏,张玉新,王红. 智能汽车预期功能安全保障关键技术[J]. 汽车工程, 2022, 44(9): 1289-1304.
[14]	汪梓豪,蔡英凤,王海,陈龙,熊晓夏. 基于单目视觉运动估计的周边多目标轨迹预测方法[J]. 汽车工程, 2022, 44(9): 1318-1326.
[15]	梁旺,秦兆博,陈亮,边有钢,胡满江. 基于改进BP神经网络的智能车纵向控制方法[J]. 汽车工程, 2022, 44(8): 1162-1172.