Tracking and Collision Avoidance of Autonomous Vehicle Based on Adaptive Preview Path

doi:10.3901/JME.2022.06.184

Abstract

Abstract: Path Tracking plays important role in the lateral control of autonomous vehicles. The stability and tracking accuracy are usually related to vehicle speed, road curvature, etc., which directly affect the safety in complex driving conditions. To improve the stability and tracking accuracy under complex conditions, path planning, tracking control and stability control are combined together to design a tracking control method based on adaptive preview paths. First, based on the vehicle's two-degree-of-freedom model, a preview distance adaptive algorithm is designed, which adjusts the preview distance according to the vehicle dynamics state and road adhesion. Secondly, the preview path at the desired preview distance is given by a cubic polynomial fitting method. Finally, based on performance of obstacle avoidance, tracking accuracy, and vehicle stability, a particle swarm optimization algorithm(PSO) is designed to optimize the algorithm parameters. The performances in path tracking, lane changing and obstacle avoidance conditions are verified in the hardware-in-the-loop tests and vehicle tests. The results show that the algorithm can adaptively adjust the preview path during tracking with low computation burden, and achieve the balance of tracking accuracy and vehicle stability.

Key words: path planning, particle swarm optimization, adaptive control, polynomial fitting, vehicle dynamics

CLC Number:

U495

WEI Lingtao, WANG Xiangyu, QIU Bin, LI Liang, ZHOU Daolin, LIN Jingui. Tracking and Collision Avoidance of Autonomous Vehicle Based on Adaptive Preview Path[J]. Journal of Mechanical Engineering, 2022, 58(6): 184-193.

Add to citation manager EndNote|Reference Manager|ProCite|BibTeX|RefWorks

URL: http://www.cjmenet.com.cn/EN/10.3901/JME.2022.06.184

http://www.cjmenet.com.cn/EN/Y2022/V58/I6/184

References

[1] HU C，WANG R，YAN F，et al.Output constraint control on path following of four-wheel independently actuated autonomous ground vehicles[J]. IEEE Transactions on Vehicular Technology，2015，65(6)：4033-4043.
[2] RAFFO G V，GOMES G K，NORMEY-RICO J E，et al. A predictive controller for autonomous vehicle path tracking[J]. IEEE Transactions on Intelligent Transportation Systems，2009，10(1)：92-102.
[3] 徐俊艳，张培仁，程剑锋. 基于Backstepping时变反馈和PID控制的移动机器人实时轨迹跟踪控制[J]. 电机与控制学报，2004，8(1)：35-38. XU Junyan，ZHANG Peiren，CHENG Jianfeng. Real-time
trajectory tracking control of mobile robot based on Backstepping time-varying state feedback and PID control method[J]. Electric Machines and Control，2004，8(1)：35-38.
[4] YU R，GUO H，SUN Z，et al. MPC-based regional path tracking controller design for autonomous ground vehicles[C]// 2015 IEEE International Conference on Systems，Man，and Cybernetics，2015：2510-2515.
[5] JI J，KHAJEPOUR A，MELEK W W，et al. Path planning and tracking for vehicle collision avoidance based on model predictive control with multiconstraints[J]. IEEE Transactions on Vehicular Technology，2016，66(2)：952-964.
[6] 武星，楼佩煌，唐敦兵. 自动导引车路径跟踪和伺服控制的混合运动控制[J]. 机械工程学报，2011，47(3)：43-48. WU Xing，LOU Peihuang，TANG Dunbing. Integrated motion control of path tracking and servo control for an automated guided vehicle[J]. Journal of Mechanical Engineering，2011，47 (3)：43-48.
[7] THOMMYPPILLAI M，EVANGELOU S，SHARP R S. Car driving at the limit by adaptive linear optimal preview control[J]. Vehicle System Dynamics，2009，47 (12)：1535-1550.
[8] XU S，PENG H. Design，analysis，and experiments of preview path tracking control for autonomous vehicles[J]. IEEE Transactions on Intelligent Transportation Systems，2019，21(1)：48-58.
[9] LAURENSE V A，GERDES J C. Speed control for robust path-tracking for automated vehicles at the tire-road friction limit[C/CD]//14th International Symposium on Advanced Vehicle Control (AVEC). Beijing，China，2018.
[10] JI X，HE X，LV C，et al. Adaptive-neural-network-based robust lateral motion control for autonomous vehicle at driving limits[J]. Control Engineering Practice，2018，76：41-53.
[11] 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，2020，69(6)：6053-6066.
[12] GUO J，LUO Y，LI K，et al. Coordinated path-following and direct yaw-moment control of autonomous electric vehicles with sideslip angle estimation[J]. Mechanical Systems and Signal Processing，2018，105：183-199.
[13] 赵治国，周良杰，朱强. 无人驾驶车辆路径跟踪控制预瞄距离自适应优化[J]. 机械工程学报，2018，54(24)：166-173. ZHAO Zhiguo，ZHOU Liangjie，ZHU Qiang. Preview distance adaptive optimization for the path tracking control of unmanned vehicle[J]. Journal of Mechanical Engineering，2018，54(24)：166-173.
[14] LI S，CHEN H，LI R，et al. Predictive lateral control to stabilise highly automated vehicles at tire-road friction limits[J]. Vehicle System Dynamics，2020，58 (5)：768-786.

