Vol. 1, No. 4 (October 2026) — Article KAGG:2610.00003

A Cross-Embodiment Navigation Stack for Heterogeneous Robot Teams: Planner, Interface Calibration, and Future-Range Perception

Authors: Zhaoyu Li, Jingyao Sun, Yichen Wang, Bowen Huang, Tianyu Zhou

Legged Locomotion Group, Tsinghua University, Beijing, China

[Received 2026-09-21; accepted 2026-10-02; published online 2026-10-05]

Abstract:

Running one navigation stack on a heterogeneous robot team requires more than a planner that accepts different footprints: each robot's velocity interface drifts with payload and battery state, and range perception must be queried along the motions that the robot can actually execute. This paper presents a cross-embodiment navigation stack with three coupled layers that share a single data contract keyed on a versioned configuration descriptor. A configuration-driven local planner built on AgniNav plans over abstract robot configurations; an active interface calibration layer built on GAUGE keeps each robot's command-to-motion model current through planner-conditioned probes triggered by residual drift; and a control-aligned future-range layer built on FutureRay supplies free-range predictions along the directions each embodiment can execute under its calibrated interface. The stack was deployed on a mixed team of a Go2-class quadruped, a B2-class quadruped, and a wheeled robot on a three-floor indoor-adjacent course with doorways, a 12 cm step, and a light-degraded stairwell, during a 14 h campaign and short ablation runs. The full stack reached 88.2 percent end-to-end task success with a 28 ms p95 replanning latency. Removing any single layer lowered success by 3.0 to 10.6 percentage points, although the two recorded ablation summaries disagree on which layer matters most. A simulated humanoid embodiment was onboarded in 2.1 h and succeeded in 94 percent of 10 runs. The paper also characterizes the failure envelope of the stack.


