3. 速度环设计：速度观测器原理与PI参数整定
速度环是FOC控制中承上启下的关键一环。位置环的输出给速度环，速度环的输出给电流环。如果速度环没调好，位置环再努力也白搭。
我个人做电机控制这些年，踩过最大的坑就是速度反馈不准。你想想看，如果速度都测不准，PI控制器拿什么去调？所以今天咱们先聊速度观测器，再聊参数整定。
3.1 速度观测器：M/T法
M/T法是目前工业上最常用的速度测量方法。它结合了M法（测频法）和T法（测周期法）的优点。
- M法：在固定时间内计数脉冲数。高速时精度高，低速时误差大。
- T法：测量两个脉冲之间的时间。低速时精度高，高速时误差大。
- M/T法：同时测量脉冲数和时间，取长补短。
核心公式：
速度 = (脉冲数 × 分辨率) / 测量时间M/T法在低速时自动切换到T法模式，高速时切换到M法模式。切换阈值一般设在10-100Hz之间，具体看编码器线数。
我在一个伺服项目里用过2500线的编码器，M/T法在1RPM以下还能保持5%以内的误差。但要注意，测量时间不能太短，否则脉冲数太少，量化误差会变大。
| 方法 | 适用转速 | 精度 | 实时性 |
|---|---|---|---|
| M法 | 高速（>1000 RPM） | 高 | 好 |
| T法 | 低速（<100 RPM） | 高 | 差 |
| M/T法 | 全速域 | 较高 | 中等 |
注意：M/T法在极低速（<0.1 RPM）时仍然会有较大波动。如果项目要求零速平稳，建议配合滑模观测器使用。
3.2 速度观测器：滑模观测器
滑模观测器（Sliding Mode Observer）是一种基于模型的速度估算方法。它不需要编码器，通过反电动势来估算转子速度和位置。
说白了，就是利用电机的数学模型，构造一个观测器，让观测器的输出跟随实际系统的输出。当两者出现偏差时，通过滑模控制律把偏差拉回来。
我曾经在一个无传感器FOC项目里用过滑模观测器。刚开始调的时候，高频抖振特别严重，电机嗡嗡响。后来加了低通滤波和边界层处理，才把问题压下去。
我的经验：滑模观测器的增益系数不能太大，否则抖振明显；也不能太小，否则收敛慢。一般从0.5倍的反电动势常数开始调，逐步增大到临界值。
滑模观测器的核心步骤：
- 建立电机数学模型（αβ坐标系下的电压方程）
- 构造滑模面（电流误差）
- 设计滑模控制律（符号函数或饱和函数）
- 提取反电动势信息（通过低通滤波）
- 计算速度和角度（反正切或锁相环）
下面这张图展示了滑模观测器的整体流程：
3.3 速度环PI参数整定
速度环的PI参数整定，我习惯用带宽法。先确定速度环的带宽，再反推PI参数。
速度环的传递函数可以简化为：
G(s) = (Kp * s + Ki) / (J * s² + Kp * s + Ki)其中J是转动惯量，Kp是比例系数，Ki是积分系数。
整定步骤：
- 确定带宽：速度环带宽一般是电流环的1/5到1/10。电流环带宽1000Hz的话，速度环带宽取100-200Hz。
- 计算Kp：Kp = J × ω_c，其中ω_c是带宽角频率。
- 计算Ki：Ki = Kp × ω_c / 4，这个系数保证阻尼比在0.7左右。
- 现场微调：带负载跑一下，看阶跃响应。超调大就降Kp，稳态误差大就升Ki。
参数整定口诀：
- Kp决定响应速度，太大容易振荡
- Ki消除稳态误差，太大容易积分饱和
- 先调Kp到临界振荡，再加Ki消除静差
我曾经在一个大惯量转台项目里，速度环怎么调都振荡。后来发现是转动惯量J估算错了。实际惯量比理论值大了3倍。重新算Kp之后，问题就解决了。
避坑指南：速度环的积分限幅一定要做。我曾经遇到过积分饱和导致速度超调30%的情况。限幅值一般设为额定转矩的80%-120%。
3.4 速度观测器与PI参数的配合
速度观测器的输出质量直接影响PI控制器的效果。如果速度反馈有延迟，PI参数就得往软了调。
我一般这样配合：
- M/T法：延迟小，适合高带宽应用（>200Hz）
- 滑模观测器：有低通滤波延迟，适合中低带宽应用（<100Hz）
- 两者结合：低速用滑模，高速用M/T法，切换时做平滑处理
嗯，这里要注意：切换速度观测器的时候，PI参数最好也跟着切换。低速时用大Ki保证稳态精度，高速时用小Ki防止振荡。
我的习惯：在代码里预留三组PI参数——低速组、中速组、高速组。根据当前速度自动切换，切换点加5%的滞回区，防止频繁跳变。
最后说一句，速度环调好了，位置环才有意义。别急着上位置环，先把速度环跑稳了再说。