[1]	XU Yinggang, ZHU Zheng, YE Xiaoming, WANG Xiangyu, LI Liang, LAI Feng, WEI Heng. Estimation of the Clamping Force of the Electromechanical Brake Caliper During ABS Intervention [J]. Journal of Mechanical Engineering, 2026, 62(8): 169-179.
[2]	MA Jianwei, LI Guanlin, XIE Yinghao, SHEN Yuantong, JIA Zhenyuan. Contour Deviation Consistency Controlling Method for Turning Toolpaths of Complex Surfaces [J]. Journal of Mechanical Engineering, 2026, 62(7): 452-461.
[3]	Lü Litong, XIA Yangxiu, QI Manzhi, CHEN Zheng, ZHANG Lianpeng, WANG Ruichen. Adaptive Robust Motion Control of Hydraulic Actuation Systems Considering Nonlinearity of Bulk Modulus [J]. Journal of Mechanical Engineering, 2026, 62(6): 419-430.
[4]	GU Lianrui, GUO Guoqiang, JIANG Renzheng, WU Tiange, KE Shuai, KONG Zhixue, ZHAO Huan. Current Situation and Development of Path Planning and Force Position Control Technology for Robot Grinding with Thin-walled and Complex Structures [J]. Journal of Mechanical Engineering, 2026, 62(5): 117-132.
[5]	ZHANG Zhiyong, JIANG Zhihao, HU Lin, HUANG Caixia. Improved Artificial Potential Field Modeling and Dynamic Obstacle Avoidance Path Planning for Continuous Curves [J]. Journal of Mechanical Engineering, 2026, 62(2): 271-282.
[6]	YANG Xiujian, YUAN Zhihao. Path Planning for Unmanned Vehicle in Uneven Terrain Environment Based on the Interleaved Granularity Map Method [J]. Journal of Mechanical Engineering, 2026, 62(2): 313-328.
[7]	CHEN Wenting, WANG Wenlong, ZHANG Zhen, AI Chao, ZHANG Jiarui, DU Zeli. Study on Variable Speed Constant Frequency Control of Pump-motor Systems Considering Slow Time-varying Parameters [J]. Journal of Mechanical Engineering, 2026, 62(2): 455-470.
[8]	CAO Jianguo, WANG Leilei, ZHANG Zhaoxiang, CAO Yuan, WANG Ben, GAO Bo. VCR Roll Contour Design and Shape Control Capability Based on Particle Swarm Optimization [J]. Journal of Mechanical Engineering, 2025, 61(8): 75-84.
[9]	CHEN Yuhong, LI Jiaxin, ZHANG Genge, WEN Zefeng, TAO Gongquan. Metro Wheel Profile Design with Low Flange Wear Based on Multi-objective Optimization [J]. Journal of Mechanical Engineering, 2025, 61(8): 261-271.
[10]	WU Xing, LI Yangzhi, ZANG Tiegang, MENG Zhaoxu, CHEN Junzhe, WANG Chentao. Combined Path Planning Based on Voronoi Skeleton for Mobile Robots [J]. Journal of Mechanical Engineering, 2025, 61(5): 165-177.
[11]	ZHAO Meng, ZHOU Ming, HU Tianshang, YANG Jianwei, WANG Yianxue, WANG Liang, XU Pei, XIN Fangqing. High Efficient Electrical Discharge Machining Nickel-based Closed Integral Impeller with Gropes of Electrodes [J]. Journal of Mechanical Engineering, 2025, 61(5): 364-374.
[12]	FENG Junxue, JIA Cunde, KONG Xiangdong, LI Bowen, ZHAO Zhewei, DING Beichen, JIANG Wenguang, AI Chao. Research on Pressure Compensation Control Based on Model Reference Adaptive Control [J]. Journal of Mechanical Engineering, 2025, 61(24): 295-310.
[13]	CHEN Zhixu, CHEN Yuanhang, LI Chenxing, YANG Chunli. Research on Posture-controlled Method of Gas Tungsten Arc and Wire-based Deposition for Repairing Complex Blades [J]. Journal of Mechanical Engineering, 2025, 61(22): 47-56.
[14]	YAO Jing, LI Mandi, ZHANG Xikun, GUO Qi, LI Xiang, ZHANG Hao. Design Optimization Method for Low-pressure-loss and Short-path Additive Manufactured Flow Channel [J]. Journal of Mechanical Engineering, 2025, 61(22): 271-281.
[15]	LI Tongjia, ZANG Pengxiang, GUO Weizhong. Location, Planning and Control Algorithm of a Novel Magnetic Adhesion Wheel Robot [J]. Journal of Mechanical Engineering, 2025, 61(21): 60-74.