用贝叶斯方法联合估计机器人状态与物理参数,提升精度与鲁棒性。
System Identification under Constraints and Disturbance: A Bayesian Estimation Approach
- 引入硬约束的贝叶斯框架,融合动力学、接触与闭环约束。
- 在仿真与硬件实验中实现更低的惯性/摩擦误差与更快收敛。
- 适合需要高精度动力学模型的机器人控制与轨迹规划场景。
我们提出一种贝叶斯系统辨识(SysID)框架,用于高精度联合估计机器人的状态轨迹与物理参数。该框架将物理一致的逆动力学、接触与闭环约束、以及完整的关节摩擦模型作为分阶段的硬等式约束嵌入。通过基于能量的回归器增强参数可观测性,支持惯性与驱动参数的等式与不等式先验,强制动态一致的扰动投影,并利用能量观测补充本体感知以消除非线性摩擦的混淆效应。为确保可扩展性,推导出参数化的等式约束里卡蒂递推,保持问题的带状结构,实现时间跨度上的线性复杂度,并开发了高效的导数计算方法。在典型机器人系统上的仿真研究,以及搭载Z1机械臂的Unitree B1硬件实验表明,相比前向动力学与解耦辨识基线,本方法收敛更快、惯性与摩擦估计误差更低、接触一致性更优。将其部署于模型预测控制框架时,可在复杂环境下的运动过程中显著提升跟踪性能。
原文摘要 · Abstract (English)
We introduce a Bayesian system identification (SysID) framework for jointly estimating robot's state trajectories and physical parameters with high accuracy. It embeds physically consistent inverse dynamics, contact and loop-closure constraints, and fully featured joint friction models as hard, stage-wise equality constraints. It relies on energy-based regressors to enhance parameter observability, supports both equality and inequality priors on inertial and actuation parameters, enforces dynamically consistent disturbance projections, and augments proprioceptive measurements with energy observations to disambiguate nonlinear friction effects. To ensure scalability, we derive a parameterized equality-constrained Riccati recursion that preserves the banded structure of the problem, achieving linear complexity in the time horizon, and develop computationally efficient derivatives. Simulation studies on representative robotic systems, together with hardware experiments on a Unitree B1 equipped with a Z1 arm, demonstrate faster convergence, lower inertial and friction estimation errors, and improved contact consistency compared to forward-dynamics and decoupled identification baselines. When deployed within model predictive control frameworks, the resulting models yield measurable improvements in tracking performance during locomotion over challenging environments.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。