机器人末端力控抖动？力传感器滤波与阻抗参数整定

做力控打磨时末端抖得厉害，轨迹跟不上，排查下来基本是力信号处理和阻抗参数没配合好。一、先看原始力信号。力传感器原始信号带噪声是正常的，先在示波器或日志里看噪声幅度和频率，噪声大到和接触力同量级时，控制环根本没法稳定。二、滤波别只加低通。低通能压高频噪声，但相位滞后会让接触响应变慢。实际常用一阶低通加陷波的组合，陷波对准机械共振频率，低通截止频率取控制带宽的 3 到 5 倍。三、阻抗参数要分段调。自由空间段刚度低一点、阻尼大一点，接触段刚度按工件硬度给，硬工件刚度给高了必抖。先固定阻尼调刚度，再固定刚度调阻尼，两个一起动很难收敛。四、查机械间隙。减速器间隙、末端连接松动会让力信号出现死区，控制环在死区里来回穿越，表现为低频抖动，这种抖调参数调不好，先紧机械。五、采样与控制周期要匹配。力控环 1kHz、轨迹环 100Hz 时，中间要做插值或滤波衔接，直接把 1kHz 噪声喂给 100Hz 环，抖动会被放大。你们力控抖动时先调滤波还是先调阻抗参数？

力控抖动先看原始力噪声再调阻抗，顺序正确。再补：陷波频率要用敲击或拖动激励实测，不要只抄机械仿真；低通截止压得太靠近力控带宽时，相位滞后会在接触瞬间先「顶一下」再抖。机械间隙造成的低频穿越，优先紧固与预紧，而不是加大阻尼硬捂。采样 1kHz 向 100Hz 轨迹环输送时，做抗混叠与下采样，比直接抽点更不容易把噪声折进接触力。

陷波频率实测这点我们也吃过亏：仿真给出的共振频率到了实机上会因为工件刚度和夹持状态漂移，敲击激励后看频谱峰值再定陷波，比照抄参数稳得多。调参顺序上，我们的做法是先固定一个保守的低通和阻尼，把接触过程跑稳，再逐步放宽截止频率，每次只动一个参数并记录接触力超调和稳态抖动，避免两个参数同时变导致无法归因。间隙问题再补一点：先在空载往复运动里看力信号有没有死区台阶，有台阶先查机械，阻尼加再大也只是把抖动压成慢漂。最后建议把同一工件在不同姿态下各跑一组，姿态变化会改变等效刚度，单姿态调好的参数换个姿态可能又抖。