Safe and Efficient Trajectory Optimization for Autonomous Vehicles Using B-Spline With Incremental Path Flattening
- 4 December 2024
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Intelligent Transportation Systems
- Vol. 26 (2) , 1797-1811
Abstract
Gradient-based trajectory optimization with B-spline curves is widely used for due to its fast convergence and continuous trajectory generation. However, the application of B-spline curves for path-velocity coupled trajectory planning in has been highly limited because it is challenging to reduce the over-approximation of the vehicle shape and to create a collision-free trajectory using B-spline curves while satisfying kinodynamic constraints. To address these challenges, this paper proposes novel disc-type, and kinodynamic feasibility penalty methods. The disc-type sv estimation method is a new technique to reduce sv over-approximation and is used to find collision points for ipf. In ipf, the collision points are used to push the trajectory away from obstacles and to iteratively increase the curvature weight, thereby reducing sv and generating a collision-free trajectory. Additionally, to satisfy kinodynamic constraints for avs using B-spline curves, we apply a clamped B-spline curvature penalty along with longitudinal and lateral velocity and acceleration penalties. Our experimental results demonstrate that our method outperforms state-of-the-art baselines in various simulated environments. We also conducted a real-world experiment using an av, and our results validate the simulated tracking performance of the proposed approach.Keywords
All Related Versions
Funding Information
- Institute of Information and Communications Technology Planning and Evaluation (IITP) grant
- Korean Government [Ministry of Science and Information and Communication Technology (MSIT)] (Development of Multi-Agent Simulation and Test Scenario Generation Software (2021-0-01415)
This publication has 44 references indexed in Scilit:
- acados—a modular open-source framework for fast embedded optimal controlMathematical Programming Computation, 2021
- OSQP: an operator splitting solver for quadratic programsMathematical Programming Computation, 2020
- HPIPM: a high-performance quadratic programming framework for model predictive controlIFAC-PapersOnLine, 2020
- Simultaneous dynamic optimization: A trajectory planning method for nonholonomic car-like robotsAdvances in Engineering Software, 2015
- A unified motion planning method for parking an autonomous vehicle in the presence of irregularly placed obstaclesKnowledge-Based Systems, 2015
- Continuous Path Smoothing for Car-Like Robots Using B-Spline CurvesJournal of Intelligent & Robotic Systems, 2015
- A real-time look-ahead interpolation methodology with curvature-continuous B-spline transition scheme for CNC machining of short line segmentsInternational Journal of Machine Tools and Manufacture, 2013
- Nonsmooth optimization via quasi-Newton methodsMathematical Programming, 2012
- Curvature continuous path generation for autonomous vehicle using B-spline curvesComputer-Aided Design, 2010
- On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programmingMathematical Programming, 2005