3. 电机控制数学基础与坐标变换

在三相永磁同步电机（PMSM）或交流感应电机的磁场定向控制（FOC）中，控制器面对的是三个随时间正弦变化、彼此相差120°电角度的相电流 ia、ib、ic。直接在三相静止坐标系里做PI调节，会碰到“交流量跟踪”的难题：给定是直流量（转速、转矩），反馈却是交流量，PI无法做到无静差。坐标变换的本质，就是把三相静止坐标系中的交流量，逐步搬到与转子同步旋转的坐标系里，变成两个直流量 Id、Iq，从而让PI调节器回到它最擅长的直流工作区间。

一、从三相静止到两相静止：Clarke变换

Clarke变换把三相 a-b-c 坐标系投影到两相正交的 α-β 静止坐标系。定义 α 轴与 a 相绕组轴线重合，β 轴超前 α 轴90°电角度。采用等幅值变换（C2000电机库常用形式）时：

Iα = (2/3) * (ia - 0.5*ib - 0.5*ic)
Iβ = (2/3) * (√3/2) * (ib - ic) = (1/√3) * (ib - ic)

若三相电流对称，ia + ib + ic = 0，则 ic = -ia - ib，可进一步化简为：

Iα = ia
Iβ = (1/√3) * ia + (2/√3) * ib

这样只需采样两相电流，第三相由基尔霍夫电流定律推出，既省去一路ADC，也减少了运算量。变换后 Iα、Iβ 仍是交流量，但已从三个耦合量变成两个正交量，为下一步旋转到 d-q 做好了准备。

二、从静止到旋转：Park变换

Park变换把 α-β 坐标系中的量旋转到随转子磁场同步旋转的 d-q 坐标系。d 轴对准转子磁链方向（永磁体N极方向），q 轴超前 d 轴90°。设转子电角度为 θe，则：

Id =  Iα*cos(θe) + Iβ*sin(θe)
Iq = -Iα*sin(θe) + Iβ*cos(θe)

对表贴式PMSM，Ld ≈ Lq，转矩近似正比于 Iq，因此控制目标通常是 Id = 0、Iq 跟踪转矩指令。对内置式PMSM，Ld < Lq，可利用磁阻转矩，令 Id 取负值以提升效率。这就是FOC“两个直流分量分别控制”的物理含义。

三、逆变换：把控制量送回三相

PI调节器输出的是 Vd、Vq 电压指令，必须经过逆Park和逆Clarke变换，才能变成SVPWM模块需要的 Vα、Vβ：

Vα = Vd*cos(θe) - Vq*sin(θe)
Vβ = Vd*sin(θe) + Vq*cos(θe)

逆Clarke（等幅值）则把 Vα、Vβ 还原为三相占空比参考：

Va = Vα
Vb = -0.5*Vα + (√3/2)*Vβ
Vc = -0.5*Vα - (√3/2)*Vβ

注意正变换与逆变换的旋转方向必须一致：若Park用 +θe 旋转，逆Park就必须用 -θe（即上式中的符号关系），否则 Id、Iq 会出现交叉耦合，表现为转矩脉动和电流环振荡。

四、空间矢量概念

空间矢量（Space Vector）把三相量合成一个在复平面上旋转的矢量。以电流为例，定义合成矢量 Is = (2/3)(ia + a·ib + a²·ic)，其中 a = e^(j120°)。在对称正弦稳态下，Is 的幅值恒定、以电角速度 ωe 匀速旋转，其 α、β 分量正是Clarke变换的结果。SVPWM正是利用逆变器8种开关状态对应的8个基本电压矢量，在一个PWM周期内用相邻两个基本矢量和零矢量去逼近目标 Vα、Vβ，从而获得比正弦PWM更高的直流母线利用率（线性调制区可达 Vdc/√3）。

五、C2000上的定点与浮点实现

TI C2000（如F2837x、F28004x）同时具备FPU和TMU（三角函数加速单元），浮点实现最直观：直接用 float 调用 __sinf()、__cosf()，TMU可在数个周期内完成一次正余弦，配合CLA或主中断即可轻松跑完整个FOC链路。以20 kHz电流环为例，单次Park+逆Park约消耗几十个CPU周期，对200 MHz主频而言余量充足。

定点实现则用于无FPU的低端型号或对确定性要求极高的场合。C2000的定点惯例是Q格式，例如Q15表示 [-1, 1) 范围，1.0对应32767。Clarke中的 1/√3 ≈ 0.57735 需量化为 0.57735 × 32768 ≈ 18919（Q15）。Park变换需要查表或CORDIC求 sin/cos，通常用256点或1024点Q15正弦表，配合线性插值降低谐波。关键注意点：

• 溢出保护：Q15乘法结果需右移15位，累加前要评估动态范围，必要时用Q14或Q13留出余量。
• 角度归一化：θe 必须映射到 [0, 2π) 或 [0, 1) 的查表索引，避免索引越界。
• 标幺化：电流、电压统一用标幺值（如基值 Ibase = 10 A、Vbase = 400 V），可让同一套Q格式适配不同功率等级。
• 一致性：正变换与逆变换的旋转方向、等幅值/等功率系数必须成对匹配，否则 Id、Iq 会出现2倍频纹波。

把整条链路串起来看：采样 → Clarke → Park → PI → 逆Park → 逆Clarke → SVPWM，每一步都只是乘加和查表，C2000的硬件恰好为这类运算做了优化。理解每个变换的物理意义和符号约定，比记住公式更重要——因为现场90%的“电流环振荡”问题，最终都追溯到某个角度符号或系数写反了。