Integrated automatic parking path planning and trajectory tracking optimization method

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.