2. FOC控制基础：磁场定向控制原理、坐标变换（Clarke/Park）、电机模型与参数
磁场定向控制（Field-Oriented Control，FOC）是现代高性能电机驱动中最核心的控制策略，其本质是将交流电机的强耦合、非线性、多变量系统，通过数学变换解耦为类似直流电机的独立励磁与转矩控制。本章从物理概念出发，逐步推导Clarke与Park变换的数学基础，并建立永磁同步电机（PMSM）在旋转坐标系下的数学模型，为后续基于STM32高级定时器实现FOC算法奠定理论与参数基础。
2.1 磁场定向控制的核心原理
FOC的基本思想是：通过坐标变换，将定子电流矢量分解为沿转子磁场方向的励磁分量（d轴）和垂直于转子磁场方向的转矩分量（q轴）。在同步旋转坐标系下，这两个分量均为直流量，从而可以像控制直流电机一样，分别独立控制磁通和转矩。对于表贴式永磁同步电机（SPMSM），通常采用id=0控制策略，此时电磁转矩与iq成正比，控制线性度极佳。
从物理层面理解，定子三相绕组产生的合成旋转磁场，其幅值和相位由三相电流瞬时值决定。FOC的实质就是实时计算当前转子磁极位置，并据此调整定子电流矢量，使其始终与转子磁场保持最优的90°空间角（或按需超前/滞后）。这种"定向"能力依赖于精确的转子位置反馈，通常由编码器、旋变或无位置传感器观测器提供。
2.2 Clarke变换：三相静止到两相静止
Clarke变换（又称3s/2s变换）将三相静止坐标系（A、B、C）下的电流投影到两相静止坐标系（α、β）上。其数学表达式为：
iα = (2/3) × (ia - 0.5×ib - 0.5×ic)
iβ = (2/3) × (√3/2 × ib - √3/2 × ic)其中系数2/3为等幅值变换（保持变换前后电流幅值不变），若采用等功率变换则系数为√(2/3)。在实际工程中，由于三相电流满足ia+ib+ic=0（星形连接无中线），可简化为：
iα = ia
iβ = (1/√3) × (ia + 2×ib)这种简化形式在STM32固件中非常常见，只需采样两相电流即可重构第三相。Clarke变换的输出iα、iβ仍然是随时间变化的正弦量，但已从三相耦合变为两相正交，为后续Park变换提供了输入。
| 变换类型 | 输入 | 输出 | 系数 | 物理意义 |
|---|---|---|---|---|
| Clarke（等幅值） | ia, ib, ic | iα, iβ | 2/3 | 保持电流幅值不变 |
| Clarke（等功率） | ia, ib, ic | iα, iβ | √(2/3) | 保持功率不变 |
| 简化Clarke | ia, ib | iα, iβ | 1, 1/√3 | 利用三相平衡条件 |
2.3 Park变换：两相静止到两相旋转
Park变换（又称2s/2r变换）将α-β静止坐标系下的交流量变换到d-q旋转坐标系下的直流量。变换矩阵为：
id = iα × cos(θe) + iβ × sin(θe)
iq = -iα × sin(θe) + iβ × cos(θe)其中θe为转子电角度（电角度 = 机械角度 × 极对数p）。Park变换的关键在于θe的获取：有传感器时直接读取编码器/旋变数据；无传感器时通过滑模观测器、扩展卡尔曼滤波或磁链观测器估算。变换后，id和iq在稳态下为恒定直流量，PI控制器可以无静差跟踪。
逆Park变换（将PI输出的Vd、Vq变换回Vα、Vβ）用于生成SVPWM所需的参考电压矢量，其公式为：
Vα = Vd × cos(θe) - Vq × sin(θe)
Vβ = Vd × sin(θe) + Vq × cos(θe)2.4 永磁同步电机数学模型与参数辨识
在d-q旋转坐标系下，PMSM的电压方程和转矩方程如下：
ud = Rs×id + Ld×did/dt - ωe×Lq×iq
uq = Rs×iq + Lq×diq/dt + ωe×(Ld×id + λf)
Te = 1.5×p×[λf×iq + (Ld - Lq)×id×iq]其中Rs为定子电阻，Ld/Lq为d/q轴电感，λf为永磁体磁链，ωe为电角速度，p为极对数。对于表贴式电机（Ld≈Lq），转矩方程简化为Te = 1.5×p×λf×iq，此时id=0控制即为最优。对于内置式电机（Ld<Lq），可利用磁阻转矩（Ld-Lq）×id×iq项，通过负id注入实现最大转矩电流比（MTPA）控制。
电机参数的准确性直接影响FOC性能。常用参数辨识方法包括：
- 静态测量：用万用表测Rs，用电桥测Ld/Lq（需锁定转子）。
- 堵转实验：施加直流电压，记录稳态电流计算Rs和初始磁链。
- 空载反电动势法：拖动电机至恒定转速，测量线电压峰值计算λf = Vem/(ωe×√3)。
- 在线辨识：利用递推最小二乘法（RLS）在运行中实时更新参数，适应温升和磁饱和。
| 参数 | 典型范围（小功率PMSM） | 测量方法 | 对FOC影响 |
|---|---|---|---|
| Rs | 0.5 ~ 5 Ω | 万用表/堵转 | 影响低速稳定性 |
| Ld | 0.1 ~ 10 mH | LCR表/堵转 | 影响电流环带宽 |
| Lq | 0.1 ~ 10 mH | LCR表/堵转 | 影响转矩精度 |
| λf | 0.01 ~ 0.2 Wb | 反电动势法 | 影响转矩常数 |
| 极对数p | 2 ~ 8 | 铭牌/结构 | 影响电角度换算 |
2.5 案例拆解：基于STM32的FOC电流环参数整定
某机器人关节模组采用表贴式PMSM，额定参数：Rs=1.2Ω，Ld=Lq=0.8mH，λf=0.035Wb，极对数p=4，额定电流5A，母线电压24V。目标是实现电流环带宽1kHz，相位裕度45°。
初始现象：直接采用经验PI参数（Kp=5，Ki=100）后，电流波形出现明显振荡，iq超调量达40%，且伴随高频噪声。
分析过程：首先检查电流采样与坐标变换时序，确认无角度延迟。然后计算电机电气时间常数τe = L/R = 0.8mH/1.2Ω ≈ 0.67ms，对应截止频率约240Hz。经验参数Kp=5导致电流环增益过高，与采样延迟（PWM周期50μs）共同引发相位裕度不足。
操作步骤：
- 根据带宽要求计算PI参数：Kp = L×ωc = 0.8e-3 × 2π×1000 ≈ 5.03，Ki = Rs×ωc = 1.2×6283 ≈ 7540。
- 考虑数字控制延迟（1.5个PWM周期），实际带宽需降至约800Hz，修正Kp=4.0，Ki=6000。
- 在STM32中启用电流环前馈补偿：Vq_ff = ωe×Ld×id + ωe×λf，减小PI负担。
- 加入低通滤波器（截止频率5kHz）抑制PWM开关噪声。
结果对比：调整后iq超调量降至8%，调节时间从2ms缩短至0.5ms，电流THD从12%降至3.5%。代价是PI参数对温度敏感，需在-20℃~80℃范围内做参数自适应。
2.6 常见误区与总结复盘
误区一：认为Clarke变换必须使用三相电流采样。实际上利用基尔霍夫电流定律，只需采样两相即可，节省一个ADC通道和采样时间。
误区二：忽略Park变换中的角度补偿。数字控制中，电流采样时刻与PWM更新时刻存在延迟，需根据PWM周期和采样点位置补偿电角度增量Δθe = ωe×T_delay，否则高速时会出现电流相位滞后。
误区三：将电机铭牌参数直接用于控制器设计。铭牌参数是额定工况下的标称值，实际运行时受温度、饱和影响显著，应结合在线辨识或查表修正。
误区四：混淆电角度与机械角度。Park变换必须使用电角度θe = p×θm，若误用机械角度，会导致转矩波动和失控。
总结：FOC的核心在于坐标变换的准确性和电机参数的可靠性。Clarke/Park变换是数学工具，将交流问题转化为直流问题；电机模型是控制对象，参数精度决定控制性能上限。在STM32实现中，应重点关注：变换计算的实时性（使用定点数或快速三角函数）、角度同步（编码器读取与PWM同步）、参数自整定（适应工况变化）。掌握本章内容后，即可进入SVPWM调制和电流环/速度环的工程实现。