【FOC算法实践解析】（一）从理论到实现：力矩控制的工程化路径
1. FOC力矩控制的核心思想
我第一次接触FOC算法是在做一个四轴飞行器项目时。当时为了控制无刷电机的力矩输出，尝试了各种方法都不理想，直到发现了这个"黑科技"。FOC（Field Oriented Control，磁场定向控制）的精髓在于：把复杂的正弦波控制问题，转化为简单的线性控制问题。
想象一下，你要控制三个小朋友同时荡秋千。如果让他们按照固定相位差摆动（就像三相电流），直接控制每个人的动作会非常困难。但如果我们换个思路，把观察视角从地面转移到秋千上，问题就简单多了——在秋千的参考系中，摆动变成了简单的来回运动。这就是FOC的核心思想：通过坐标变换，把旋转坐标系下的问题转化为静止坐标系来处理。
具体到工程实现，我们需要解决三个关键问题：
- 如何将三相电流转换为正交坐标系下的两相电流（Clark变换）
- 如何将静止坐标系转换到旋转坐标系（Park变换）
- 如何设计线性控制器（如PID）来调节力矩输出
2. 从三相到两相：Clark变换详解
2.1 为什么要做Clark变换
在实际电机控制中，我们测量到的是三相电流Ia、Ib、Ic。这三个量相互耦合，就像三个纠缠在一起的弹簧，动一个会影响其他两个。Clark变换的作用就是解耦——把三维空间中的非正交坐标系转换为二维正交坐标系。
我常用一个生活类比来解释：假设你有三杯不同浓度的盐水（Ia、Ib、Ic），想知道其中盐和水的总量。Clark变换就像把三杯溶液混合后，分离出纯盐和纯水的量（Iα、Iβ）。虽然信息量减少了，但处理起来简单多了。
数学表达式如下：
# 等幅值变换 Iα = Ia - 0.5*Ib - 0.5*Ic Iβ = (sqrt(3)/2)*Ib - (sqrt(3)/2)*Ic # 等功率变换（更常用） Iα = sqrt(2/3) * (Ia - 0.5*Ib - 0.5*Ic) Iβ = sqrt(2/3) * (sqrt(3)/2*Ib - sqrt(3)/2*Ic)2.2 变换系数的选择
新手最容易困惑的是2/3和sqrt(2/3)这两个系数。我在早期项目中就踩过坑——用了等幅值变换但没注意功率匹配，导致电机出力不足。简单来说：
- 等幅值变换：保证变换前后信号幅值不变
- 等功率变换：保证变换前后功率守恒（推荐）
实测发现，使用等功率变换时，电机运行更平稳，特别是在负载突变时。这是因为功率守恒保持了系统的能量一致性。
3. 从静止到旋转：Park变换实战
3.1 Park变换的物理意义
Clark变换后得到的Iα、Iβ仍然是正弦量（相对于定子）。Park变换的妙处在于：把观察视角从定子转移到转子上。就像坐在旋转木马上看周围的景物——虽然景物在动，但从你的视角看它们是静止的。
数学表达：
# 正变换（αβ→dq） Id = Iα*cosθ + Iβ*sinθ Iq = -Iα*sinθ + Iβ*cosθ # 逆变换（dq→αβ） Iα = Id*cosθ - Iq*sinθ Iβ = Id*sinθ + Iq*cosθ3.2 角度测量的关键细节
θ角度的获取精度直接影响控制效果。我试过三种方案：
- 磁编码器：精度高（12bit以上），但成本较高
- 霍尔传感器：成本低但精度差（适合低速场合）
- 无传感器估算：省硬件但算法复杂
在无人机项目中，我最终选择了AS5048磁编码器。它的14bit分辨率足够应对20000RPM的高速场景。接线时要注意：
- SPI接口要加10-100Ω终端电阻
- 电源要加π型滤波（10μF+0.1μF）
- 信号线要走差分对（如果有）
4. 工程实现中的坑与解决方案
4.1 电流采样设计
电流采样是FOC中最容易出问题的环节。我曾遇到采样值跳变导致电机抖动的bug，最终发现是以下原因：
- 采样时机不对：必须在PWM中点采样（中心对齐模式）
- 硬件滤波不足：建议使用二阶RC滤波（截止频率1-2kHz）
- 地线干扰：要采用星型接地，避免功率地和信号地混接
推荐电路参数：
| 元件 | 参数 | 备注 |
|---|---|---|
| 采样电阻 | 0.005Ω-0.01Ω | 功率要足够 |
| 运放 | INA240 | 共模抑制比高 |
| RC滤波 | 1kΩ+100nF | 截止频率1.6kHz |
4.2 实时性保障技巧
在STM32F4上实现时，最初的控制周期只能做到50μs。通过以下优化提升到20μs：
- 使用硬件除法器：替换软件除法
- 查表法计算三角函数：预存sin/cos值
- DMA传输采样数据：解放CPU资源
- 汇编优化关键函数：特别是Park变换部分
实测表明，控制周期小于50μs时，电机运行噪音明显降低。这是因为电流环的带宽得到了提升。
5. 完整实现流程示例
5.1 硬件连接检查清单
- 电机三相线要接对（UVW相序）
- 电流采样运放输出要校准零点
- 编码器接口要配置正确（SPI/I2C）
- PWM死区时间设置合理（通常500ns-1μs）
5.2 软件初始化步骤
void FOC_Init() { // 1. 外设初始化 PWM_Init(20kHz); // PWM频率 ADC_Init(DMA_Mode); // ADC DMA采样 Encoder_Init(); // 角度传感器 // 2. 控制参数初始化 PID_Init(¤t_pid, 0.5, 0.01, 0); // Iq PID PID_Init(&id_pid, 0.1, 0, 0); // Id PID // 3. 保护功能使能 Enable_Overcurrent_Protection(10A); }5.3 主控制循环
void FOC_Loop() { // 1. 读取反馈量 float Ia = Read_PhaseCurrent(A); float Ib = Read_PhaseCurrent(B); float theta = Read_EncoderAngle(); // 2. Clark变换 Clarke_Transform(Ia, Ib, &Iα, &Iβ); // 3. Park变换 Park_Transform(Iα, Iβ, theta, &Id, &Iq); // 4. 电流环控制 Iq_ref = Get_Torque_Reference(); // 来自速度环 Vq = PID_Update(¤t_pid, Iq_ref - Iq); Vd = PID_Update(&id_pid, 0 - Id); // 通常Id控制为0 // 5. 逆Park变换 Inv_Park_Transform(Vd, Vq, theta, &Vα, &Vβ); // 6. SVPWM生成 SVPWM_Generate(Vα, Vβ); }在调试过程中，建议先用示波器观察Iq的响应曲线。理想的阶跃响应应该是在2-3个控制周期内达到稳态，超调量小于10%。如果出现振荡，可以适当降低PID的比例增益。