Trajectory Planning Based on Spatio-Temporal Map with Collision Avoidance Guaranteed by Safety Strip

Ting Zhang, Mengyin Fu, Wenjie Song*, Yi Yang, Meiling Wang

*Corresponding author for this work

Research output: Contribution to journalArticlepeer-review

15 Citations (Scopus)

Abstract

Trajectory planning for the unmanned vehicle in the complex environment has always been a challenging task. Planned trajectory with the corresponding target velocity or acceleration sequence must be collision-free guaranteed and as comfortable as possible on the premise of obeying the traffic rules and interaction with other dynamic social vehicles. To meet this requirement, this paper proposes a framework for trajectory planning based on spatio-Temporal map. Due to the time layer architecture in the map, the trajectory can be generated with velocity and acceleration simultaneously, and the whole trajectory is constrained within a 'safety strip', resulting in an efficient and safety guaranteed trajectory. The framework is composed of three sections: rough search, fine optimization and safety strip-based collision avoidance. For rough search, we propose an improved A∗ algorithm implemented in the discrete time layer to find out the suboptimal states efficiently. In fine optimization, the B-spline curve is exploited to connect the searched states into a continuous trajectory. And the optimal control points of B-spline are further grouped into several segments, forming the safety strip which is actually the distribution space of the planned trajectory. If necessary, an adjustment will be applied to keep the strip away from the collision zone, making the entire trajectory completely collision-free. Experiments on both public dataset and self-driving simulator show that the proposed framework can adapt to different kinds of complex traffic scenes well.

Original languageEnglish
Pages (from-to)1030-1043
Number of pages14
JournalIEEE Transactions on Intelligent Transportation Systems
Volume23
Issue number2
DOIs
Publication statusPublished - 1 Feb 2022

Keywords

  • Trajectory planning
  • collision avoidance
  • safety strip
  • spatio-Temporal map

Fingerprint

Dive into the research topics of 'Trajectory Planning Based on Spatio-Temporal Map with Collision Avoidance Guaranteed by Safety Strip'. Together they form a unique fingerprint.

Cite this