汽车工程 ›› 2025, Vol. 47 ›› Issue (7): 1357-1368.doi: 10.19562/j.chinasae.qcgc.2025.07.013

• • 上一篇    

基于时空走廊的非结构化环境智能车辆轨迹规划

杨秀建,冯旭磊,张生斌(),白永瑞   

  1. 昆明理工大学交通工程学院,昆明 650500
  • 收稿日期:2024-12-03 修回日期:2025-01-04 出版日期:2025-07-25 发布日期:2025-07-18
  • 通讯作者: 张生斌 E-mail:zhangshengbin@kust.edu.cn
  • 基金资助:
    国家自然科学基金(52162046)资助。

Trajectory Planning for Intelligent Vehicles in Unstructured Environment Based on Spatio-Temporal Corridors

Xiujian Yang,Xulei Feng,Shengbin Zhang(),Yongrui Bai   

  1. Faculty of Transportation Engineering,Kunming University of Science and Technology,Kunming 650500
  • Received:2024-12-03 Revised:2025-01-04 Online:2025-07-25 Published:2025-07-18
  • Contact: Shengbin Zhang E-mail:zhangshengbin@kust.edu.cn

摘要:

针对非结构化环境中现有时空联合轨迹规划方法未能充分考虑轨迹安全性问题,本文提出了一种基于时空走廊的时空联合轨迹规划方法,可在时空约束空间内直接求解可行驶的最优轨迹。首先,基于车辆运动学模型构建运动基元树,并通过对运动基元树搜索获取符合车辆运动学约束的初始轨迹。其次,以初始轨迹为基础构建三维时空走廊,为轨迹优化问题提供时空域上的安全求解空间。最后,在时空走廊内综合考虑动力学、安全性、连续性等约束条件,利用分段贝塞尔曲线方法对轨迹进行优化求解。仿真与实际环境测试结果表明,与TEB算法相比,本文所提出的轨迹规划方法在安全性与灵活性方面均表现出显著优势,同时具有良好的计算实时性。

关键词: 智能车辆, 非结构环境, 轨迹规划, 时空走廊

Abstract:

For insufficient consideration of trajectory safety in existing spatio-temporal joint trajectory planning methods for unstructured environment, a spatio-temporal joint trajectory planning method based on spatio-temporal corridors is proposed in this paper to enable the direct generation of feasible and optimal trajectories within spatio-temporal constraint spaces. Firstly, a motion primitive tree is constructed based on the vehicle kinematic model, and an initial trajectory satisfying the vehicle’s kinematic constraints is obtained through a search of the motion primitive tree. Subsequently, a 3-D spatio-temporal corridor is generated based on the initial trajectory, providing a safe solution space in the spatio-temporal domain for trajectory optimization. Finally, within the spatio-temporal corridor, constraints such as dynamics, safety, and continuity are comprehensively considered, and the trajectory is optimized using a segmented Bézier curve method. The simulation and real-world test results show that the proposed trajectory planning method demonstrates significant advantages over the TEB algorithm in terms of safety and flexibility, while maintaining superior computational real-time performance.

Key words: intelligent vehicle, unstructured environment, trajectory planning, spatio-temporal corridor