Autonomous Navigation Approach for Complex Scenarios Based on Layered Terrain Analysis and Nonlinear Model

In complex scenarios, such as industrial parks and underground parking lots, efficient and safe autonomous navigation is essential for driverless operation and automatic parking. However, conventional modular navigation methods, especially the A* algorithm, suffer from excessive node traversal and short paths that bring vehicles dangerously close to obstacles. To address these issues, we propose an autonomous navigation approach based on a layered terrain cost map and a nonlinear predictive control model, which ensures real-time performance, safety, and reduced computational cost. The global planner applies a two-stage A* strategy guided by the hierarchical terrain cost map, improving efficiency and obstacle avoidance, while the local planner combines linear interpolation with nonlinear model predictive control to adaptively adjust the vehicle speed under varying terrain conditions. Experiments conducted in simulated and real underground parking scenarios demonstrate that the proposed method significantly improves the computational efficiency and navigation safety, outperforming the traditional A* algorithm and other baseline approaches in overall performance.