仅用自身体感传感器,通过站立时双脚固定状态校准人形机器人腿部关节偏移。
Contact-Constrained Lower-Limb Joint-Offset Calibration for Humanoid Robots

- 利用躯干惯性单元和关节编码器,在双脚静止接触时建模姿态一致性约束。
- 实测将足高均方误差从4.26/8.03毫米降至2.20/1.43毫米,显著提升定位精度。
- 适合缺乏外部设备的人形机器人部署,尤其对髋部旋转耦合敏感的系统有效。
精确的关节编码器偏移对人形机器人下肢运动学一致性至关重要,但现有方法通常依赖外部动作捕捉系统或标记物。本文提出一种仅依赖机载关节编码器与髋部安装的IMU的自包含校准框架,基于静态双足支撑接触条件。正向运动学中两脚间变换在双脚固定时应保持不变;最小化其姿态相关离散度,形成关于12维偏移向量的非线性最小二乘问题。海森矩阵特征分析表明,平行俯仰轴引发旋转耦合:方向残差仅反映俯仰偏移之和,而平移与姿态多样性决定其余可观测性。对于A3的俯仰-滚转-偏航顺序,髋部滚转与偏航激励可降低髋俯仰耦合。结合站立姿态的膝关节先验,锚定剩余弱俯仰链分解。仿真与真实机器人注入测试均显示一致收敛;在保留数据上,校准使足高均方误差在A3上由4.26降至2.20毫米,在A2上由8.03降至1.43毫米。独立的激光雷达-惯性参考验证了俯仰耦合通道。注入俯仰偏移后,移除该偏差可使腿部里程计垂直漂移回归激光雷达轨迹。少量静态双足支撑姿态即可提供接触一致的修正,但弱俯仰链中的个别偏移仍依赖先验。
原文摘要 · Abstract (English)
Accurate joint encoder offsets are essential for kinematic consistency in humanoid lower limbs, yet existing calibration methods typically require external motion-capture systems or fiducial targets. We present a self-contained calibration framework exploiting only onboard joint encoders and a pelvis-mounted IMU during static double-support contact. The inter-foot transform from forward kinematics must stay constant when both feet are fixed; minimizing its posture-dependent dispersion yields a nonlinear least-squares problem over the 12-dimensional offset vector. A Hessian eigenstructure analysis shows that parallel pitch axes induce a rotational coupling. Orientation residuals then observe only the pitch-offset sum, while translation and posture diversity set the remaining numerical observability. For the A3 pitch-to-roll-to-yaw ordering, hip-roll and hip-yaw excitation reduce hip-pitch coupling. A standing-posture knee prior then anchors the remaining weak pitch-chain decomposition. Simulation and real-machine injection tests show consistent recovery, and on held-out recordings calibration reduces foot-height RMS residuals from 4.26 to 2.20 mm on A3 and from 8.03 to 1.43 mm on A2. An independent LiDAR-inertial reference checks the pitch-coupled channel. Removing an injected pitch offset moves the leg-odometry vertical drift back toward the LiDAR trajectory. A few static double-support stances thus provide contact-consistent corrections for well-excited directions. Individual offsets in the weak pitch chain remain prior-dependent.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。