如果你拆开高端自动门的控制器，核心就是一片ARM Cortex-M4或M7的MCU在跑FOC（Field-Oriented Control，磁场定向控制）矢量控制算法。它把电机的三相交流电流虚拟为两个正交的直流分量——一个控制力矩（q轴）、一个控制磁场（d轴）——从而实现了对无刷直流电机"像直流电机一样简单"的精确控制。本文从数学到工程实现，把FOC算法完整拆解。
一、为什么自动门需要FOC
最原始的BLDC控制方式是"六步换相"（Six-Step Commutation）——根据霍尔传感器的位置信号、每60°电角度切换一次通电相、形成六个方向的定子磁场吸引转子。六步换相简单、便宜——但有一个致命问题：力矩脉动。在每一步换相的瞬间电流不连续、力矩跳变→门体在低速运行时会有明显的"一格一格"的顿挫感→门体运行不平顺。
FOC把六步离散换相变成连续平滑的正弦电流驱动——力矩完全平稳、运行零顿挫、低速控制极其精确（可以精确到1mm位置控制）。对自动门来说，FOC的平滑控制让：①门体运行像坐电梯一样平稳毫无顿挫感；②低速关门阶段速度可控极其精确（不会"拍"上）；③遇阻检测更加灵敏——因为力矩反馈是平滑连续的。
二、FOC的数学三变换
FOC算法的核心是三个坐标变换：
第一步：Clarke变换（三相静止→两相静止）
把三相电流 Ia、Ib、Ic 变换为两相正交的电流 Iα、Iβ（α轴与A相轴线重合，β轴超前90°）。对于平衡三相系统（Ia+Ib+Ic=0），Clarke变换的矩阵形式为：Iα = Ia, Iβ = (Ia + 2·Ib) / √3。实际代码中通常只采样两相电流（Ia和Ib），Ic通过Ia+Ib+Ic=0推算。
第二步：Park变换（两相静止→两相旋转）
把静止αβ坐标系下的Iα、Iβ变换到随转子磁场同步旋转的dq坐标系（d轴对准转子磁极N极，q轴超前90°）：Id = Iα·cos(θ) + Iβ·sin(θ), Iq = -Iα·sin(θ) + Iβ·cos(θ)。θ是转子电角度（从编码器或霍尔传感器或观测器获取）。经过Park变换后，Id和Iq变成了"直流分量"——不论电机转速多快，Id和Iq在稳态下是恒定的——这就是FOC的精髓。
第三步：反Park变换（两相旋转→两相静止）
PI控制器输出的Vd和Vq需要反变换回αβ坐标系才能生成PWM：Vα = Vd·cos(θ) - Vq·sin(θ), Vβ = Vd·sin(θ) + Vq·cos(θ)。
三、SVPWM——空间矢量脉宽调制
有了Vα和Vβ后，用SVPWM（Space Vector PWM）生成六路MOSFET的开关信号。SVPWM的基本思想是把三相逆变器的8种开关状态（6个有效矢量+2个零矢量）组合成任意方向和任意大小的电压矢量。相比简单的SPWM（正弦PWM），SVPWM的优势是：①母线电压利用率高15%（同样母线电压能输出更高的线电压）；②谐波含量更低（电机发热更少、运行更安静）。
MCU实现流程：Vα,Vβ→判断所在扇区（六个60°扇区之一）→计算两个相邻有效矢量的作用时间T1和T2→剩余时间T0分配给零矢量（零矢量通常使用对称分布以减少开关损耗）→生成三路互补带死区的PWM。整个SVPWM计算在现代MCU上只需要几个微秒（用硬件数学加速器甚至不到1μs），然后通过高级定时器输出到MOSFET栅极驱动。
四、电流环PI参数整定
FOC有两个PI控制环：
- 电流环（内环）：带宽通常设计在1-5kHz——非常高的带宽（是PWM频率的1/20~1/5）。电流环的PI参数可以通过"零极点对消法"推导：Ki/Kp = R/L（电机的电阻/电感比），Kp = 电流环目标带宽×L
- 速度环（外环）：带宽通常在50-200Hz——比电流环低很多，因为机械系统的惯性远大于电气系统
自动门的FOC通常运行在速度模式——给定目标速度曲线（S曲线或梯形曲线）→速度环输出Iq_ref→电流环跟踪。Id_ref通常设为零（Id=0控制策略，即转子磁场全部用于产生转矩——对于表贴式PMSM电机这是最优策略）。
五、自动门FOC的特殊优化：MTPA
对于内置式永磁同步电机（IPMSM，Ld≠Lq），Id=0不是最优策略——因为它没有利用磁阻转矩分量。MTPA（Maximum Torque Per Ampere，每安培最大转矩）策略同时利用永磁转矩和磁阻转矩，在相同电流下可输出更多力矩。IPMSM电机在第d轴施加负电流（-Id）会叠加磁阻转矩→总转矩增大。这在重门扇（>150kg）的自动门中特别有意义——用更小的电流带更重的门。
MTPA的Id-Iq关系（经过推导）为：Id = (ψm - sqrt(ψm² + 8·(Ld-Lq)²·Is²)) / (4·(Ld-Lq))。式中ψm是永磁体磁链，Is是总电流幅值。这个公式看着复杂但在MCU中只是一个代数计算，执行时间约几个微秒。
从六步换相到FOC是自动门控制的一次质变——门体运行的平顺性、安静性、可靠性，最终都来自控制算法的进化。
