Real-Time Topology-Aware Local Planning and Control for Off-Road Vehicles on 3-D Terrains

A novel topology-aware model predictive control (MPC) framework is presented for navigating off-road wheeled vehicles with extreme mobility on 3-D terrains. Prior studies have oversimplified the problem by either treating it solely as a path-planning problem or disregarding the terrain topology. To bridge this gap, this article presents a one-layer model predictive planning and control framework that considers terrain topology for off-road vehicles at operationally relevant speeds. The algorithm is tested in various simulated scenarios with comparisons to benchmarks. The proposed algorithm demonstrates superior performance by capturing the dynamic constraints, while the benchmarks either fail to complete tasks or exhibit inferior performance due to inaccurate representation of the dynamic limitations of the vehicle. Furthermore, the algorithm is tested for robustness to demonstrate its ability to handle uncertainties in terrain topology.