Robot-Body-Aware Traversal Risk Graph Planning for Wheeled-Legged Robots in Complex Terrain
Organizations: Key Laboratory of Intelligent Perception and Human-Machine Collaboration-ShanghaiTech University, Ministry of Education, China
Abstract
Traversal Risk Graphs (TRGs) provide a compact, terrain-aware representation for global navigation, but native TRG costs are computed over circular node neighborhoods and edge-aligned terrain regions rather than the robot's oriented body footprint. For wheeled-legged robots, this abstraction can miss partial support loss and body-terrain interference, especially during turns. We present Robot-Body-Aware TRG planning (RB-TRG), which builds on the sparse TRG representation and lifts edge-wise terrain-risk search to heading- and turn-aware body-risk transitions. An oriented rectangular footprint is sampled along graph edges and yaw sweeps to measure longitudinal support variation, lateral inclination, terrain interference, and exposure to untrusted map regions. Mean-and-upper-tail features are incorporated into transition costs, whose accumulated value is minimized by A* over ordered node-pair states, preserving TRG construction and its planning interface. We evaluate RB-TRG in a same-graph study on four scanned terrain environments and in paired closed-loop MuJoCo trials. RB-TRG reduces the three core geometric body-placement metrics and increases end-to-end success from 51.5% to 68.5%, while increasing mean path length by 2.3%. A Go2-W deployment further demonstrates RB-TRG with a full LiDAR navigation stack, which received the Best Autonomy and Best Mobility awards at the IEEE ICRA 2026 Legged Robot Challenges. The code for RB-TRG is released at https://github.com/ZhiqiaoGuo/RB-TRG.
Figures & tables
| Method | [m] | [m] | [ ∘ ] | [m] | Untr. [%] |
|---|---|---|---|---|---|
| Native TRG | 5.059 | 0.600 | 36.4 | 0.564 | 10.4 |
| Edge-only | 5.156 | 0.555 | 33.8 | 0.491 | 10.3 |
| Mean-only | 5.163 | 0.551 | 33.7 | 0.507 | 10.4 |
| Full RB-TRG | 5.173 | 0.540 | 33.3 | 0.480 | 10.3 |
| Method | Route cov. [%] | Cond. succ. [%] | E2E succ. [%] |
|---|---|---|---|
| Task-level benchmark | |||
| Native TRG | 100 | 59.5 | 51.5 |
| RB-TRG | 100 | 76.1 | 68.5 |
| T-Hybrid | 75.0 | 12.2 | 9.0 |
| ART | 100 | 5.0 | 5.0 |
| RB-TRG component ablation | |||
| Metric | Native | RB-TRG | 95% CI | |
|---|---|---|---|---|
| Cross-track RMSE [m] | 0.383 | 0.074 | ||
| Non-wheel-contact time [%] | 27.1 | 18.2 | ||
| Wheel-slip proxy | 0.645 | 0.607 | ||
| 95th-percentile pitch [ ∘ ] | 24.5 | 20.4 | ||
| 95th-percentile roll [ ∘ ] | 9.7 | 8.5 |
Robot Motion Planning
Robot motion planning finds safe, feasible paths and trajectories for robots moving through constrained, changing environments.
See all 262 papers