Clark和ParkS到VPWM：无人机FOC算法的数学骨架一次讲透

无人机电机控制的背后，是一套优雅的数学变换体系。三相静止坐标系下的正弦电流，经过Clark变换投影到两相静止坐标系，再经过Park变换旋转到两相旋转坐标系，变成直流量进行PID调节;调节后的电压指令再经过逆Park变换和SVPWM调制，重新生成三相占空比信号。这三次变换构成了FOC算法的数学骨架，每一次变换都有明确的物理意义和工程实现要点。

Clark变换：从三相到两相的降维

三相无刷电机的绕组在空间上互差一百二十度，产生的磁场是三个正弦分量的叠加。Clark变换的使命是将这个三相耦合系统解耦为两相正交系统，用α和β两个轴替代原来的A、B、C三相。

变换矩阵的推导基于恒幅值原则：变换前后电压或电流的幅值保持不变。对于三相正弦量，Clark正变换的矩阵形式为：

经过这一变换，A、B、C三相电流的矢量和被映射到αβ平面上，零序分量表示三相之和，在三相平衡系统中为零，计算时可忽略。

代码实现非常直接。读取ADC采样得到的三相电流值，通过上述矩阵运算得到Iα和Iβ。为了减少计算量，可以预先计算好系数，避免浮点除法。对于整数运算平台，需注意系数缩放后的精度管理。

Clark变换的输出Iα和Iβ仍是正弦交流量，频率随电机转速变化。这意味着传统PID调节器无法对正弦量实现无静差跟踪，Park变换的任务正在于此。

Park变换：从交流到直流的旋转

Park变换将静止的αβ坐标系旋转到与转子磁场同步旋转的dq坐标系。旋转角度θ来自位置传感器或观测器的估算值。变换后的Id和Iq成为直流量，Id对应励磁分量，Iq对应转矩分量。

变换矩阵为两个维度，这在廉价单片机上是可观的资源占用。优化策略包括查表法减少三角函数的实时计算，以及仅在角度变化时更新旋转因子。

经过Park变换得到的Id和Iq送入两个独立的PID调节器。速度环的输出作为Iq的给定值，Id的给定值通常设为零(表贴式永磁同步电机)。PID调节器输出的Vd和Vq是旋转坐标系下的电压指令。

逆Park变换：从直流回到交流

电压调节完成后，需要将Vd和Vq从旋转坐标系变换回静止坐标系，得到Vα和Vβ。这就是逆Park变换，矩阵是正变换的转置。

逆Park变换同样需要计算和。这两个值将作为SVPWM模块的输入，决定三相逆变器的开关时序。

## SVPWM占空比计算：从矢量到脉宽

SVPWM是整个FOC算法通向功率硬件的最后一关。它将Vα和Vβ转换为三相占空比，生成逆变器的开关信号。

电压空间矢量扇区判断是第一步。根据Vα和Vβ的符号和比值关系，判断参考矢量落在六个扇区中的哪一个。扇区判断的代码可以写出紧凑的无分支版本，避免条件跳转带来的流水线停顿。

计算相邻有效矢量的作用时间T1和T2。设扇区一内的两个矢量为和，作用时间由下式给出：

每个开关周期的时间总和控制周期。计算得到T1和T2后，剩余时间分配给零矢量。

比较值生成是最后一步。根据扇区号和T1、T2、T0的关系，计算出三个比较寄存器的值。七段式对称调制中，零矢量时间均分，序列中心对称。实际代码中预先为每个扇区定义比较值映射表，运行时根据扇区索引查表得到各相的导通时间。

程序框架与执行时序

完整的FOC控制循环以固定的PWM周期为节拍执行。典型配置为PWM频率十六千赫兹，对应控制周期六十二点五微秒。

PWM定时器的下溢中断是执行入口。中断服务程序首先读取转子位置传感器和三相电流ADC的转换结果。位置数据用于计算和，电流数据用于Clark和Park变换。变换完成后调用电流环PID，输出Vd和Vq。逆Park变换得到Vα和Vβ，经SVPWM生成三相占空比，更新PWM比较寄存器。整个中断服务程序需要在当前PWM周期结束前完成，对于主流Cortex-M4内核的单片机，完整FOC计算通常可在十到二十微秒内完成。

电流采样时刻需要避开PWM开关噪声。通常在PWM周期的中心点触发ADC转换，此时相电流处于稳定状态，采样值最准确。

算法评价与选型指引

Clark-Park-SVPWM这套数学骨架的价值在于解耦。它将非线性、强耦合的三相交流电机控制系统转化为两个独立的线性直流调节通道，使PID这类经典控制理论得以直接应用。

从计算负载来看，Clark和逆Park变换均为乘加运算，开销较小。Park变换涉及三角函数，是计算瓶颈。使用查表法或Cordic算法可以大幅减少计算时间。SVPWM的扇区判断和时间计算包含除法和条件分支，需注意整数运算平台的精度处理。

不同应用场景对算法细节的要求不同。低速大扭矩场景下，Clark和Park变换的精度直接影响低速平稳性，需要高分辨率的电流采样和角度估算。高速弱磁场景下，SVPWM的电压利用率成为限制因素，可能需要从七段式切换到五段式或进入过调制区。高动态响应场景下，Park变换所需的转子角度精度至关重要，角度估算误差会直接导致Id和Iq交叉耦合。

Clark变换让三相变两相，Park变换让交流变直流，SVPWM让矢量变脉宽。这三步变换构成的数学骨架，将物理世界中的旋转磁场映射到数字控制器中的线性方程组，再将计算结果映射回功率开关的通断时序。理解这套骨架，就能看懂任何一套FOC代码的主干结构，也就抓住了无人机电机控制技术的核心脉络。