Hierarchical Terrain-Aware Navigation via Bayesian-Guided RRT* and Flat-Corridor CiLQR
- 3 March 2026
- journal article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Robotics and Automation Letters
- Vol. 11 (4) , 5104-5111
Abstract
Autonomous navigation in unstructured, off-road environments remains a critical challenge due to complex terrain and limited prior knowledge. This letter presents a hierarchical framework to generate paths across locally flat regions and optimize spatio-temporal trajectories under vehicle kinodynamics. The first step employs a terrain-aware RRT* that integrates Bayesian-learning-guided sampling with a directional reachability index, enabling efficient exploration in complex environments while avoiding dead-end traps. The resulting path explicitly accounts for local roughness and slope. The second step applies a constrained iterative linear quadratic regulator (CiLQR) trajectory optimizer that refines the path within a dynamic flat-corridor, where terrain risk is embedded into the optimization. The optimizer enforces vehicle stability constraints and adaptively regulates speed based on terrain risk and curvature, yielding dynamically feasible trajectory. Extensive simulations in off-road scenarios demonstrate that the proposed framework outperforms state-of-the-art methods, producing feasible trajectories with up to 34 % lower vehicle jolt. Furthermore, real-world tests on a 40-ton articulated truck in the Alxa Desert validate the framework's robustness and practical effectiveness.Keywords
Funding Information
- National Natural Science Foundation of China (62473044)
- National Natural Science Foundation of China (62303117)
- Natural Science Foundation of Fujian Province (2025J09022)
This publication has 22 references indexed in Scilit:
- Gaussian Process-based Traversability Analysis for Terrain Mapless Navigation2024
- A Kalman-Koopman LQR Control Approach to Robotic SystemsIEEE Transactions on Industrial Electronics, 2024
- Terrain-Aware Spatio-Temporal Trajectory Planning for Ground Vehicles in Off-Road Environment2024
- Safe Consensus Tracking With Guaranteed Full State and Input Constraints: A Control Barrier Function-Based ApproachIEEE Transactions on Automatic Control, 2023
- Hierarchical Motion Planning for Autonomous Vehicles in Unstructured Dynamic EnvironmentsIEEE Robotics and Automation Letters, 2022
- PUTN: A Plane-fitting based Uneven Terrain Navigation Framework2022
- Hierarchical Planning Through Goal-Conditioned Offline Reinforcement LearningIEEE Robotics and Automation Letters, 2022
- Real-Time Perception-Limited Motion Planning Using Sampling-Based MPCIEEE Transactions on Industrial Electronics, 2022
- FAST-LIO: A Fast, Robust LiDAR-Inertial Odometry Package by Tightly-Coupled Iterated Kalman FilterIEEE Robotics and Automation Letters, 2021
- Adaptive Motion Planning Based on Vehicle Characteristics and Regulations for Off-Road UGVsIEEE Transactions on Industrial Informatics, 2018