华南理工大学学报(自然科学版) ›› 2020, Vol. 48 ›› Issue (7): 65-75.doi: 10.12141/j.issn.1000-565X.190568

• 交通运输工程 • 上一篇    下一篇

结构化道路下基于层次分析法的智能车避障轨迹规划

曾德全 余卓平 熊璐 付志强 张培志
  

  1. 同济大学 汽车学院//新能源汽车工程中心,上海 201804
  • 收稿日期:2019-09-05 修回日期:2020-03-02 出版日期:2020-07-25 发布日期:2020-07-01
  • 通信作者: 曾德全(1988-),男,博士生,主要从事智能车决策规划研究。 E-mail:zdq1610849@126.com
  • 作者简介:曾德全(1988-),男,博士生,主要从事智能车决策规划研究。
  • 基金资助:
    国家重点研发计划项目 (2018YFB0105103,2018YFB0105101); 上海市工业强基专项 (GYQJ-2017-4-08);同济大学中央高校基本科研业务费专项资金资助项目 (22120190205)

Intelligent Vehicle Obstacle Avoidance Trajectory Planning in Structured Road Based on Analytic Hierarchy Process

ZENG Dequan YU Zhuoping XIONG Lu FU Zhiqiang ZHANG Peizhi   

  1. School of Automotive Studies//Clean Energy Automotive Engineering Centre,Tongji University,Shanghai 201804,China
  • Received:2019-09-05 Revised:2020-03-02 Online:2020-07-25 Published:2020-07-01
  • Contact: 曾德全(1988-),男,博士生,主要从事智能车决策规划研究。 E-mail:zdq1610849@126.com
  • About author:曾德全(1988-),男,博士生,主要从事智能车决策规划研究。
  • Supported by:
    Supported by the National Key Research and Development Program of China ( 2018YFB0105103,2018YFB0105101)

摘要: 为实现结构化道路下智能车最优避障轨迹的规划,设计了基于层次分析法的轨迹择优体系。首先,以三次 B 样条曲线为路径规划器,生成满足曲率连续且曲率最值受控的路径,并以此构造路径簇; 其次,为实现主客观指标的量化表达,以平滑性和经济性为准则,以路径长度、曲率和、曲率变化率和以及偏离目标点的距离为子准则,构造 AHP 路径择优体系,筛选出最优的路径; 然后,采用三次多项式表征速度相对时间的变化,以满足速度、加速度、加速度导数的连续; 最后,参考国家标准设计测试场景,验证方法的稳定性与算法的实时性。经 5000 次循环仿真测试表明: 算法具有较高的实时性,0. 1s 内能规划出可行轨迹的概率在 94%,0. 16s 内则能 100%规划出可行轨迹; 规划的轨迹便于车辆跟踪,方法具有较高的稳定性,实车峰值横向误差小于0. 21m,峰值车速误差小于0. 42m/s,平均车速误差小于0. 11m/s,总体呈收敛的趋势。

关键词: 轨迹规划, 层次分析法, 三次 B 样条曲线, 结构化道路, 智能车, 避障

Abstract: The optimal trajectory selection system based on analytic hierarchy process (AHP) was designed,in order to plan optimal obstacle avoidance trajectory for intelligent vehicle in structured road. Firstly,cubic B-spline curve was employed as the planner to generate path with continuous curvature and controlled maximum curvature,based on which path sets were constructed.Secondly,in order to achieve quantitative expression of subjective and objective indicators,the AHP system for optimal path selection was constructed and the optimal path was selected,by considering smoothness and economic criteria as the criteria,path length,curvature sum,curvature change rate sum and distance from target point as sub-criteria. Then,cubic polynomial was used to represent the change of velocity relative to time,so as to satisfy the continuity of velocity,acceleration and acceleration derivative. Fi-nally,test scenarios were designed according to national standards to verify the stability of the method and the real- time performance of the algorithm. After 5 000 cycles of simulation test,the result shows that the algorithm has a good real-time performance. The probability of feasible trajectory planning within 0. 1 s is 94%,while within 0. 16 s it is 100%. The planned trajectory is convenient for vehicle tracking and the method has a high stability. The peak lateral error of real vehicle test is less than 0. 21 m,the peak speed error is less than 0. 42 m/s,and the av-erage speed error is less than 0. 11 m/s,which show an overall trend of convergence.

Key words: trajectory planning, analytic hierarchy process, cubic B-spline curve, structured road, intelligent vehicle, obstacle avoidance

中图分类号: