4、陷波滤波器类型：二阶陷波、多阶陷波、自适应陷波、数字陷波滤波器的特点与适用场景

在运动控制系统的振动抑制实践中，陷波滤波器（Notch Filter）是最常用的频域整形工具。它的核心任务是在不显著影响系统低频增益和相位裕度的前提下，对特定频率（通常是机械谐振频率）的增益进行深度衰减。然而，面对不同的机械结构、不同的谐振特性（如固定频率谐振、时变谐振、多模态谐振）以及不同的控制器架构（模拟或数字），工程师必须选择合适阶数和结构的陷波器。本章将系统剖析二阶陷波、多阶陷波、自适应陷波与数字陷波滤波器的数学本质、工程特点及选型逻辑，帮助读者建立从“谐振现象”到“滤波器实现”的完整映射。

上图展示了四类陷波滤波器的基本定位与选型逻辑。在实际工程中，这四类滤波器并非互斥关系，而是可以组合使用。例如，在伺服驱动器中，数字陷波滤波器通常作为基础框架，内部可配置二阶或多阶陷波算法；而自适应陷波则是在数字陷波基础上增加了频率估计与参数更新模块。下面逐一深入剖析。

4.1 二阶陷波滤波器：经典中的主力

核心原理

二阶陷波滤波器（Biquad Notch）是工程应用中最基础的陷波结构，其连续域传递函数为：

H(s) = (s² + ωz²) / (s² + (ωz/Qz)·s + ωz²)

其中，ωz为陷波中心频率（即谐振频率），Qz为品质因数，决定陷波带宽。当Qz较大时，陷波带宽窄，仅对谐振频率附近很窄的频段进行衰减，对相邻频率影响小；当Qz较小时，陷波带宽宽，衰减范围大，但也会影响谐振频率附近的相位特性。实际应用中，通常将零点频率ωz设置为谐振频率，极点频率ωp略低于ωz（或通过调整Q值实现），以在保证陷波深度的同时，尽量减少对低频段相位的影响。

判断方法与操作流程

在运动控制调试中，使用二阶陷波的标准流程如下：

1. 频谱测量：通过扫频或FFT分析，获取速度环或位置环开环/闭环频率响应，识别谐振峰的频率f_res和峰值增益G_peak。
2. 参数计算：设定陷波频率f_notch = f_res；根据谐振峰宽度确定Q值，一般取Q = f_res / (f_high - f_low)，其中f_high和f_low为谐振峰-3dB带宽的上下限频率。
3. 深度设置：陷波深度（即最大衰减量）通常设置为-20dB至-40dB，具体取决于谐振峰的强度。若谐振峰增益超过20dB，建议深度至少为-30dB。
4. 验证与迭代：将滤波器插入速度环输出端或电流环给定端，重新测量频率响应，确认谐振峰被抑制且相位裕度损失小于5°~10°。

案例拆解：某转台伺服系统的二阶陷波调参

某精密转台采用直驱电机，在速度环调试中发现2.3kHz处存在明显的机械谐振峰，峰值增益约18dB，导致系统在2kHz以上频段出现啸叫和振荡。通过频谱分析仪测得谐振峰-3dB带宽为2.1kHz~2.5kHz，计算得Q≈2.3。在伺服驱动器中启用二阶陷波器，设置f_notch=2300Hz，Q=2.3，深度=-25dB。插入后重新测量，谐振峰被抑制至-5dB以下，速度环带宽从原来的350Hz提升至520Hz，且相位裕度仅损失4°。系统运行平稳，啸叫消失。复盘发现，若Q值设置过大（如Q=5），虽然陷波更窄，但实际谐振频率随温度漂移后，陷波效果会显著下降，因此最终选择了Q=2.3的较宽陷波，兼顾了鲁棒性。

常见误区与总结

• 误区一：Q值越大越好。Q值过大会导致陷波带宽过窄，对谐振频率漂移敏感，且可能引入额外的相位滞后。
• 误区二：陷波深度越深越好。过深的陷波会同时衰减谐振频率附近的有效控制信号，降低系统响应速度。
• 误区三：忽略相位影响。二阶陷波在陷波频率附近会产生相位滞后，若系统相位裕度本就不足，可能引发新的稳定性问题。

二阶陷波是基础，但面对多谐振峰或时变谐振时，需要更复杂的结构。

4.2 多阶陷波滤波器：应对多模态谐振

核心原理

多阶陷波滤波器并非指单个高阶滤波器，而是多个二阶陷波器的串联或并联组合。其传递函数为多个二阶陷波环节的乘积：

H(s) = Π [ (s² + ωzi²) / (s² + (ωzi/Qzi)·s + ωzi²) ]  (i=1,2,...,n)

