人形机器人IMU漂移为什么带偏全身姿态?
躯干姿态一旦慢慢偏掉,步态、手臂补偿和视觉坐标都会一起跟着歪。人形机器人使用IMU做姿态基准时,零偏漂移和足端约束如果没有闭合,误差会被全身控制放大。
IMU零偏最麻烦的地方,是它不像白噪声那样平均后自然消失。陀螺零偏会在积分中变成角度漂移,加速度计偏置又会把重力方向估计拉偏;温度变化、机械应力和上电自热都会让这个偏置缓慢移动。若滤波器只在静态启动时校一次,机器人走几分钟后,躯干姿态看起来只是偏了一点,质心投影却已经被规划器带到错误位置。
安装轴系偏差会让漂移更难分辨。IMU板卡与躯干结构的安装角若有小角度误差,前后俯仰和左右横滚会互相串入,急停或落脚冲击后还可能出现短时饱和恢复。此时单看传感器输出并不能判断是姿态真的变化,还是量测坐标没有对准机械坐标。出厂标定必须把安装矩阵写入控制链路,而不能只把IMU当成独立模块验收。
时间同步同样关键。关节编码器、足底力传感器和IMU若相差几个控制周期,滤波器就会把旧关节姿态和新惯性数据放在一起融合。快速转身时,这种错位会表现成腰部姿态突变,进而触发不必要的步态修正。与其事后加重滤波,不如在采集链路上给每类数据打硬时间戳。
足端约束是抑制漂移的重要外部观测,但前提是支撑脚确实可靠。支撑相中,脚底相对地面近似静止,可以用零速度或平面约束修正躯干状态;可一旦脚掌在低摩擦地面上滑动,这个约束就从校正量变成错误锚点。人形机器人在瓷砖、金属坡面或软垫上行走时,若还把足端当作绝对静止,滤波器会把滑移误差解释成躯干姿态变化。
因此观测器需要给足端约束加可信度,而不是固定使用。法向力稳定、切向力未接近摩擦锥边界、足底力矩中心没有跳变时,约束权重可以提高;检测到滑移、碰撞或脚掌边缘接触时,就要降低约束权重,改由惯性和运动学短时间维持。这个权重切换若没有迟滞,也会把估计结果做成抖动源。
验证姿态估计要避开只在静态平台上看误差。更有价值的是让机器人做原地转身、斜坡停驻、小高度落脚和短时滑移,把估计姿态、真实外部测量和足端状态同时记录。若漂移只在某些接触状态下加速,说明问题不是IMU规格不够,而是外部约束使用时机不对。
温度补偿也要跟运行状态绑定。躯干内部风扇、功率板和电池会让IMU附近形成缓慢热梯度,静态温箱标定只能覆盖一部分变化。若零偏模型没有记录上电后的自热曲线,冷启动和热启动会给出不同初值。现场校验可在站立静止窗口内估计短时零偏,但必须确认脚底没有滑移,否则会把环境运动误写进惯性偏置。补偿参数还要随固件版本管理,避免换板后继续使用旧温漂曲线。
所以,姿态基准不是一块传感器能单独保证的。把零偏、安装和足端观测放进同一滤波框架,整机姿态才不会被小漂移慢慢带偏。





