2、FOC控制基础：磁场定向控制原理、坐标变换（Clarke/Park）、SVPWM调制
磁场定向控制（Field Oriented Control，FOC）是现代高性能永磁同步电机（PMSM）驱动中最主流的控制策略。其核心思想是：通过数学变换，将原本在静止三相坐标系下强耦合、非线性的交流电机模型，解耦为旋转坐标系下类似直流电机的独立控制模型，从而实现对电机转矩和磁通的独立、精准控制。对于使用AS5048磁编码器的系统而言，FOC的坐标变换精度直接依赖于转子位置反馈的准确性——AS5048提供的14位角度数据，正是Park变换中所需的角度θ的物理来源。本章将深入剖析FOC的数学原理、坐标变换的工程实现以及SVPWM调制策略，为后续章节中AS5048与FOC算法融合打下坚实基础。
2.1 磁场定向控制的核心原理
FOC的出发点在于对电机数学模型的重构。三相PMSM在静止abc坐标系下的电压方程和磁链方程呈现强耦合特性，且转矩与电流呈非线性关系。若直接采用PID控制，难以在全速度范围内获得良好的动态性能。FOC通过两次坐标变换，将定子电流矢量分解为两个正交分量：励磁分量（Id）和转矩分量（Iq）。在转子磁场定向（即d轴与转子永磁体磁链方向对齐）的前提下，电磁转矩可简化为：
Te = 1.5 * p * [Ψf * Iq + (Ld - Lq) * Id * Iq]对于表贴式PMSM（Ld≈Lq），转矩表达式进一步简化为Te = 1.5 * p * Ψf * Iq，即转矩仅与Iq成正比。此时，电机控制问题被完全解耦为：控制Id=0（或按MTPA策略给定）以管理磁通，控制Iq以管理转矩。这种解耦使得控制器设计可以借鉴直流电机的成熟经验，PI调节器即可获得优异的动态响应。
2.2 坐标变换：从Clarke到Park的数学桥梁
坐标变换是FOC的数学基础，分为两个阶段：Clarke变换（3s/2s）将三相静止坐标系（abc）变换为两相静止坐标系（αβ），Park变换（2s/2r）再将αβ坐标系变换为两相旋转坐标系（dq）。
Clarke变换（等幅值变换）的数学表达式为：
Iα = Ia
Iβ = (Ia + 2*Ib) / √3实际工程中，由于电机中性点通常不引出，常采用双相采样法，仅需采样Ia和Ib，Ic由基尔霍夫定律计算（Ic = -Ia - Ib）。Park变换的表达式为：
Id = Iα * cos(θ) + Iβ * sin(θ)
Iq = -Iα * sin(θ) + Iβ * cos(θ)其中θ为转子电角度，由AS5048输出的机械角度乘以电机极对数得到。逆Park变换（用于SVPWM输入）表达式为：
Vα = Vd * cos(θ) - Vq * sin(θ)
Vβ = Vd * sin(θ) + Vq * cos(θ)| 变换类型 | 输入 | 输出 | 关键参数 | 工程实现要点 |
|---|---|---|---|---|
| Clarke变换 | Ia, Ib（Ic计算） | Iα, Iβ | 等幅值/等功率系数 | 电流采样需与PWM中心对齐，避免开关噪声 |
| Park变换 | Iα, Iβ, θ | Id, Iq | θ为电角度 | θ需进行象限处理，使用CORDIC或查表计算三角函数 |
| 逆Park变换 | Vd, Vq, θ | Vα, Vβ | 电压限制（过调制） | 输出限幅需考虑母线电压利用率 |
2.3 SVPWM调制：电压矢量的空间合成
空间矢量脉宽调制（SVPWM）是FOC中逆变器控制的核心算法。与传统的SPWM相比，SVPWM具有更高的直流母线电压利用率（提升约15.47%）和更低的谐波含量。其基本原理是：将逆变器8种开关状态（6个有效矢量V1~V6和2个零矢量V0、V7）映射到αβ平面，形成六个扇区。任一参考电压矢量Vref均可由所在扇区的两个相邻有效矢量和零矢量按伏秒平衡原理合成。
SVPWM实现步骤：
- 扇区判断：根据Vα和Vβ的符号及大小关系，确定Vref所在扇区（I~VI）。
- 作用时间计算：计算相邻有效矢量作用时间T1、T2及零矢量时间T0 = Ts - T1 - T2（Ts为PWM周期）。
- 占空比分配：采用七段式或五段式发波模式，将时间分配给三相桥臂，生成对称PWM波形。
// 扇区判断伪代码（基于Vα, Vβ）
if (Vβ > 0) {
if (Vα > 0) { sector = (Vα > Vβ/√3) ? 1 : 2; }
else { sector = (|Vα| < Vβ/√3) ? 2 : 3; }
} else {
if (Vα < 0) { sector = (|Vα| > |Vβ|/√3) ? 4 : 5; }
else { sector = (Vα > |Vβ|/√3) ? 6 : 5; }
}2.4 案例拆解：AS5048角度延迟对FOC性能的影响
某机器人关节模组采用AS5048+STM32G4方案，PWM频率20kHz，SPI通信速率10MHz。调试中发现电机在3000rpm以上时出现明显噪声和转矩脉动，且电流波形出现低频振荡。
初步排查：通过逻辑分析仪抓取SPI时序，发现AS5048的角度数据在每次PWM中断中读取，但读取时刻位于PWM周期开始处，而电流采样位于PWM中心对齐处，两者之间存在约25μs的时间差。在3000rpm（电频率=3000/60*极对数4=200Hz）下，25μs对应电角度偏移为200*360*25e-6 = 1.8°。虽然单看角度误差不大，但结合电流环PI调节器的相位裕度，该延迟导致dq轴耦合加剧。
解决方案：将AS5048的SPI读取移至PWM定时器上溢中断的入口处，并采用DMA方式传输，确保角度数据与电流采样时刻对齐。同时，在Park变换前增加角度补偿：θ_comp = θ_raw + ω * T_delay，其中T_delay为实测延迟时间。修改后，电机在5000rpm下运行平稳，噪声降低约12dB，转矩脉动从±8%降至±2%。
复盘经验：FOC系统的性能瓶颈往往不在算法本身，而在于传感器数据的时间同步性。AS5048虽然精度高，但若读取时序不当，其优势会被系统延迟抵消。建议在设计初期就明确PWM中断、ADC采样、SPI读取的执行顺序，并预留角度补偿接口。
2.5 常见误区与总结复盘
- 误区一：认为AS5048的14位精度足以保证FOC性能，忽略角度更新率。实际上，对于高速电机，角度更新率比分辨率更关键。
- 误区二：Clarke变换中直接使用Ia、Ib、Ic三路采样，增加成本且无必要。双相采样+计算Ic是更优方案。
- 误区三：SVPWM扇区判断使用浮点运算，导致中断耗时过长。应使用定点运算或查表法优化。
- 误区四：忽略逆变器死区时间对SVPWM波形的影响。死区会导致输出电压畸变，需加入死区补偿。