Skip to content

论文arXiv 2611.243103 天前

SBEE框架:本体感知融合地形高程估计,足式机器人ATE降低22.1% ​

本文由 AI 根据公开内容整理,可能有误,请以原文为准:Proprioceptive Simultaneous Base and Terrain Elevation Estimation for Legged Robot Locomotion(arXiv 2611.24310)

核心内容 ​

针对足式机器人在视觉退化环境中全局位置与偏航不可观、垂直漂移导致摆腿轨迹失稳的痛点,研究团队提出Simultaneous Base and Elevation Estimation(SBEE)实时开源框架。该方法将地形视为持久本体感知地标,利用每一步落脚提供的高度测量锚定垂直轴。在MuJoCo仿真及ANYmal-D GrandTour数据集296米实机测试中,SBEE相比三种主流本体感知估计器,绝对轨迹误差(ATE)降低22.1%,显著提升了无视觉条件下的定位精度。

技术上,SBEE采用左不变扩展卡尔曼滤波(LI-EKF)与栅格高程图构建双向耦合回路。稳定触地时向地图插入不确定性感知的采样点,已建图单元格则作为加权垂直伪观测反馈至滤波器,起到类似回环检测的作用。不同于传统接触辅助不变滤波器需为每条腿增加状态维度,该LI-EKF直接消耗运动学速度量测,使状态维度独立于腿数,兼顾了双足与四足平台的通用性与实时计算效率。

关键看点 ​

  • 双向耦合机制:LI-EKF与栅格高程图实时交互,利用触地高度样本与地图伪观测互为约束,替代视觉地标实现垂直轴锚定
  • 状态维度解耦:LI-EKF直接消耗运动学速度量测而非逐腿建模,状态维度不随腿数增加,适配双足/四足等多构型平台
  • 实测精度提升:在ANYmal-D GrandTour数据集296米 locomotion 测试中,ATE较现有最优本体感知估计器降低22.1%
  • 开源实时框架:代码完全开源,支持MuJoCo仿真验证与真机部署,解决视觉拒止环境下的高度参考系漂移问题

工程与产业观察 ​

SBEE为视觉失效场景下的足式机器人提供了高鲁棒性本体感知范式。其将地形高程作为持久先验并解耦状态维度的设计,对井下、隧道等GPS/视觉拒止环境的工程落地具有直接参考价值,也为具身智能在极端环境下的状态估计提供了新的算法基线。

英文摘要 (Abstract) ​

Legged robots in visually degraded environments must rely exclusively on proprioceptive sensing, under which global position and yaw are unobservable. Vertical drift is particularly detrimental, as it corrupts the height reference required by swing-leg trajectories and can destabilize the robot. We treat the terrain itself as a persistent proprioceptive landmark: every footstep provides a height measurement that anchors the vertical axis. We propose Simultaneous Base and Elevation Estimation (SBEE), a real-time open-source framework in which a Left-Invariant Extended Kalman Filter (LI-EKF) for floating-base estimation and a grid-based elevation map are coupled in a bidirectional loop, mirroring SLAM with terrain elevation in place of landmarks. Stable foot contacts insert uncertainty-aware height samples into the map, and previously mapped cells are fed back as uncertainty-weighted vertical pseudo-measurements that act analogously to loop closures. Unlike contact-aided invariant filters, the LI-EKF consumes a kinematic velocity measurement instead of augmenting the state with a contact model per leg, so its state dimension is independent of the number of legs. We evaluate SBEE in MuJoCo on quadrupedal and bipedal platforms and on the ANYmal-D GrandTour dataset over 296 m of locomotion, reducing the absolute trajectory error by 22.1% relative to the best of three state-of-the-art proprioceptive estimators.

作者:Michael Maravgakis, Stylianos Piperakis, Panos Trahanias

基于本页技术方向关联的整机参数、核心零部件、实测报告与同赛道选型横评。

外部来源

本页事实对应的公开页面,以原文为准。(点击将离开本站)

  1. arXiv 2611.24310:Proprioceptive Simultaneous Base and Terrain Elevation Estimation for Legged Robot Locomotion ↗访问 2026-11-19