From G2 to G3 Continuity: Continuous Curvature Rate Steering Functions for Sampling-Based Nonholonomic Motion Planning

Holger Banzhaf, Nijanthan Berinpanathan, Dennis Nienhüser, J. Marius Zöllner

Abstract

Motion planning for car-like robots is one of the major challenges in automated driving. It requires to solve a two-point boundary value problem (BVP) in real time while taking into account the nonholonomic constraints of the vehicle and the obstacles in the non-convex environment. This paper introduces Hybrid Curvature Rate (HCR) and Continuous Curvature Rate (CCR) Steer: Two novel steering functions for car-like robots that compute a curvature rate continuous solution of the two-point BVP. Hard constraints on the maximum curvature, maximum curvature rate, and maximum curvature acceleration are satisfied resulting in directly driveable G <sup xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink">3</sup> continuous paths. The presented steering functions are benchmarked in terms of computation time and path length against its G <sup xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink">1</sup> and G <sup xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink">2</sup> continuous counterparts, namely Dubins, Reeds-Shepp, Hybrid Curvature, and Continuous Curvature Steer. It is shown that curvature rate continuity can be achieved with only small computational overhead. The generic motion planner Bidirectional RRT* is finally used to present the effectiveness of HCR and CCR Steer in three challenging automated driving scenarios.
BibTeX
@inproceedings{banzhaf2018from,
  author = {Holger Banzhaf and Nijanthan Berinpanathan and Dennis Nienhüser and J. Marius Zöllner},
  title = {{From G<sup>2</sup> to G<sup>3</sup> Continuity: Continuous Curvature Rate Steering Functions for Sampling-Based Nonholonomic Motion Planning}},
  booktitle = {Intelligent Vehicles Symposium},
  year = {2018},
  doi = {10.1109/ivs.2018.8500653},
}

Loading related content...

Figure