3. 振镜的数学模型：机械模型、电气模型、传递函数
搞过振镜控制的人都知道，振镜本质上就是一个高精度的“电机+摆镜”系统。但你要想调好PID，就必须先把它的数学模型摸透。说白了，振镜的模型搞不清楚，PID参数整定就是瞎蒙。我当年刚入行时，就是因为没认真分析机械谐振点，结果调了三天三夜，振镜一直在高频抖动……后来老老实实建模，半天就搞定了。
这一章咱们就把振镜的机械、电气模型拆开揉碎了讲，最后汇总成经典的传递函数形式。你把它吃透了，后面PID参数整定就有了“根”。
3.1 机械模型：弹簧-质量-阻尼系统
振镜的摆镜和转子，说白了就是一个旋转的弹簧-质量-阻尼系统。你想想看，镜片固定在转轴上，轴被电机驱动，但轴本身有扭转刚度，还有轴承摩擦和空气阻尼。所以它的机械运动可以简化成这样：
- J —— 转动惯量（kg·m²），包含镜片和转子
- K —— 扭转刚度（N·m/rad），来自转轴和弹性元件
- B —— 阻尼系数（N·m·s/rad），包含粘性摩擦和涡流阻尼
我给一个典型的二阶振荡模型：
J · θ''(t) + B · θ'(t) + K · θ(t) = T(t)其中 θ(t) 是镜面偏转角，T(t) 是电机施加的转矩。这个方程大家熟吧？就是质量-弹簧-阻尼的旋转版本。嗯，这里要注意：实际振镜的刚度K往往很大，所以机械谐振频率通常几百Hz甚至几千Hz，直接影响到你的控制带宽。
我在项目里遇到过一台振镜，共振点在800Hz附近，阻尼比只有0.02。如果不加陷波滤波，PID一闭环就尖叫。后来我在模型里专门加了一个二阶陷波器，才压住那根尖峰。
3.2 电气模型：电机+驱动
振镜用的电机通常是动圈式或动磁式音圈电机，或者直流力矩电机。电气模型核心就是电枢回路：
U(t) = R · i(t) + L · i'(t) + Ke · θ'(t)- U —— 驱动电压 (V)
- R —— 电枢电阻 (Ω)
- L —— 电枢电感 (H)
- Ke —— 反电动势系数 (V·s/rad)
- i —— 电枢电流 (A)
而电磁转矩与电流成正比：T(t) = Kt · i(t)，Kt 是转矩常数。注意，对于优良的电机设计，Kt ≈ Ke（单位换算后）。
驱动器的模型通常简化为一个比例环节 + 一个延时。但如果你用数字驱动器，还会引入零阶保持器（ZOH）和采样延迟。我以前调过一款高速振镜，驱动器的PWM频率只有20kHz，结果闭环后始终有高频纹波，后来换了个80kHz的驱动器才搞定。所以电气模型的细节会影响你的控制策略。
3.3 传递函数：从电压到角度
把机械和电气模型联立，就能得到振镜的完整传递函数。我来一步步推：
- 从电气方程消去电流，得到电压到转矩的传递：
T(s)/U(s) = Kt / (Ls + R + KtKes/(Js²+Bs+K)) …… 太复杂？ - 实际上，因为振镜电感L很小（通常mH级），电气时间常数远小于机械时间常数，我们可以忽略电感项，简化电气模型为：
T(s) ≈ (Kt/R) · U(s) - (KtKe/R) · sθ(s) - 再代入机械方程，整理后得到：
θ(s) / U(s) = (Kt/R) / [ Js² + (B + KtKe/R) s + K ]这个二阶传递函数的系数很关键：
| 符号 | 含义 | 典型值（小振镜） |
|---|---|---|
| ωn | 无阻尼自然频率 | 200~2000 Hz |
| ζ | 等效阻尼比（包含反电动势阻尼） | 0.1~0.7 |
| Kdc | 直流增益 (Kt/(R·K)) | 0.1~5 rad/V |
3.4 模型参数辨识与工程经验
理论模型再好，也得落地。振镜的实际模型往往比二阶复杂——有柔性模态、有迟滞、有摩擦非线性。但做PID整定时，二阶模型已经足够作为设计基础。记住：
- 先测机械谐振峰，确定 ωn 和 ζ
- 再测直流增益 Kdc（给一个小的阶跃电压，看稳态角度）
- 最后用扫频或阶跃响应验证模型精度
下面我把振镜模型的整体关系画成一张图，方便你对照理解。
有了这张图，你就可以把振镜看成从电压到角度的二阶系统。后面PID整定时，直接用这个模型设计控制器参数，再用闭环响应对比修正，效率高得多。