每个二阶环节对应一个谐振频率。多阶陷波的优势在于可以独立调节每个谐振峰的抑制深度和带宽，互不干扰。在数字实现中，多阶陷波通常以级联Biquad结构实现，每个Biquad对应一个谐振点。

判断方法与操作流程

多阶陷波的设计流程如下：

1. 多峰识别：通过频谱分析，识别出所有超过设定阈值（如10dB）的谐振峰，记录每个峰的频率和Q值。
2. 优先级排序：优先抑制增益最高、对稳定性影响最大的谐振峰。通常低频谐振（<1kHz）对系统带宽影响大，高频谐振（>5kHz）可能引发噪声放大。
3. 逐级设计：为每个谐振峰设计独立的二阶陷波参数，然后串联。
4. 整体验证：将所有陷波器串联后，检查总相位滞后。若总相位损失超过15°，需考虑降低部分陷波的深度或调整Q值。

案例拆解：五轴机床进给轴的双谐振抑制

某五轴加工中心Y轴进给系统，因丝杠-工作台耦合存在两个谐振峰：1.2kHz（增益15dB）和3.8kHz（增益12dB）。若仅使用一个二阶陷波抑制1.2kHz，3.8kHz的谐振仍会导致高速加工时表面波纹。采用双二阶陷波串联：第一级f1=1200Hz，Q1=3，深度-20dB；第二级f2=3800Hz，Q2=4，深度-18dB。插入后，两个谐振峰均被抑制至-5dB以下。但发现总相位滞后在1kHz处达到12°，导致速度环带宽从400Hz降至320Hz。为补偿相位损失，将速度环积分增益降低10%，并适当提高微分增益，最终在保证稳定性的前提下，带宽恢复至380Hz。该案例表明，多阶陷波虽然解决了多峰问题，但相位代价是叠加的，需要结合控制器参数调整。

常见误区与总结

• 误区一：陷波器数量越多越好。每增加一个陷波器，系统相位损失增加，且调试复杂度上升。
• 误区二：所有谐振峰都需同等抑制。应优先抑制对系统稳定性影响最大的峰，弱峰可适当放宽。
• 误区三：忽略谐振峰之间的耦合。机械系统各模态之间存在耦合，抑制一个峰可能改变另一个峰的频率和增益，需迭代验证。

多阶陷波适用于谐振频率固定但数量较多的场景。然而，当谐振频率随工况变化时，固定参数的多阶陷波将失效，此时需要自适应陷波。

4.3 自适应陷波滤波器：动态频率跟踪

核心原理

自适应陷波滤波器（Adaptive Notch Filter）通过在线估计谐振频率，并实时调整陷波中心频率，实现对时变谐振的持续抑制。其典型结构包括：频率估计模块（如锁相环PLL、最小均方LMS算法、卡尔曼滤波）和可变参数陷波器。以LMS自适应陷波为例，其核心思想是利用参考信号与误差信号的相关性，不断更新陷波频率：

ω[n+1] = ω[n] + μ · e[n] · x[n]

其中，μ为步长因子，e[n]为误差信号，x[n]为参考信号（通常取谐振频率附近的正弦分量）。自适应陷波的优势在于无需人工干预，可自动跟踪谐振频率的变化，适用于负载变化大、温度漂移明显的系统。

判断方法与操作流程

自适应陷波的工程实施步骤：

1. 确定适用性：若谐振频率随负载、温度或位置变化超过±10%，且变化速度较慢（时间常数大于0.1s），适合采用自适应陷波。
2. 选择估计算法：对于单峰谐振，LMS或PLL即可；对于多峰，需使用多通道自适应或级联结构。
3. 设置收敛参数：步长因子μ决定收敛速度和稳态误差。μ过大，收敛快但稳态波动大；μ过小，收敛慢且可能无法跟踪快速变化。
4. 保护机制：设置频率更新范围（如±20%），防止误收敛到非谐振频率；设置陷波深度上限，避免过度抑制。

案例拆解：机器人关节臂的变负载谐振抑制

某六轴工业机器人的第二关节，在搬运不同重量工件时，谐振频率在28Hz~35Hz之间变化。固定二阶陷波只能抑制某一特定频率，导致其他负载下仍存在振动。采用LMS自适应陷波器，参考信号取自速度环输出，步长μ=0.01，频率更新范围25Hz~40Hz。实测在空载时，陷波频率自动收敛至28.5Hz；负载5kg时，收敛至32.2Hz；负载10kg时，收敛至34.8Hz。整个收敛过程约0.3s，期间系统振动幅度先增大后迅速衰减。与固定陷波相比，自适应陷波在所有负载工况下均能将振动加速度降低80%以上。但代价是算法复杂度增加，且需要额外的DSP计算资源。复盘发现，μ值过大（0.05）时，频率估计波动达±2Hz，导致陷波效果不稳定；μ=0.01时，稳态波动仅±0.3Hz，效果最佳。

