arXiv:2605.17681cs.RO2026-05被引 1

让机器人运动估计符合物理规律,提升步态精度与参数识别能力。

PRIME: Physically-consistent Robotic Inertial and Motion Estimation for Legged and Humanoid Robots

论文配图:PRIME: Physically-consistent Robotic Inertial and Motion Estimation for Legged and Humanoid Robots
图 1 · 摘自论文原文
  • 基于最大后验估计融合传感数据与物理约束,生成动态一致轨迹。
  • 在四足与双足机器人上实现接触力与惯性参数的准确估计。
  • 适合需要高精度运动建模与物理仿真数据的机器人研发者。

人形与多足机器人通过间歇性接触与环境互动,其精确运动估计依赖于接触动力学推理。然而,现有传感方案——无论是基于机载本体感知的扩展卡尔曼滤波器(EKFs)还是外部动作捕捉系统——仅恢复运动学信息,而接触力、接触时机及惯性参数仍不可观测。因此,纯运动学重建常违反刚体动力学,尤其在接触频繁的运动中。为实现在真实部署中仅凭机载运动学实现精准运动估计,本文提出PRIME(Physically-consistent Robotic Inertial and Motion Estimation),一种最大后验(MAP)形式化方法,可将测量的运动学与执行器指令优化为动态一致的轨迹,并联合估计摩擦接触力与物理一致的惯性参数。该方法引入可微分接触动力学与平滑互补约束,结合Anitescu式摩擦模型,形成光滑可解的优化问题,适用于多种接触过渡场景。我们在四足机器人与Unitree G1人形机器人上评估了PRIME在接触丰富运动中的表现,验证了轨迹一致性提升与惯性参数识别准确性。除改善状态估计与反馈控制外,PRIME还能从实际部署机器人生成带力与接触标注的运动重建数据,可用于下游学习应用,如大规模行为建模与机器人基础模型训练。

原文摘要 · Abstract (English)

Humanoid and legged robots interact with the environment through intermittent contacts, making accurate motion estimation fundamentally dependent on reasoning about contact dynamics. However, standard sensing pipelines-whether based on onboard proprioception with Extended Kalman Filters (EKFs) or external motion capture systems-recover only kinematics, while contact forces, contact timing, and inertial parameters remain unobserved. As a result, purely kinematic reconstructions often violate rigid-body dynamics, particularly during contact-rich motions. To enable accurate motion estimation from onboard kinematics in real-world deployment, we propose PRIME (Physically-consistent Robotic Inertial and Motion Estimation), a Maximum A Posteriori (MAP) formulation that refines measured kinematics and actuator commands into a dynamically consistent trajectory while jointly estimating frictional contact forces and physically consistent inertial parameters. Our approach incorporates differentiable contact dynamics with smoothed complementarity constraints and an Anitescu-style friction model, yielding a smooth optimization problem that remains tractable across versatile contact transitions. We evaluate PRIME on contact-rich locomotion with quadrupedal robots and the Unitree G1 humanoid, demonstrating improved trajectory consistency and accurate inertial parameter identification. Beyond improving state estimation and feedback control with calibrated inertial parameters, PRIME produces force- and contact-annotated motion reconstructions from real robots in deployment, which can be used to provide high-quality data for downstream learning applications, including large-scale behavior modeling and robot foundation models.

运动估计物理约束人形机器人接触动力学

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