首页|融合环境势场的动态换道轨迹规划方法研究

融合环境势场的动态换道轨迹规划方法研究

扫码查看
针对智能车辆在换道时存在的曲率变化过大以及容易出现速度突变的问题,提出一种融合环境势场的基于时空间采样的动态规划方法.建立环境势场以合势场值作为道路可通过性的衡量标准.基于Frenet坐标系在横纵向2个维度分别对换道终点进行时空间采样,生成五次多项式轨迹集合.构建综合考虑安全性、偏离目标车道线程度、规划时间和轨迹舒适性的多目标代价函数.通过碰撞检测和代价函数确定主车的最佳轨迹.设计动态规划模块使算法能适应复杂场景的换道需求.仿真结果表明:算法能使车辆更早发现障碍物,换道轨迹曲率基本与道路曲率保持一致,浮动不超过正负0.02 m-1;主车速度并未发生明显突变,提高了换道过程的安全性与舒适性.
Research on dynamic lane change trajectory planning method integrating environmental potential field
In the research on intelligent vehicle autonomous driving technology,the lane change process has always been a critical issue.While traditional lane change models can effectively plan paths in simple scenarios,they often face challenges in complex and dynamic road environments,such as excessive curvature changes in the trajectory and sudden speed variations,which can affect the smoothness and safety of the vehicle.To address these issues,this study analyzes and compares existing traditional vehicle lane change models and proposes a dynamic planning method based on time-space sampling,integrated with an environmental potential field.By introducing the environmental potential field and an improved trajectory planning algorithm,the stability and safety of intelligent vehicles during lane changes are further enhanced.First,an environmental potential field is established based on an improved two-dimensional normal distribution formula,which includes fixed obstacle potential fields,dynamic obstacle potential fields,and road boundary potential fields.The total potential field value at a given point on the road is used as a measure of the passability of that location.Next,using the transformation relationship between the Frenet coordinate system and Cartesian coordinates,an independent integral system is constructed that decouples the vehicle's lateral and longitudinal motion,greatly reducing the computational complexity of trajectory planning while improving calculation efficiency.The lane change endpoints are sampled in both time and space dimensions,and a set of quintic polynomial trajectories is generated by incorporating boundary conditions into quintic polynomial curves.Further,velocity,acceleration,and curvature constraints are applied to filter out trajectories that do not meet kinematic requirements.A multi-objective cost function is constructed,considering trajectory safety,the degree of deviation from the target lane,planning time,and trajectory comfort.The total cost of each candidate trajectory in the lane change trajectory set is calculated,and priority scores are assigned to the candidate trajectories.The motion trajectories of surrounding vehicles are predicted,and a vehicle OBB(Oriented Bounding Box)collision model is constructed.The cost values of the candidate trajectories are compared,and combined with the collision detection model,the quintic polynomial trajectory with the minimum cost and no collision is selected as the optimal trajectory for the current planning.To validate the effectiveness of the proposed method,an S-shaped dual-lane change simulation scenario was constructed,and active lane change simulations were carried out.During the simulation,not only were the effects of different planning densities on vehicle state changes analyzed,but the optimal trajectory was also updated in real-time based on the vehicle's current state.Simulation results show that,due to the incorporation of the environmental potential field,intelligent vehicles can detect obstacles earlier than traditional methods and react promptly based on the obstacle potential field values.Additionally,through the optimization of key parameters such as the cost function and dynamic planning density,the obstacle avoidance performance of intelligent vehicles in complex road environments is further improved.Specifically,during the lane change process,the curvature of the vehicle trajectory remains consistent with the road curvature,with fluctuations not exceeding±0.02 m-1,maintaining high smoothness and continuity overall.Furthermore,the speed of the host vehicle does not experience significant changes during the lane change,ensuring a safer and more comfortable lane change process.

intelligent vehiclefrene coordinatestrajectory planninglane changecost function

谢春丽、刘长明

展开 >

东北林业大学机电工程学院,哈尔滨 150040

智能车辆 Frenet坐标系 轨迹规划 主动换道 代价函数

2024

重庆理工大学学报
重庆理工大学

重庆理工大学学报

CSTPCD北大核心
影响因子:0.567
ISSN:1674-8425
年,卷(期):2024.38(19)