Optimization-Based Automated Parking Trajectory Planning in Unstructured Environments With Efficient Obstacle Query
- 10 September 2025
- journal article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Intelligent Transportation Systems
- Vol. 26 (10) , 15422-15435
Abstract
Autonomous parking trajectory planning in unstructured environments with irregular obstacles must address the challenges posed by non-convex obstacle constraints. Due to the coupling between problem complexity and the number of surrounding obstacles, existing methods often suffer from increased computation time and failure rates in dense environments. To tackle this issue, this paper proposes an efficient parking trajectory planner with fast obstacle retrieval capability. The proposed planner follows a classical two-stage architecture consisting of front-end trajectory generation and back-end trajectory optimization. In the first stage, a multi-resolution sampling-based trajectory generation method is introduced. By using multi-resolution sampling strategy and a KD-Tree-based collision detection algorithm, the method achieves high-quality initial trajectory while maintaining computational efficiency. In the second stage, we present a novel iterative trajectory optimization method based on neighbor obstacle indexing, which restricts the scale of obstacle constraints during each optimization iteration, which improves computational efficiency of trajectory optimization. Extensive comparative studies and real-car experiments are conducted to validate the advantages of the proposed method, particularly in terms of computation time and robustness in complex, cluttered environments.Keywords
Funding Information
- State Key Program of National Natural Science Foundation of China (52332010)
This publication has 44 references indexed in Scilit:
- Parallel Parking Path Planning in Narrow Space Based on a Three-Stage Curve Interpolation MethodIEEE Access, 2023
- Trust in automated parking systems: A mixed methods evaluationTransportation Research Part F: Traffic Psychology and Behaviour, 2023
- Enhancing Feasibility and Safety of Nonlinear Model Predictive Control with Discrete-Time Control Barrier Functions2021
- Towards Semantic Segmentation of Urban-Scale 3D Point Clouds: A Dataset, Benchmarks and Challenges2021
- Analysis and Improvement of Geometric Parallel Parking Methods with Respect to the Minimum Final Lateral Distance to the Parking SpotInternational Journal of Intelligent Transportation Systems Research, 2021
- A guaranteed collision‐free trajectory planning method for autonomous parkingIET Intelligent Transport Systems, 2020
- Autonomous Parking Using Optimization-Based Collision Avoidance2018
- Optimisation based path planning for car parking in narrow environmentsRobotics and Autonomous Systems, 2016
- A unified motion planning method for parking an autonomous vehicle in the presence of irregularly placed obstaclesKnowledge-Based Systems, 2015
- Efficient mixed-integer planning for UAVs in cluttered environments2015