Integrated automatic parking path planning and trajectory tracking optimization method
Junren Shi,Yongkang Su,Changhao Piao,Yingjie Tang,Yufei Liang,Zhongquan Wang
DOI: https://doi.org/10.1177/01423312241282832
IF: 2.146
2024-11-01
Transactions of the Institute of Measurement and Control
Abstract:Transactions of the Institute of Measurement and Control, Ahead of Print. Current automatic parking systems often separate path planning and trajectory tracking, increasing complexity and failing to meet the parking needs of autonomous cars. Consequently, this study presents an approach based on Multi-stage Nonlinear Model Predictive Control (MSNMPC) for integrated autonomous parking path planning and trajectory tracking optimization. The method represents the evolution of uncertainty parameters over time through a scenario tree, and the MSNMPC controller with a predictive horizon P defines P + 1 phases, each with specific cost and constraint functions that depend only on the vehicle state and control inputs of that phase to satisfy the constraints of all phases of the parking process. In addition, the method integrates path planning and tracking control into one optimization problem, which is solved online to achieve integrated parking control. Simulation confirms that, in comparison to MPC with RRT* hierarchical control, the integrated parking scheme of MSNMPC has less lateral error and offers superior flexibility and tracking performance. To verify the generality of the scheme, it was validated in the diagonal parking scenario and the vertical parking scenario, respectively. The results show that, compared to the control experiments, the parking elapsed time has been reduced by 10.76% and 9.02%, respectively, enhancing parking efficiency. In addition, the parking error has decreased by 30.77% and 38.46%, respectively, thus improving parking accuracy. Moreover, the minimum safe distance in the control scheme for addressing uncertainty factors is 0.7 m greater than that of the control experiments, meeting the driving requirements for driverless vehicles in parking scenarios.
automation & control systems,instruments & instrumentation