第四章 电机控制算法基础：FOC矢量控制原理、PID参数整定、速度环与电流环设计
各位同学，大家好。这一章我们聊聊电机控制的核心——FOC矢量控制。说实话，很多初学者一听到FOC就觉得头大，什么Clark变换、Park变换，一堆数学公式。其实没那么玄乎，说白了就是一套让电机转得又稳又顺的“翻译工具”。
我刚开始做电机驱动时，用的是最基础的六步换向法，电机嗡嗡响，扭矩还忽大忽小。后来接触FOC，才明白什么叫“丝般顺滑”。今天我就把这块掰开了讲，结合我踩过的坑，帮你把FOC的原理和PID整定一次搞明白。
4.1 FOC矢量控制的核心思想
FOC，全称Field-Oriented Control，磁场定向控制。它的目标是什么？让电机像直流电机一样好控制。
直流电机你给它一个电压，它就转一个速度，线性关系，简单粗暴。但交流电机（比如永磁同步电机PMSM）不一样，它的磁场和电流是耦合在一起的，你给个电压，它不一定按你想要的来。
FOC的思路就是：把交流电机的三相电流，通过坐标变换，分解成两个独立的直流分量——一个控制磁通（d轴），一个控制转矩（q轴）。 这样，控制交流电机就跟控制直流电机一样简单了。
核心公式（理解即可）：
Clark变换：将三相静止坐标系（a,b,c）变换到两相静止坐标系（α,β）。
Park变换：将两相静止坐标系（α,β）变换到两相旋转坐标系（d,q）。
反Park变换：反过来，把d,q电压变回α,β电压，用于生成PWM。
嗯，这里要注意：d轴电流控制的是磁场，q轴电流控制的是转矩。 对于表贴式永磁同步电机（SPMSM），我们通常让Id=0，只控制Iq，这样效率最高。我在项目中遇到过有人把Id和Iq搞反了，结果电机发热严重，扭矩还出不来。
4.2 FOC的控制流程
一个完整的FOC控制环路，大概长这样：
- 采样三相电流：通过两个电流传感器（比如采样电阻或霍尔传感器）采集Ia、Ib，Ic通过Ia+Ib+Ic=0算出。
- Clark变换：把Ia、Ib、Ic变成Iα、Iβ。
- Park变换：利用转子位置角θ，把Iα、Iβ变成Id、Iq。
- 电流环PI控制：分别对Id和Iq进行PI调节，输出Vd_ref和Vq_ref。
- 反Park变换：把Vd_ref、Vq_ref变回Vα、Vβ。
- SVPWM生成：根据Vα、Vβ计算三相占空比，输出PWM波驱动逆变器。
你看，整个流程就是“采样→变换→控制→反变换→输出”。我刚开始写代码时，总在变换矩阵的符号上出错，后来养成了一个习惯：每次写完变换，先用MATLAB或Python仿真验证一下，再下到板子里。 这习惯救了我好几次。
4.3 PID参数整定——从理论到实战
PID，比例-积分-微分。在电机控制里，我们最常用的是PI，D项用得少，因为电流环的噪声比较大，微分容易放大噪声。
我个人习惯把PID整定分成两步走：先调电流环，再调速度环。
4.3.1 电流环PI整定
电流环是内环，响应速度要快。一般带宽设置在1kHz到2kHz左右。
整定方法：
- 先调比例P：从小到大加P，直到电流响应出现轻微振荡，然后回调到振荡幅度的60%~70%。
- 再加积分I：I的作用是消除静差。从0开始慢慢加，直到稳态误差消失，但不要加太多，否则会超调。
我的经验： 电流环的P和I，可以用公式估算一个初始值：
P ≈ L * 带宽，I ≈ R * 带宽
其中L是电机电感，R是相电阻。这个公式能帮你快速找到起点，省得盲目试。
我曾经在一个项目中，电机电感只有几十微亨，P给大了直接电流震荡，电机啸叫。后来把P降下来，I也调小，才稳定下来。所以，参数整定一定要结合硬件特性，别死套公式。
4.3.2 速度环PI整定
速度环是外环，响应比电流环慢。带宽一般设在电流环的1/5到1/10，比如100Hz~200Hz。
整定步骤：
- 先让电流环稳定工作。
- 给速度环一个阶跃指令（比如从0转到1000rpm）。
- 调P：让速度响应快，但不要超调太多。
- 调I：消除稳态误差，让速度最终稳定在目标值。
避坑指南： 我曾经在调速度环时，I给得太大，结果电机在低速时出现“爬行”现象——速度忽快忽慢。后来发现是积分饱和了。解决办法：加积分限幅，或者用抗积分饱和算法。
4.4 速度环与电流环的配合设计
这两个环的关系，就像“将军”和“士兵”。速度环是将军，它说“我要加速到1000rpm”；电流环是士兵，它负责执行，输出对应的电流。
设计要点：
- 电流环的采样频率要快：一般10kHz~20kHz，甚至更高。速度环可以慢一些，1kHz~2kHz就够了。
- 两个环的带宽要拉开差距：速度环带宽是电流环的1/5~1/10，避免相互干扰。
- 注意时序：在中断里，先执行电流环，再执行速度环。因为电流环需要最新的电流数据。
我见过有人把两个环放在同一个中断里，采样频率一样，结果速度环的噪声全耦合到电流环里，电机抖得厉害。后来把速度环放到一个慢速定时器里，问题就解决了。
4.5 实战中的常见问题与调试技巧
| 问题现象 | 可能原因 | 解决办法 |
|---|---|---|
| 电机啸叫，电流波形乱 | 电流环P太大，或采样噪声大 | 降低P，增加采样滤波 |
| 速度超调大，来回震荡 | 速度环P太大，或I太大 | 降低P，减小I，或加微分D |
| 低速时电机抖动 | 编码器分辨率不够，或电流环带宽太低 | 提高编码器分辨率，或增加电流环带宽 |
| 电机带载后速度掉下来 | 速度环I太小，或电流限幅太小 | 增大I，或提高电流限幅值 |
调试口诀（我自己总结的）：
先内后外，先P后I。
P给响应，I消静差。
带宽拉开，噪声滤掉。
限幅加好，饱和不闹。
4.6 小结
这一章我们讲了FOC的核心原理、控制流程、PID整定方法，以及速度环和电流环的配合设计。说白了，FOC就是把交流电机“伪装”成直流电机来控制，而PID就是让这个“伪装”更精准的工具。
下一章，我们会把这些算法真正写到代码里，结合CANopenNode，实现一个完整的电机控制节点。到时候你会看到，理论怎么落地成代码，代码怎么跑在硬件上。
好，今天就到这里。有什么问题，欢迎在课程群里交流。咱们下章见。