常见误区与总结

• 误区一：自适应陷波可以完全替代手动调试。实际上，自适应陷波仍需设置初始频率、步长、范围等参数，且对噪声敏感。
• 误区二：收敛速度越快越好。过快的收敛会导致频率估计噪声大，甚至误跟踪到非谐振频率。
• 误区三：忽略计算资源。自适应算法需要实时运算，对控制周期有严格要求，可能增加硬件成本。

自适应陷波解决了时变谐振问题，但上述讨论均基于模拟或数字实现。在数字控制系统中，所有陷波器最终都以数字滤波器的形式实现，其离散化方法和数值精度直接影响性能。

4.4 数字陷波滤波器：离散域的实现艺术

核心原理

数字陷波滤波器是上述所有陷波器在数字控制器中的具体实现形式。其设计核心是将连续域传递函数离散化，常用方法包括双线性变换（Bilinear Transform）、零极点匹配（Matched Z-Transform）和冲激不变法。其中，双线性变换最常用，因为它能保持频率响应形状，且无混叠。以二阶陷波为例，双线性变换后的数字传递函数为：

H(z) = (b0 + b1·z⁻¹ + b2·z⁻²) / (1 + a1·z⁻¹ + a2·z⁻²)

系数由陷波频率、Q值和采样周期Ts共同决定。数字陷波的优势在于：参数可编程、温度漂移小、可灵活切换多组参数、支持在线调整。但需注意离散化带来的频率偏差（尤其在采样频率较低时）和有限字长效应。

判断方法与操作流程

数字陷波器的设计流程：

1. 确定采样频率：采样频率fs应至少大于陷波频率的10倍，否则离散化误差显著。例如，陷波频率2kHz，fs至少20kHz。
2. 选择离散化方法：推荐双线性变换，但需进行频率预畸变（Pre-warping），确保离散后的陷波频率与连续域一致。
3. 计算系数：根据连续域参数（ωz, Q）和采样周期Ts，计算b0, b1, b2, a1, a2。
4. 定点化处理：在DSP或FPGA中，需将浮点系数转换为定点数，注意系数精度和运算溢出。
5. 验证与测试：在MATLAB/Simulink中仿真，或直接在控制板上注入正弦扫频信号，验证实际频率响应。

案例拆解：基于FPGA的数字陷波器实现

某高速贴片机Z轴采用直线电机，谐振频率为4.5kHz，控制周期为50μs（采样频率20kHz）。在FPGA中实现二阶数字陷波器，采用双线性变换并预畸变。计算得系数：b0=0.9821, b1=-1.9642, b2=0.9821, a1=-1.9642, a2=0.9643。使用24位定点数表示，量化后系数误差小于0.01%。实测频率响应显示，4.5kHz处衰减-28dB，与理论值-30dB接近。但发现当温度升高时，FPGA内部逻辑延迟变化导致实际陷波频率偏移约30Hz，通过增加温度补偿系数解决。该案例表明，数字陷波器的精度不仅取决于算法，还受硬件实现细节影响。

常见误区与总结

• 误区一：直接使用连续域参数而不做预畸变。这会导致离散后的陷波频率偏移，尤其在fs较低时。
• 误区二：忽略有限字长效应。系数量化误差可能导致陷波深度下降或频率偏移，需进行灵敏度分析。
• 误区三：认为数字陷波器一定优于模拟陷波器。在超高频（>10kHz）场景，模拟陷波器可能更简单可靠，数字实现受限于采样率和计算延迟。

数字陷波器是现代运动控制的主流选择，它统一了二阶、多阶和自适应陷波的实现框架。下表总结了四类陷波器的关键对比：

类型	结构复杂度	频率适应性	相位损失	典型应用	实现平台
二阶陷波	低	固定	小（约-90°@f_notch）	单峰固定谐振	模拟电路/数字
多阶陷波	中	固定多频	叠加（每级-90°）	多模态谐振	数字为主
自适应陷波	高	在线跟踪	与阶数相关	时变谐振	数字DSP/FPGA
数字陷波	中	可编程	取决于阶数	通用伺服驱动	MCU/DSP/FPGA

在实际工程中，选择陷波器类型应遵循以下原则：首先，通过频谱分析明确谐振特性（频率、数量、时变性）；其次，评估控制器计算资源和实时性要求；最后，结合相位裕度预算确定陷波深度和阶数。无论选择哪种类型，都必须经过仿真验证和现场实测的闭环迭代。