A Safe and Efficient Navigation Framework for Ground Vehicles on Uneven Terrain Considering Kinematic Constraints and Terrain Traversability

Ground vehicles navigating uneven terrain must simultaneously guarantee motion safety and efficiency. Safety requires that the planned waypoints lie in highly traversable terrain, while ensuring vehicle reachability to these waypoints, which must be kinematically feasible. Efficiency demands fewer detours and smoother paths that avoid excessive vehicle acceleration and steering. However, existing path planning research for uneven terrain fails to comprehensively integrate vehicle kinematic constraints, terrain factors, path smoothness, rollover risk, and total path length. To address this problem, this paper proposes a novel navigation framework. It first integrates terrain slope, flatness, elevation variation, and sparsity to generate a 2D global terrain traversability cost map. Subsequently, a three-phase path planning algorithm integrates A*, guided Rapidly-exploring Random Tree (RRT), and our proposed Kinematic and Terrain-Aware Probabilistic Roadmap (KT-PRM) local re-planning algorithm, which jointly considers multiple factors including ground vehicle kinematic constraints, terrain factors, path smoothness, rollover risk, and path length. This three-phase combination delivers safe, smooth, and short global paths over uneven terrain within a relatively short planning time. Finally, Nonlinear Model Predictive Control (NMPC) is employed for path tracking in the framework. Experiments were conducted in both simulated and real-world uneven terrain environments. The results demonstrated that the three-phase path planning algorithm integrated with our proposed KT-PRM algorithm achieves comprehensive performance in generating safer, smoother, and shorter paths. Our proposed navigation framework achieves safer and more efficient navigation compared with existing navigation frameworks.