4. FSM建模与辨识
FSM（快速反射镜）系统的控制性能高度依赖于被控对象的数学模型精度。无论是进行PID整定、前馈补偿设计，还是实施H∞鲁棒控制或自适应控制，一个能够准确反映FSM动态特性的传递函数模型都是控制算法落地的基石。本章将系统讲解从物理机理推导传递函数、到实验测量频率响应、再到利用阶跃响应与正弦扫频数据进行参数拟合的完整工程链路，帮助学员建立从“物理器件”到“数学表达”再到“控制设计”的桥梁。
4.1 传递函数建模：从物理机理到数学表达
FSM的机械结构通常由柔性铰链支撑的反射镜面、驱动执行器（压电陶瓷或音圈电机）以及位置传感器（PSD、电容传感器或电涡流传感器）组成。从控制工程视角看，其核心动态特性可等效为典型的二阶质量-弹簧-阻尼系统。基于牛顿第二定律或拉格朗日方程，可以推导出从驱动电压（或电流）到镜面角位移的传递函数：
G(s) = θ(s) / V(s) = K · ωₙ² / (s² + 2ζωₙs + ωₙ²)其中，K为稳态增益（单位：rad/V或mrad/V），ωₙ为无阻尼自然频率（单位：rad/s），ζ为阻尼比。对于压电驱动的FSM，由于压电陶瓷本身具有电容特性，驱动电路中还存在一个由驱动放大器输出电阻与压电电容构成的一阶电气惯性环节，因此实际模型往往需要扩展为三阶或四阶形式：
G(s) = K / [(s/ωₑ + 1) · (s²/ωₙ² + 2ζs/ωₙ + 1)]式中ωₑ为电气转折频率，通常远高于机械谐振频率（ωₑ > 5ωₙ），但在高频段（>1kHz）对相位裕度有显著影响。此外，FSM结构中还可能存在高阶弯曲模态（如镜面自身的振动模态），这些模态通常出现在2~5倍基频处，需要在建模时决定是否纳入模型阶次。
4.2 频率响应测量：正弦扫频的工程实施
频率响应测量是FSM辨识中最可靠、最直观的方法。其核心思想是：向FSM驱动端施加一系列不同频率的正弦激励信号，测量输出端（位置传感器）的幅值与相位变化，从而获得系统的Bode图。工程实施步骤如下：
- 激励信号设计：采用对数扫频（chirp）或逐点正弦扫描。频率范围通常从1Hz（或0.1倍预期带宽）到5~10倍谐振频率。幅值选择需兼顾信噪比与线性度——FSM的柔性铰链在小角度（<1mrad）时线性度良好，但过大角度会激发非线性刚度。
- 数据采集：使用高精度ADC同步采集输入电压与输出位置信号，采样率至少为最高扫频频率的20倍。每次频率点至少记录10个完整周期，以消除瞬态响应影响。
- 幅相提取：采用相关分析法（与参考正弦/余弦做内积）或FFT方法提取各频率点的幅值比与相位差。相关分析法抗噪性能更优，尤其适用于低信噪比场景。
- 数据后处理：去除趋势项、剔除异常点（如因机械限位或驱动饱和导致的数据），必要时进行多次测量取平均以降低随机噪声影响。
| 参数项 | 推荐设置 | 说明 |
|---|---|---|
| 扫频范围 | 1Hz ~ 5kHz | 覆盖FSM典型谐振频率（50~500Hz）及高频段 |
| 激励幅值 | 0.1~0.5V | 对应镜面角度约0.05~0.25mrad，保证线性区 |
| 采样率 | ≥100kHz | 满足最高频率的奈奎斯特条件并留裕量 |
| 每频点周期数 | 10~20 | 兼顾测量精度与总测试时间 |
| 频率点数 | 50~100（对数均匀） | 低频段密、高频段疏，保证Bode图分辨率 |
4.3 阶跃响应辨识：时域方法的快速估计
阶跃响应法是一种快速、直观的时域辨识方法，适用于现场快速获取FSM的近似模型参数。操作时向FSM施加一个阶跃电压（通常为0.1~0.5V），记录输出位置的时间历程。对于典型的欠阻尼二阶系统（ζ < 1），阶跃响应呈现衰减振荡特征，可从响应曲线中直接提取以下特征量：
- 稳态值θ_ss：响应最终收敛的位置，用于计算增益K = θ_ss / V_step。
- 超调量σ%：峰值与稳态值的偏差百分比，通过公式 ζ = -ln(σ%) / √(π² + ln²(σ%)) 计算阻尼比。
- 峰值时间t_p：从阶跃施加到第一个峰值的时间，通过公式 ωₙ = π / (t_p · √(1-ζ²)) 计算自然频率。
然而，实际FSM系统中存在传感器噪声、驱动放大器饱和、以及可能的死区非线性，导致直接从时域曲线读取的特征量存在误差。因此，阶跃响应法更适合作为初步估计，为后续频域辨识提供合理的初值。更精确的做法是：将阶跃响应数据与理论模型进行非线性最小二乘拟合，同时优化K、ζ、ωₙ三个参数，使模型输出与实际响应的误差平方和最小。
lsqcurvefit函数对完整阶跃响应数据进行拟合，最终收敛到K=1.95mrad/V，ζ=0.38，ωₙ=2780rad/s。拟合残差小于2%，验证了二阶模型的适用性。
4.4 模型参数拟合：频域与联合优化策略
当获得完整的频率响应数据（幅频+相频）后，参数拟合问题转化为一个优化问题：寻找传递函数参数向量θ=[K, ζ, ωₙ, ωₑ, ...]，使得模型的理论频率响应与实际测量值之间的误差最小。常用的拟合方法包括：
- 频域最小二乘：在复平面上最小化模型频响G(jωᵢ;θ)与实测频响H(jωᵢ)之间的加权误差平方和。权重通常取1/|H(jωᵢ)|²，以平衡不同频段的贡献。
- 幅相分离拟合：分别对幅频特性（对数坐标）和相频特性进行拟合，适用于对相位精度要求较高的场合（如高带宽伺服控制）。
- 时频联合优化：同时利用阶跃响应数据和扫频数据，构造综合代价函数，提高参数估计的鲁棒性。该方法尤其适用于存在测量噪声或模型未建模动态的场景。
拟合完成后，必须进行模型验证：将辨识模型与实测数据在时域和频域进行对比，计算拟合优度（如R²或VAF准则）。若模型在谐振峰附近误差较大，可考虑增加模型阶次或引入一个局部谐振修正项（如二阶陷波器/谐振器并联）。
| 拟合方法 | 优点 | 缺点 | 适用场景 |
|---|---|---|---|
| 频域最小二乘 | 直接利用Bode数据，物理意义明确 | 对初值敏感，可能陷入局部最优 | 已有较准确初值时的精修 |
| 幅相分离拟合 | 可独立控制幅值/相位权重 | 可能产生幅值拟合优但相位差的情况 | 对相位裕度要求高的控制系统 |
| 时频联合优化 | 信息利用率高，鲁棒性强 | 计算量大，需合理设置权重 | 噪声较大或模型阶次不确定时 |
| 子空间法（如N4SID） | 无需初值，自动确定阶次 | 对数据质量要求高，结果物理意义弱 | 高阶模型或MIMO系统辨识 |
4.5 案例拆解：某快速反射镜的完整辨识流程
以下通过一个完整的工程案例，展示从实验设计到模型验证的全流程。对象为一款压电驱动的FSM，设计指标为闭环带宽≥500Hz，行程±2mrad。
背景与约束：该FSM安装于光电跟踪转台内部，环境振动噪声较大（主要是转台轴承的微振动，频率集中在50~200Hz）。位置传感器为电容式，分辨率0.1μrad，量程±3mrad。驱动放大器为高压运放（0~150V），输出电流限制±50mA。
实验步骤：
- 预实验：施加0.1V、10Hz正弦信号，确认输出幅值约0.2mrad，线性度良好，无饱和迹象。
- 阶跃响应测试：施加0.2V阶跃，采样率50kHz，记录100ms数据。提取特征量：θ_ss=0.41mrad，σ%=28%，t_p=1.1ms。初步估计：K≈2.05mrad/V，ζ≈0.37，ωₙ≈2950rad/s。
- 正弦扫频测试：频率范围2Hz~5kHz，对数均匀分布60个频点，每频点记录15个周期。激励幅值0.15V（对应约0.3mrad），采样率200kHz。采用相关分析法提取幅相数据。
- 数据预处理：发现2Hz~20Hz频段数据受转台振动干扰明显，幅值波动超过±15%。采用与参考信号同步的带通滤波后，信噪比提升至25dB以上。
- 参数拟合：以阶跃响应估计值为初值，采用频域最小二乘法拟合四阶模型（含电气惯性环节）。优化后参数：K=2.02mrad/V，ζ=0.35，ωₙ=2880rad/s，ωₑ=12000rad/s。
- 模型验证：将辨识模型与实测Bode图对比，在10Hz~2kHz范围内幅值误差<0.5dB，相位误差<3°。另施加0.3V、200Hz正弦信号，模型预测输出与实际输出幅值误差2.1%，相位误差2.8°。
结果与复盘：辨识模型成功用于后续的PID+陷波器控制器设计，实际闭环带宽达到520Hz，相位裕度42°，满足指标要求。复盘发现，若直接使用二阶模型（忽略电气惯性），在1kHz处相位误差将达8°，导致设计的陷波器频率偏移，闭环系统出现轻微振荡。因此，对于带宽要求较高的FSM系统，建议至少采用三阶以上模型。