Real-Time Trajectory Planning for Autonomous Driving with Gaussian Process and Incremental Refinement
Authors:
- 23 May 2022
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- p. 8999-9005
Abstract
Real-time kinodynamic trajectory planning in dy-namic environments is critical yet challenging for autonomous driving. In this paper, we propose an efficient trajectory plan-ning system for autonomous driving in complex dynamic sce-narios through iterative and incremental path-speed optimization. Exploiting the decoupled structure of the planning prob-lem, a path planner based on Gaussian process first generates a continuous arc-length parameterized path in the Frenét frame, considering static obstacle avoidance and curvature constraints. We theoretically prove that it is a good generalization of the well-known jerk optimal solution. An efficient s-t graph search method is introduced to find a speed profile along the generated path to deal with dynamic environments. Finally, the path and speed are optimized incrementally and iteratively to ensure kinodynamic feasibility. Various simulated scenarios with both static obstacles and dynamic agents verify the effectiveness and robustness of our proposed method. Experimental results show that our method can run at 20 Hz. The source code is released as an open-source package.Keywords
This publication has 18 references indexed in Scilit:
- Robust and Efficient Quadrotor Trajectory Generation for Fast Autonomous FlightIEEE Robotics and Automation Letters, 2019
- Safe Trajectory Generation for Complex Urban Environments Using Spatio-Temporal Semantic CorridorIEEE Robotics and Automation Letters, 2019
- Search-Based Optimal Motion Planning for Automated Driving2018
- Continuous-time Gaussian process motion planning via probabilistic inferenceThe International Journal of Robotics Research, 2018
- A Sequential Two-Step Algorithm for Fast Generation of Vehicle Racing TrajectoriesJournal of Dynamic Systems, Measurement, and Control, 2016
- Gaussian Process Motion planning2016
- Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directionsTransportation Research Part C: Emerging Technologies, 2015
- Optimal trajectories for time-critical street scenarios using discretized terminal manifoldsThe International Journal of Robotics Research, 2011
- iSAM2: Incremental smoothing and mapping using the Bayes treeThe International Journal of Robotics Research, 2011
- Factor graphs and the sum-product algorithmIEEE Transactions on Information Theory, 2001