References (43)

  1. T. Zang, S. Cheng, H. Huang, S. Wang, and W. Zhang. AgniNav: Configuration-Driven Cross-Embodiment Local Planning for Robot Navigation. arXiv:2606.10903, 2026. arXiv:2606.10903
  2. T. Zang, H. Huang, S. Cheng, and W. Zhang. GAUGE: Planner-Conditioned Active Calibration of Opaque Quadruped Velocity Interfaces. arXiv:2607.02841, 2026. arXiv:2607.02841
  3. T. Zang, S. Wang, H. Huang, and S. Cheng. FutureRay: Control-Aligned Future Range for Agile Quadruped Navigation. arXiv:2608.01197, 2026. arXiv:2608.01197
  4. D. Shah, A. Sridhar, A. Bhorkar, N. Hirose, and S. Levine. GNM: A General Navigation Model to Drive Any Robot. arXiv:2210.03370, 2022. arXiv:2210.03370
  5. D. Shah, A. Sridhar, N. Dashora, K. Stachowicz, K. Black, N. Hirose, and S. Levine. ViNT: A Foundation Model for Visual Navigation. arXiv:2306.14846, 2023. arXiv:2306.14846
  6. A. Sridhar, D. Shah, C. Glossop, and S. Levine. NoMaD: Goal Masked Diffusion Policies for Navigation and Exploration. arXiv:2310.07896, 2023. arXiv:2310.07896
  7. A. Eftekhar et al.. The One RING: a Robotic Indoor Navigation Generalist. arXiv:2412.14401, 2024. arXiv:2412.14401
  8. J. Zhang et al.. Embodied Navigation Foundation Model. arXiv:2509.12129, 2025. arXiv:2509.12129
  9. H. Xi, M. Tan, X. Zhang, S. Cheng, S. Wang, Y. Gu, X. Shen, and W. Zhang. CeRLP: A Cross-embodiment Robot Local Planning Framework for Visual Navigation. arXiv:2603.19602, 2026. arXiv:2603.19602
  10. J. Zhang, Y. Du, X. Guo, S. Sun, X. Liu, Y. Sun, G. Lu, W. Sui, and J. Li. EA-Nav: Learning Safe Visual Navigation Policies with Embodiment Awareness. arXiv:2607.19880, 2026. arXiv:2607.19880
  11. Open X-Embodiment Collaboration et al.. Open X-Embodiment: Robotic Learning Datasets and RT-X Models. arXiv:2310.08864, 2023. arXiv:2310.08864
  12. Octo Model Team et al.. Octo: An Open-Source Generalist Robot Policy. arXiv:2405.12213, 2024. arXiv:2405.12213
  13. R. Doshi, H. Walke, O. Mees, S. Dasari, and S. Levine. Scaling Cross-Embodied Learning: One Policy for Manipulation, Navigation, Locomotion and Aviation. arXiv:2408.11812, 2024. arXiv:2408.11812
  14. D. Fox, W. Burgard, and S. Thrun. The Dynamic Window Approach to Collision Avoidance. IEEE Robotics and Automation Magazine, 4(1):23–33, 1997. doi:10.1109/100.580977
  15. S. Macenski, F. Martín, R. White, and J. Ginés Clavero. The Marathon 2: A Navigation System. arXiv:2003.00368, 2020. arXiv:2003.00368
  16. L. Wellhausen and M. Hutter. ArtPlanner: Robust Legged Robot Navigation in the Field. arXiv:2303.01420, 2023. arXiv:2303.01420
  17. Y. Kim, C. Kim, and J. Hwangbo. Learning Forward Dynamics Model and Informed Trajectory Sampler for Safe Quadruped Navigation. arXiv:2204.08647, 2022. arXiv:2204.08647
  18. N. Rudin, D. Hoeller, M. Bjelonic, and M. Hutter. Advanced Skills by Learning Locomotion and Local Navigation End-to-End. arXiv:2209.12827, 2022. arXiv:2209.12827
  19. D. Hoeller, N. Rudin, D. Sako, and M. Hutter. ANYmal Parkour: Learning Agile Navigation for Quadrupedal Robots. arXiv:2306.14874, 2023. arXiv:2306.14874
  20. J. Hwangbo, J. Lee, A. Dosovitskiy, D. Bellicoso, V. Tsounis, V. Koltun, and M. Hutter. Learning Agile and Dynamic Motor Skills for Legged Robots. arXiv:1901.08652, 2019. arXiv:1901.08652
  21. J. Lee, J. Hwangbo, L. Wellhausen, V. Koltun, and M. Hutter. Learning Quadrupedal Locomotion over Challenging Terrain. arXiv:2010.11251, 2020. arXiv:2010.11251
  22. N. Rudin, D. Hoeller, P. Reist, and M. Hutter. Learning to Walk in Minutes Using Massively Parallel Deep Reinforcement Learning. arXiv:2109.11978, 2021. arXiv:2109.11978
  23. T. Miki, J. Lee, J. Hwangbo, L. Wellhausen, V. Koltun, and M. Hutter. Learning Robust Perceptive Locomotion for Quadrupedal Robots in the Wild. arXiv:2201.08117, 2022. arXiv:2201.08117
  24. A. Kumar, Z. Fu, D. Pathak, and J. Malik. RMA: Rapid Motor Adaptation for Legged Robots. arXiv:2107.04034, 2021. arXiv:2107.04034
  25. G. Ji, J. Mun, H. Kim, and J. Hwangbo. Concurrent Training of a Control Policy and a State Estimator for Dynamic and Robust Legged Locomotion. arXiv:2202.05481, 2022. arXiv:2202.05481
  26. G. B. Margolis and P. Agrawal. Walk These Ways: Tuning Robot Control for Generalization with Multiplicity of Behavior. arXiv:2212.03238, 2022. arXiv:2212.03238
  27. I. Radosavovic, T. Xiao, B. Zhang, T. Darrell, J. Malik, and K. Sreenath. Real-World Humanoid Locomotion with Reinforcement Learning. arXiv:2303.03381, 2023. arXiv:2303.03381
  28. K. Hausman, J. Preiss, G. S. Sukhatme, and S. Weiss. Observability-Aware Trajectory Optimization for Self-Calibration with Application to UAVs. arXiv:1604.07905, 2016. arXiv:1604.07905
  29. E. S. Page. Continuous Inspection Schemes. Biometrika, 41(1/2):100–115, 1954. doi:10.1093/biomet/41.1-2.100
  30. V. Makoviychuk et al.. Isaac Gym: High Performance GPU-Based Physics Simulation For Robot Learning. arXiv:2108.10470, 2021. arXiv:2108.10470
  31. A. Agarwal, A. Kumar, J. Malik, and D. Pathak. Legged Locomotion in Challenging Terrains using Egocentric Vision. arXiv:2211.07638, 2022. arXiv:2211.07638
  32. X. Cheng, K. Shi, A. Agarwal, and D. Pathak. Extreme Parkour with Legged Robots. arXiv:2309.14341, 2023. arXiv:2309.14341
  33. Z. Zhuang, Z. Fu, J. Wang, C. Atkeson, S. Schwertfeger, C. Finn, and H. Zhao. Robot Parkour Learning. arXiv:2309.05665, 2023. arXiv:2309.05665
  34. J. Frey, M. Mattamala, N. Chebrolu, C. Cadena, M. Fallon, and M. Hutter. Fast Traversability Estimation for Wild Visual Navigation. arXiv:2305.08510, 2023. arXiv:2305.08510
  35. G. Kahn, P. Abbeel, and S. Levine. BADGR: An Autonomous Self-Supervised Learning-Based Navigation System. arXiv:2002.05700, 2020. arXiv:2002.05700
  36. A. Loquercio, E. Kaufmann, R. Ranftl, M. Müller, V. Koltun, and D. Scaramuzza. Learning High-Speed Flight in the Wild. arXiv:2110.05113, 2021. arXiv:2110.05113
  37. A. Kendall and Y. Gal. What Uncertainties Do We Need in Bayesian Deep Learning for Computer Vision? arXiv:1703.04977, 2017. arXiv:1703.04977
  38. A. D. Ames, S. Coogan, M. Egerstedt, G. Notomista, K. Sreenath, and P. Tabuada. Control Barrier Functions: Theory and Applications. arXiv:1903.11199, 2019. arXiv:1903.11199
  39. J. Hu, S. Yuan, G. C. R. Bethala, A. Tzes, and Y. Fang. Learning Adaptive Safety Margins for Visual Navigation. arXiv:2607.18200, 2026. arXiv:2607.18200
  40. M. Tranzatto et al.. CERBERUS: Autonomous Legged and Aerial Robotic Exploration in the Tunnel and Urban Circuits of the DARPA Subterranean Challenge. arXiv:2201.07067, 2022. arXiv:2201.07067
  41. A. Agha et al.. NeBula: Quest for Robotic Autonomy in Challenging Environments; TEAM CoSTAR at the DARPA Subterranean Challenge. arXiv:2103.11470, 2021. arXiv:2103.11470
  42. A. Kadian et al.. Sim2Real Predictivity: Does Evaluation in Simulation Predict Real-World Performance? arXiv:1912.06321, 2019. arXiv:1912.06321
  43. P. Anderson et al.. On Evaluation of Embodied Navigation Agents. arXiv:1807.06757, 2018. arXiv:1807.06757
Cite this article Zhaoyu Li, Jingyao Sun, Yichen Wang, Bowen Huang, Tianyu Zhou, "A Cross-Embodiment Navigation Stack for Heterogeneous Robot Teams: Planner, Interface Calibration, and Future-Range Perception," Transactions on Intelligent Robotics and Autonomous Systems, 2026, vol. 1, no. 4, KAGG:2610.00003. DOI: 10.5803/kagg.2610.00003.