Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios

  • Authors:
  • Julius Ziegler;Christoph Stiller

  • Affiliations:
  • Department of Measurement and Control, University of Karlsruhe, University of Karlsruhe;Department of Measurement and Control, University of Karlsruhe, University of Karlsruhe

  • Venue:
  • IROS'09 Proceedings of the 2009 IEEE/RSJ international conference on Intelligent robots and systems
  • Year:
  • 2009

Quantified Score

Hi-index 0.01

Visualization

Abstract

We present a method for motion planning in the presence of moving obstacles that is aimed at dynamic on-road driving scenarios. Planning is performed within a geometric graph that is established by sampling deterministically from a manifold that is obtained by combining configuration space and time. We show that these graphs are acyclic and shortest path algorithms with linear runtime can be employed. By reparametrising the configuration space to match the course of the road, it can be sampled very economically with few vertices, and this reduces absolute runtime further. The trajectories generated are quintic splines. They are second order continuous, obey nonholonomic constraints and are optimised for minimum square of jerk. Planning time remains below 20 ms on general purpose hardware.