ArduPilot飞控滤波调优实战：从原理到参数优化

1. 为什么飞控需要滤波调优？

第一次用ArduPilot飞控时，最让我困惑的就是明明硬件和Betaflight完全一样，但飞行手感却天差地别。后来拆解log数据才发现，问题出在传感器数据的"干净程度"上。飞控就像人的小脑，如果传感器传上来的都是"假动作"，那控制输出自然会变得很奇怪。

想象一下你在颠簸的公交车上写字，车身晃动就像电机振动带来的噪声。低通滤波相当于让你写字时手抖得轻一点，而陷波滤波则是专门消除某个特定频率的抖动（比如发动机的固定震动频率）。我在Mark4机架上实测发现，不调滤波直接套用Betaflight的PID参数，会出现两个典型问题：快速横滚时机身抖动像"打摆子"，急加减速时又有明显的点头现象。

滤波调优本质上是在做三件事：

1. 识别噪声：用FFT工具分析出振动的主频和谐波
2. 选择武器：根据噪声特性组合使用低通和陷波滤波
3. 平衡取舍：在滤波效果和相位延迟间找到最佳平衡点

2. 滤波原理的工程化理解

2.1 低通滤波的"水龙头"效应

ArduPilot的INS_ACCEL_FILTER和INS_GYRO_FILTER就像安装在传感器数据流上的水龙头。把截止频率设为100Hz，相当于只允许流速低于100Hz的"水流"通过。但这里有个隐藏陷阱：水龙头拧得越紧（截止频率越低），水流到达水杯的时间就越晚（相位延迟越大）。

实测数据表明，5寸机架在INS_GYRO_FILTER=75Hz时，横滚控制的延迟会达到15ms；调到250Hz后延迟降到6ms，但高频振动明显增加。我的经验公式是：

最佳截止频率 ≈ 最大控制频率 × 3

比如你期望的控制响应最高到80Hz，那么低通滤波设在240Hz左右比较合适。

2.2 陷波滤波的"狙击枪"战术

当电机转速为6000转/分（100Hz）时，不仅会产生100Hz基频噪声，还会带来200Hz、300Hz等谐波。INS_HNTCH_ENABLE就像一把可以精确打击这些特定频率的狙击枪。有次调试时发现一个有趣现象：开启动态陷波（INS_HNTCH_MODE=4）后，电机温度升高导致的转速漂移能被自动跟踪，这比固定频率陷波实用得多。

建议按这个顺序配置陷波滤波：

1. 用FFT工具确认主噪声频率
2. 设置INS_HNTCH_FREQ略低于基频（预留RPM波动空间）
3. 带宽INS_HNTCH_BW建议设为中心频率的30-50%
4. 谐波次数INS_HNTCH_HMNCS根据频谱图决定

3. 手把手调参实战

3.1 准备工作：获取噪声指纹

接上USB线，在Mission Planner的"振动分析"界面猛推油门，我通常这样读取数据：

1. 采样时间≥30秒
2. 包含从怠速到最大油门的全过程
3. 重点观察X/Y轴的频谱（Z轴通常噪声较小）

最近调试的Mark4机架频谱显示（使用T-Motor F60 Pro III电机）：

基频峰值：122Hz 二次谐波：244Hz 三次谐波：366Hz

3.2 加速度计滤波调参

虽然参数名叫INS_ACCEL_FILTER，但它实际影响的是姿态估计的准确性。有个容易忽略的细节：这个滤波器作用于加速度计原始数据，会影响EKF的收敛速度。我的调参步骤：

1. 初始值设为40Hz（保守值）
2. 观察"振动-加速度计"读数，Z轴应<15m/s²
3. 每次增加10Hz，直到出现高频毛刺
4. 回退5Hz作为最终值

实测发现，大多数5寸机架的最佳值在50-80Hz之间。超过100Hz后，急加速时会出现明显的姿态估计抖动。

3.3 陀螺仪滤波的黄金法则

INS_GYRO_FILTER直接影响控制响应的灵敏度和噪声水平。这里有个实用技巧：在调参前先把ATC_RAT_RLL_P设为0，让飞机保持自稳模式但不响应摇杆输入，然后观察陀螺仪数据的"干净程度"。

我的调参备忘录：

• 竞速机：250-300Hz（追求响应速度）
• 航拍机：80-150Hz（追求稳定性）
• 重型机：50-80Hz（抗振动优先）

特别注意：修改此参数后必须重新调整PID！有次我忘记这茬，结果飞机翻得比煎饼还利索。

4. 高阶技巧与避坑指南

4.1 动态陷波的秘密参数

INS_HNTC2_ENABLE的隐藏玩法是配合RPM信号做油门联动陷波。当电调支持DShot Telemetry时，可以设置：

INS_HNTCH_OPTS = 136 （RPM+Throttle混合模式） INS_HNTCH_REF = 1 （参考电调1的RPM）

这样滤波频率会随油门变化自动调整，实测可以降低15%的电机温度。不过要注意H743等主控需要额外配置UART端口来接收RPM信号。

4.2 滤波与PID的联动效应

滤波和PID就像咖啡和糖的关系。当我把INS_GYRO_FILTER从75Hz调到200Hz后，必须同步修改：

ATC_RAT_RLL_P ×0.7 ATC_RAT_RLL_D ×1.3

因为高频噪声增加会导致D项过冲，而相位延迟减少又允许更高的P增益。有个简单的验证方法：快速打杆后立即回中，观察震荡次数。理想状态是1-2次小幅震荡后立刻稳定。

4.3 特殊场景的滤波策略

夜间飞行时发现一个有趣现象：低温会导致电机轴承阻力增大，使得噪声频谱整体下移约10%。这时需要：

1. 将INS_HNTCH_BW增加20%
2. 启用第二个陷波器（INS_HNTC2_ENABLE=1）
3. 设置INS_HNTC2_FREQ比主陷波低15Hz

类似的，使用三叶桨时需要把谐波次数设为3的倍数（INS_HNTCH_HMNCS=3,6,9），而两叶桨则用2,4,6的组合更有效。