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.

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]	DENG Jianxin, YUAN Bangyi, HUANG Qiulin, DING Dukun, XIN Manyu, LIU Guangming. Review on the Key Technologies of Complex Surfaces Polishing Based on Robots [J]. Journal of Mechanical Engineering, 2024, 60(7): 1-21.
[2]	ZHANG Weimin, XU Sensheng, ZHANG Yue. Research on Path Planning of Indoor Inspection Robot Based on Improved A^* Algorithm [J]. Journal of Mechanical Engineering, 2024, 60(20): 315-326.
[3]	SUN Mengnan, DONG Zhixu, XU Wei, SUN Xingwei, LIU Weijun. Research on Improved Low-rank and Sparse Decomposition-Based Method for Spot Images Denoising [J]. Journal of Mechanical Engineering, 2024, 60(2): 17-26.
[4]	WANG Xiaofei, XU Jiazhong, DING Liang, HUANG Cheng, YANG Huaiguang, LIU Meijun. Tendentious Chained Path Planning Algorithm [J]. Journal of Mechanical Engineering, 2024, 60(19): 53-61.
[5]	NIU Shanshuai, WANG Junzheng, ZHAO Jiangbo, SHEN Wei. Adaptive Robust Control with Unknown Dead-zone Compensation for Pump Controlled Electro-hydraulic Servo System [J]. Journal of Mechanical Engineering, 2024, 60(18): 327-337.
[6]	ZHANG Wei, LIU Hui, LIU Jingang, YAN Pengfei, FU Bing. Adaptive Phase Compensation Method for Main Harmonic Disturbance in Electromechanical Transmission [J]. Journal of Mechanical Engineering, 2024, 60(13): 354-365.
[7]	XU Wenlin, PENG Yu, HE Zhicheng, JIANG Chao. Kinematic Topological Configuration Design of Mechanism Partitions for Complex Path Planning [J]. Journal of Mechanical Engineering, 2024, 60(11): 62-73.
[8]	HU Lin, YANG Dongzhao, ZHANG Xin, ZHANG Jie, LIAO Jiacai. Dynamic Path Planning of Intelligent Vehicle Overtaking Lane Change Based on DQP-LMPC [J]. Journal of Mechanical Engineering, 2024, 60(10): 171-181.
[9]	NIE Shida, LIU Hui, LIAO Zhihao, XIE Yujia, XIANG Changle, HAN Lijin, LIN Sihao. Study on Path Planning for Off-road Autonomous Vehicles in Complex Terrains [J]. Journal of Mechanical Engineering, 2024, 60(10): 261-272.
[10]	LIN Chen, WEI Hongqian, JING Wei, ZHANG Youtong. Automotive Functional Safety: Risk Mitigation Control of Path Planning for Autonomous Vehicles towards Sensitive Command Attack Scenarios [J]. Journal of Mechanical Engineering, 2024, 60(10): 302-316.
[11]	PU Xuejie, ZHANG Jianhui, LI Jianyong, ZHANG Jiannan. Path Planning Method for Solving Implicit Contradiction for Complex Technical System [J]. Journal of Mechanical Engineering, 2024, 60(1): 309-328.
[12]	WEN Xuanhao, CAO Huajun, LI Hongcheng, GE Weiwei, HUANG Zixuan. Production Disturbances Recognition Model and Adaptive Energy-saving Control Method of Discrete Manufacturing Unit [J]. Journal of Mechanical Engineering, 2023, 59(7): 252-264.
[13]	LIU Dawei, LI Bingbing, FU Zhanglei, JIN Xin. Configuration Principle and Dynamic Antiskid Mechanism of Non-circular Face Gear Differential [J]. Journal of Mechanical Engineering, 2023, 59(5): 67-76.
[14]	XIANG Hongbiao, YANG Dahu, YANG Lu, WANG Shoujun, ZHANG Mian, HUANG Xian, HUO Wenxing. Path Planning and Recognition Tracking of a Magnetoelastic Miniature Swimmer in Complex Environment [J]. Journal of Mechanical Engineering, 2023, 59(5): 89-99.
[15]	WU Hongyu, NIU Wendong, ZHANG Yuling, WANG Shuxin, YAN Shaoze. Path Planning Method for Multi-point Exploration of Underwater Glider to Minimize Energy Consumption [J]. Journal of Mechanical Engineering, 2023, 59(5): 156-166.