汽车工程 ›› 2021, Vol. 43 ›› Issue (12): 1752-1761.doi: 10.19562/j.chinasae.qcgc.2021.12.003

• • 上一篇    下一篇

融合前车轨迹预测的改进人工势场轨迹规划研究

吴晓建1,2,燕冬2,王爱春2,黄菊花1,伍磊1,周兵3()   

  1. 1.南昌大学机电工程学院,南昌 330031
    2.江铃汽车股份有限公司,南昌 330001
    3.湖南大学机械与运载工程学院,长沙 410082
  • 收稿日期:2021-07-21 修回日期:2021-09-02 出版日期:2021-12-25 发布日期:2021-12-24
  • 通讯作者: 周兵 E-mail:zhou_bingo@163.com
  • 基金资助:
    国家自然科学基金(52002163)

Research on Improved Artificial Potential Field Path Planning Integrating Prediction of Preceding Vehicle Trajectory

Xiaojian Wu1,2,Dong Yan2,Aichun Wang2,Juhua Huang1,Lei Wu1,Bing Zhou3()   

  1. 1.School of Mechanical & Electrical Engineering,Nanchang University,Nanchang 330031
    2.Jiangling Automobile Co. ,Ltd. ,Nanchang 330001
    3.College of Mechanical and Vehicle Engineering,Hunan University,Changsha 410082
  • Received:2021-07-21 Revised:2021-09-02 Online:2021-12-25 Published:2021-12-24
  • Contact: Bing Zhou E-mail:zhou_bingo@163.com

摘要:

人工势场算法在移动场景中的避撞路径规划很少考虑其与前车未来轨迹的时序耦合影响,基本将每个规划周期内的前车视为静态,通过不同规划周期滚动更新的方式进行准动态路径规划,导致规划路径不够合理、一致性差。本文针对性提出通过时序耦合关联,将前车预测轨迹融入智能汽车路径规划过程。首先构建了改进人工势场算法的引力场及斥力场模型,提出在每个规划周期内,将前车位置在斥力场中根据其预测值进行动态更新;而后提出了基于驾驶意图聚类识别及离散优化结合的前车轨迹长时间预测算法,以及基于运动学模型聚类识别与无迹卡尔曼滤波算法结合的前车轨迹短时间预测算法,再经S函数进行加权融合完成前车轨迹的最终预测。高速驶出及邻车切入等场景下的仿真分析表明,相比于传统的人工势场算法,所提出的改进人工势场动态轨迹规划算法能获得更加合理和一致性更优的规划结果。

关键词: 智能汽车, 人工势场, 动态轨迹规划, 轨迹预测

Abstract:

The collision avoidance path planning of artificial potential field algorithm in moving scene rarely considers the timing coupling effect with the future trajectory of the preceding vehicle, and basically regards the preceding vehicle in every planning cycle as static. A quasi-dynamic path planning is thereby carried out through the rolling update of different planning cycles, resulting in unreasonable and poor consistency of the planned path. In this paper, the prediction trajectory of the preceding vehicle is accordingly integrated into the intelligent vehicle path planning process through time-series coupling correlation. First, the attraction field and repulsion field models of the improved artificial potential field algorithm are constructed, and the position of the preceding vehicle in the repulsion field is proposed to be dynamically updated according to its prediction value in each planning cycle. Then a long-term prediction algorithm for the trajectory of the preceding vehicle by combining cluster recognition of driving intention and discrete optimization, and a short-term prediction algorithm for the trajectory of the preceding vehicle by combining cluster recognition of kinematics model and unscented Kalman filter algorithm are proposed. Subsequently, the weighted fusion is performed through the Sigmoid function to complete the prediction of the trajectory of the preceding vehicle. Finally, simulation results in scenarios such as driving out a high way and cutting in by adjacent vehicle indicate that, compared with the traditional APF algorithm, the proposed improved artificial potential field dynamic path planning algorithm can obtain more reasonable and consistent planning results.

Key words: intelligent vehicle, artificial potential field, dynamic path planning, trajectory prediction