基于改进纯跟踪的智能车路径跟随方法

doi:10.19562/j.chinasae.qcgc.2023.01.001

摘要/Abstract

摘要：

为提高智能车的路径跟随精度和行驶平稳性，提出一种基于改进纯跟踪的路径跟随方法。首先建立纯跟踪路径跟随模型，分析纯跟踪模型在初始偏差条件下的控制效果；然后将航向偏差作为反馈变量对纯跟踪方法进行补偿，并以横向偏差和航向偏差为输入、以补偿权重为输出，采用类模糊方法实现补偿权重的动态调节；最后通过实车试验选定控制参数，并验证所提方法的控制性能。结果表明，该方法在不同初始偏差和不同目标行驶速度下能够实现偏差的快速消除，并保证行驶平稳性，具有较好的路径跟随效果，运算耗时较少。

关键词: 智能车, 路径跟随, 纯跟踪, 动态补偿, 模糊控制

Abstract:

In order to improve the path following accuracy and driving stability of intelligent vehicles， a path following method based on improved pure tracking is proposed. Firstly， the path following model based on pure tracking is established， and the control effect of the pure tracking model under the condition of initial error is analyzed. Secondly， the heading error is used as the feedback variable to compensate the pure tracking method， and the quasi fuzzy method is used to realize the dynamic adjustment of the compensation weight with the lateral error and the heading error as the input and the compensation weight as the output. Finally， the control parameters are selected through the real vehicle test， and the control performance of the proposed method is verified. The results show that the method can eliminate the errors quickly under different initial errors and different target driving speeds and ensure the driving stability， and the method has better path following effect and spends less compute time.

Key words: intelligent vehicles, path following, pure tracking, dynamic compensation, fuzzy control

潘世举,李永乐,李子先,何滨兵,朱愿,徐友春. 基于改进纯跟踪的智能车路径跟随方法[J]. 汽车工程, 2023, 45(1): 1-8.

Shiju Pan,Yongle Li,Zixian Li,Binbing He,Yuan Zhu,Youchun Xu. Path Following Method of Intelligent Vehicles Based on Improved Pure Tracking[J]. Automotive Engineering, 2023, 45(1): 1-8.

图/表 12

图1

图2

表1

变量论域"

变量	论域
$l e$	$(0, l m a x)$
$θ e$	$(0, θ m a x)$
$k$	$(- m, m)$

表1

图3

表2

车辆参数和部分控制参数"

变量	取值	变量	取值
$l$	1.2 m	$l m a x$	1 m
$δ c$	$(- 0.593 ? 4,0.593 ? 4) ? r a d$	$θ m a x$	$0.349 ? r a d$

表2

图4

图5

图6

图7

图8

图9

图10

参考文献 15

1	陈轶嵩，邢云翔，熊晓琴，等. 基于专利分析的智能网联汽车技术与经济评价体系的研究［J］. 汽车工程， 2021， 43（9）： 1271-1277.
	CHEN Y S， XING Y X，XIONG X Q， et al. Research on technical and economic evaluation system of intelligent connected vehicles based on patent analysis［J］. Automotive Engineering， 2021， 43（9）： 1271-1277.
2	秦晓辉，王哲文，庞涛，等. 基于车辆模型紧耦合的封闭园区车辆定位方法［J］. 汽车工程， 2021， 43（9）： 1328-1335.
	QI X H， WANG Z W， PANG T， et al. Vehicle positioning method based on tight coupling of vehicle model in enclosed environments［J］. Automotive Engineering， 2021， 43（9）： 1328-1335.
3	崔明阳，黄荷叶，许庆，等. 智能网联汽车架构、功能与应用关键技术［J］. 清华大学学报（自然科学版）， 2022， 62（3）： 493-508.
	CUI M Y， HUANG H Y， XU Q， et al. Survey of intelligent and connected vehicle technologies： architectures， functions and applications［J］. Journal of Tsinghua University （Science and Technology）， 2022， 62（3）： 493-508.
4	MONOT N， MOREAU X， BENINE-NETO A， et al. Automated vehicle lateral guidance using multi-PID steering control and look-ahead point reference［J］. International Journal of Vehicle Autonomous Systems， 2021， 16（1）： 38-55.
5	LI Y B， YU J L， GUO X N， 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	GRIGORESCU S， TRASNEA B， COCIAS T， et al. A survey of deep learning techniques for autonomous driving［J］. Journal of Field Robotics， 2020， 37（3）： 362-386.
7	LIU J， YANG Z， HUANG Z， et al. Simulation performance evaluation of pure pursuit， stanley， LQR， MPC controller for autonomous vehicles［C］. 2021 IEEE International Conference on Real-time Computing and Robotics （RCAR）. IEEE， 2021： 1444-1449.
8	CHEN L， QIN Z B， KONG W W， et al. Lateral control using LQR for intelligent vehicles based on the optimal front-tire lateral force［J］. Journal of Tsinghua University （Science and Technology）， 2021， 61（9）： 906-912.
9	潘世举，李华，苏致远，等. 基于跟踪误差模型的智能车辆轨迹跟踪方法［J］. 汽车工程， 2019， 41（9）： 1021-1027.
	PAN S J， LI H， SU Z Y， et al. Trajectory tracking method for intelligent vehicles based on tracking-error model［J］. Automotive Engineering， 2019， 41（9）： 1021-1027.
