arXiv:2411.11483cs.RO2024-11被引 11

提出双贝塔卡尔曼滤波,提升足式机器人在打滑和腿变形下的状态估计精度。

Robust State Estimation for Legged Robots with Dual Beta Kalman Filter

  • 构建双重估计框架,同步估算腿长参数与机器人状态。
  • 通过静态腿方程设计部分测量模型,避免误差累积。
  • 引入贝塔卡尔曼滤波,自适应抑制低频打滑带来的异常数据影响。

现有足式机器人状态估计算法常忽略足部打滑与腿部变形,导致较大误差。本文提出综合测量模型,通过分析足接触点与机身中心的相对运动,显式建模脚滑与可变腿长。证明腿长为可观测量,可通过辅助滤波器直接推断。为此,提出双估计框架:参数滤波器估计腿长参数,状态滤波器估计机器人状态。为防止迭代误差传播,基于腿静态方程构建参数滤波器的部分测量模型,仅依赖关节力矩与足端受力,规避状态估计误差的影响。由于脚滑无法直接观测,且发生频率低,被视作测量数据中的异常值。为缓解其影响,提出贝塔卡尔曼滤波(beta KF),用贝塔散度重构标准卡尔曼滤波的损失函数,可自适应赋予异常值低权重,增强鲁棒性。上述方法构成双贝塔卡尔曼滤波(Dual beta KF),在Unitree GO2机器人上的实验表明,该算法显著优于现有先进方法。

原文摘要 · Abstract (English)

Existing state estimation algorithms for legged robots that rely on proprioceptive sensors often overlook foot slippage and leg deformation in the physical world, leading to large estimation errors. To address this limitation, we propose a comprehensive measurement model that accounts for both foot slippage and variable leg length by analyzing the relative motion between foot contact points and the robot's body center. We show that leg length is an observable quantity, meaning that its value can be explicitly inferred by designing an auxiliary filter. To this end, we introduce a dual estimation framework that iteratively employs a parameter filter to estimate the leg length parameters and a state filter to estimate the robot's state. To prevent error accumulation in this iterative framework, we construct a partial measurement model for the parameter filter using the leg static equation. This approach ensures that leg length estimation relies solely on joint torques and foot contact forces, avoiding the influence of state estimation errors on the parameter estimation. Unlike leg length which can be directly estimated, foot slippage cannot be measured directly with the current sensor configuration. However, since foot slippage occurs at a low frequency, it can be treated as outliers in the measurement data. To mitigate the impact of these outliers, we propose the beta Kalman filter (beta KF), which redefines the estimation loss in canonical Kalman filtering using beta divergence. This divergence can assign low weights to outliers in an adaptive manner, thereby enhancing the robustness of the estimation algorithm. These techniques together form the dual beta-Kalman filter (Dual beta KF), a novel algorithm for robust state estimation in legged robots. Experimental results on the Unitree GO2 robot demonstrate that the Dual beta KF significantly outperforms state-of-the-art methods.

状态估计足式机器人卡尔曼滤波鲁棒性

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。