A Real-Time Terrain-Adaptive Local Trajectory Planner for High-Speed Autonomous Off-Road Navigation on Deformable Terrains

Abstract

This paper presents a novel terrain-adaptive local trajectory planner designed for the autonomous operation of off-road vehicles on deformable terrains. State-of-the-art solutions either do not account for deformable terrains, or do not offer sufficient robustness or computational speed. To bridge this research gap, the paper introduces a novel model predictive control (MPC) formulation. In contrast to the prevailing state-of-the-art approaches that rely exclusively on hard or soft constraints for obstacle avoidance, the present formulation enhances robustness by incorporating both types of constraints. The effectiveness and robustness of the formulation are evaluated through extensive simulations, encompassing a wide range of randomized scenarios, and compared against state-of-the-art methods. Subsequently, the formulation is augmented with an optimal-control-oriented terramechanics model from the literature, explicitly addressing terrain deformation. Additionally, a terrain estimator employing the unscented Kalman filter is utilized to dynamically adjust the sinkage exponent online, resulting in a terrain-adaptive formulation. This formulation is tested on a physical vehicle in real world experiments against a rigid-terrain formulation as the benchmark. The results showcase the superior safety and performance achieved by the proposed formulation, underscoring the critical significance of integrating terramechanics knowledge into the planning process. Specifically, the proposed terrain-adaptive formulation achieves reduced mean absolute sideslip angle, decreased mean absolute yaw rate, shorter time to goal, and a higher success rate, primarily attributed to its enhanced understanding of terramechanics within the planner.