10	PARK M， LEE S， HAN W. Development of steering control system for autonomous vehicle using geometry‐based path tracking algorithm［J］. Etri Journal， 2015， 37（3）： 617-625.
11	AHN J， SHIN S， KIM M， et al. Accurate path tracking by adjusting look-ahead point in pure pursuit method［J］. International Journal of Automotive Technology， 2021， 22（1）： 119-129.
12	张华强，王国栋，吕云飞，等. 基于改进纯追踪模型的农机路径跟踪算法研究［J］. 农业机械学报， 2020， 51（9）： 18-25.
	ZHANG H Q， WANG G D， LÜ Y F， et al. Agricultural machinery automatic navigation control system based on improved pure tracking model［J］. Transactions of the Chinese Society for Agricultural Machinery， 2020， 51（9）： 18-25.
13	SHAN Y， ZHENG B， CHEN L， et al. A reinforcement learning-based adaptive path tracking approach for autonomous driving［J］. IEEE Transactions on Vehicular Technology， 2020， 69（10）： 10581-10595.
14	CHEN I M， CHAN C Y. Deep reinforcement learning based path tracking controller for autonomous vehicle［J］. Proceedings of the Institution of Mechanical Engineers， Part D： Journal of Automobile Engineering， 2021， 235（3）： 541-551.
15	李革，王宇，郭刘粉，等. 插秧机导航路径跟踪改进纯追踪算法［J］. 农业机械学报， 2018， 49（5）： 21-26.
	LI G， WANG Y， GUO L F， et al. Improved pure pursuit algorithm for rice transplanter path tracking［J］. Transactions of the Chinese Society for Agricultural Machinery， 2018， 49（5）： 21-26.

[1]	胡林,李根,王方,林淼,巫宁. 基于CIDAS事故数据的路口乘用车-两轮车测试场景研究[J]. 汽车工程, 2023, 45(8): 1417-1427.
[2]	潘世举, 李建市, 李华, 娄静涛, 徐友春. 基于反馈纯跟踪的智能车路径跟随方法[J]. 汽车工程, 2023, 45(7): 1134-1144.
[3]	吴骁, 史文库, 陈志勇. 基于交互式多模型卡尔曼滤波的主动悬架控制[J]. 汽车工程, 2023, 45(7): 1200-1211.
[4]	李子先,潘世举,朱愿,何滨兵,徐友春. 基于状态反馈和预瞄前馈的智能车半主动悬架控制[J]. 汽车工程, 2023, 45(5): 735-745.
[5]	查云飞,石小山,吴昊,李敏旭,陈慧勤. 基于主动倾斜式尾翼的车辆气动特性研究[J]. 汽车工程, 2023, 45(3): 489-500.
[6]	刘晋霞,梁志豪,王强,温明星. TTR汽车等效燃油消耗最小的能量管理策略研究[J]. 汽车工程, 2023, 45(2): 285-292.
[7]	吕彦直,魏超,何元浩. 基于GCN和CIL的端到端自动驾驶换道方法[J]. 汽车工程, 2023, 45(12): 2310-2317.
[8]	任明辉,梁军,陈龙,张春,王云. 基于改进冲突搜索的智能车库多AGV路径规划[J]. 汽车工程, 2023, 45(10): 1933-1943.
[9]	刘永涛,刘传攀,刘湘安,陈轶嵩,乔洁. 基于自适应采样时间MPC的自动紧急制动系统[J]. 汽车工程, 2023, 45(1): 32-41.
[10]	邓泽武,胡钊政,周哲,刘裕林,彭超. 融合激光雷达与双层地图模型的智能车定位[J]. 汽车工程, 2022, 44(7): 1018-1026.
[11]	张书恺,陈慧,刘美岑. 全自动泊车系统路径跟随控制策略[J]. 汽车工程, 2022, 44(7): 1027-1039.
[12]	周哲,胡钊政,王志强,肖汉彪. 基于2阶HMM的智能车视觉地图定位方法[J]. 汽车工程, 2022, 44(2): 190-198.
[13]	关龙新,顾祖飞,张超,王爱春,彭晨若,江会华,吴晓建. 考虑系统复杂扰动的智能车模型预测路径跟踪控制[J]. 汽车工程, 2022, 44(12): 1844-1855.
[14]	黄圣杰,胡满江,周云水,殷周平,秦晓辉,边有钢,贾倩倩. 动态场景下基于语义分割与运动一致性约束的车辆视觉SLAM[J]. 汽车工程, 2022, 44(10): 1503-1510.
[15]	殷学冰,陈勇,代青林,刘海,田乃利,贺伯林. 基于NSGA-Ⅱ算法和模糊控制的纯电动汽车2DCT换挡规律研究[J]. 汽车工程, 2022, 44(10): 1571-1580.