基于可变微分邻域的自动驾驶车辆动态轨迹规划方法OA
Variable differential neighborhood-based dynamic trajectory planning for automated vehicles
针对自动驾驶单邻域搜索凸质量及多凸形转换可控性差的问题,该文提出一种基于可变微分邻域的自动驾驶车辆动态轨迹规划方法.首先建立自动驾驶微分邻域模型,将最大内切椭圆法融入微分邻域搜索模型,得到当前时刻最大微分邻域;然后设计涵盖纵向距离、横向偏差、安全裕度的评价函数,以实现下一时刻微分邻域的动态优选;最后通过障碍函数对可变微分邻域搜索的轨迹平滑性进行优化,并利用平均驻留时间法得到可变微分邻域搜索的切换稳定性指标,保证可变微分邻域搜索的多凸形转换可控性.实验结果表明:与现有常用搜索算法(单邻域搜索算法与迭代式区域膨胀算法)相比,可变微分邻域搜索算法在动态和静态环境下,凸空间启发式搜索性能明显提升,并且可行驶凸空间覆盖率分别提升20%和7%;在前后两次避障时,邻域切换稳定性收敛时间分别控制在0.6s和0.4s以内,同时速度的最大超调量仅为1.00%和2.94%;在动静态障碍环境下,可变微分邻域搜索算法能有效提升轨迹生成质量同时保持强可控性.
[Objective]Aiming at the problems of low convex quality in single-neighborhood search,insufficient adaptability to dynamic obstacles,and poor controllability in multi-convex region switching for autonomous vehicle trajectory planning,this paper proposes a dynamic trajectory planning method based on Variable Differential Neighborhood Search(VDNS).The core objectives are to improve the coverage and quality of drivable convex space,enhance the smoothness of trajectory under neighborhood switching,and ensure the stability and convergence of multi-convex shape transition,so as to provide a safe,efficient and robust trajectory planning solution for autonomous driving in dynamic urban traffic scenarios.[Methods]Firstly,a differential neighborhood model integrating vehicle kinematics and real-time environmental perception is established.By embedding the Maximum Volume Inscribed Ellipse method into the differential neighborhood search framework,the maximum differential neighborhood at the current moment is generated,which provides a strict lower bound of safe convex polyhedron space and balances the quality and efficiency of neighborhood generation.Secondly,a comprehensive evaluation function considering longitudinal driving distance,lateral deviation and safety margin is constructed,and an adaptive weight adjustment mechanism based on scene risk and motion urgency is introduced to realize the dynamic optimization of the next moment differential neighborhood.Then,the logarithmic barrier function is adopted to transform the trajectory smoothness optimization with inequality constraints into an unconstrained quadratic programming problem,and the Newton iteration method is used to solve it,which suppresses trajectory oscillation and meets vehicle dynamics constraints.Finally,the average dwell-time method is applied to establish the switching stability index of variable differential neighborhood search.Each differential neighborhood is regarded as an independent subsystem,and the sufficient conditions for exponential convergence of the switched system are derived to guarantee the controllability of multi-convex shape transition.[Results]The joint simulation based on PreScan,Simulink and CarSim shows that:1)Compared with the single-neighborhood search(NS)algorithm and iterative regional inflation(IRIS)algorithm,the proposed VDNS algorithm improves the coverage of drivable convex space by 20%in dynamic obstacle environment and 7%in static obstacle environment,with significantly enhanced heuristic search performance.2)In two consecutive obstacle avoidance maneuvers,the convergence time of neighborhood switching stability is controlled within 0.6 s and 0.4 s,and the maximum velocity overshoot is only 1.00%and 2.94%,showing strong switching stability.3)The trajectory generated by VDNS is continuous and smooth without oscillation,which overcomes the shortage of poor smoothness in traditional IRIS algorithm.4)With the increase of obstacle number,the single-step time complexity of VDNS is lower than that of IRIS,and the computational efficiency is higher in complex environments.5)The adaptive weight mechanism achieves better balance among safety,efficiency and smoothness,which is superior to the fixed weight strategy in trajectory quality and obstacle avoidance performance.[Conclusions]The VDNS-based dynamic trajectory planning method effectively improves the convex quality of neighborhood search and the controllability of multi-convex region switching.It not only expands the drivable convex space and enhances the dynamic adaptability to obstacles,but also ensures the smoothness of trajectory and the stability of neighborhood switching.This method can be applied to urban dynamic traffic scenarios with static and dynamic obstacles,and provides a new technical approach for real-time,safe and reliable trajectory planning of autonomous vehicles.
钱易得;马育林;李祎承;潘家保;许述财
安徽工程大学机械与汽车工程学院,芜湖 241000||江苏大学汽车工程研究院,镇江 212013安徽工程大学机械与汽车工程学院,芜湖 241000江苏大学汽车工程研究院,镇江 212013安徽工程大学机械与汽车工程学院,芜湖 241000清华大学智能绿色车辆与交通全国重点实验室,北京 100084
交通工程
自动驾驶规划控制可变微分邻域最大内切椭圆法平均驻留时间轨迹平滑性
planning and control for automated vehiclesvariable differential neighborhoodmaximum volume inscribed ellipseaverage dwell timetrajectory smoothness
《清华大学学报(自然科学版)》 2026 (8)
1611-1624,14
安徽省高校杰出青年科研项目(2023AH020015)智能绿色车辆与交通全国重点实验室开放课题(KFY2419)
评论