3. 多轴电机控制数学基础
在多轴电机控制中，FOC（Field-Oriented Control，磁场定向控制）之所以能把三相交流电机控制得像直流电机一样直观，核心在于一系列坐标变换：把三相静止坐标系下的物理量，映射到随转子旋转的两相坐标系中。C2000 系列（如 F28379D、F280049）的 CLA、TMU 与 FPU 正是为这类变换与环路运算准备的硬件加速单元。本节从数学定义出发，落到 C2000 定点/浮点映射与环路建模。
一、坐标系的约定与 Clarke 变换
先固定参照约定，全文与图示保持一致：三相绕组 A、B、C 空间互差 120°，以 A 相轴线为 α 轴，β 轴超前 α 轴 90°（逆时针为正）。采用等幅值 Clarke 变换（系数 2/3），使变换后矢量幅值与相幅值相等，便于与电流采样值直接比较：
iα = (2/3)·(ia − 0.5·ib − 0.5·ic)
iβ = (2/3)·(√3/2)·(ib − ic) = (ib − ic)/√3三相无中线时 ia+ib+ic=0，可简化为 iα=ia，iβ=(ia+2ib)/√3，省去一次乘法。若采用等功率变换（系数 √(2/3)），则转矩公式需相应调整，两者不可混用——这是初学者最常见的量纲错误来源。
二、Park 变换与转子磁场定向
Park 变换把 αβ 静止系旋转到 dq 旋转系，旋转角为转子电角度 θe：
id = iα·cosθe + iβ·sinθe
iq = −iα·sinθe + iβ·cosθe转子磁场定向的本质是：令 d 轴与转子永磁磁链 ψf 对齐，则 id 控制励磁（表贴式 PMSM 中 id=0 即最大转矩电流比），iq 正比于电磁转矩 Te = 1.5·p·ψf·iq（p 为极对数）。因此只要把 iq 控制住，就等价于控制转矩；把 id 控制为 0，就避免了无功电流带来的铜耗。这就是"交流电机直流化"的物理含义。
反变换（逆 Park）用于把电压指令送回 αβ 系，再经 SVPWM 生成开关信号：
uα = ud·cosθe − uq·sinθe
uβ = ud·sinθe + uq·cosθe三、空间矢量与 SVPWM 的扇区判断
三相逆变器只有 8 种开关状态，对应 6 个有效矢量（幅值 2/3·Udc）与 2 个零矢量。SVPWM 用相邻两有效矢量与零矢量在一个 PWM 周期 Ts 内合成目标电压矢量，其线性调制区最大幅值为 Udc/√3，比正弦调制的 Udc/2 高出约 15.5%。扇区判断可用三个中间变量：
Vref1 = uβ
Vref2 = (√3·uα − uβ)/2
Vref3 = (−√3·uα − uβ)/2
A = Vref1>0 ? 1:0; B = Vref2>0 ? 1:0; C = Vref3>0 ? 1:0
N = A + 2B + 4C // N=1..6 对应扇区 I..VI随后按扇区计算相邻矢量作用时间 T1、T2，并做饱和处理：若 T1+T2>Ts，则按比例缩放 T1、T2，剩余时间分配给零矢量。这一步是防止过调制导致波形畸变的关键。
四、电流环与速度环建模
在 dq 系下，PMSM 的电压方程可写为：
ud = Rs·id + Ld·did/dt − ωe·Lq·iq
uq = Rs·iq + Lq·diq/dt + ωe·(Ld·id + ψf)其中 ωe·Lq·iq 与 ωe·ψf 是交叉耦合与反电势项。工程上常做前馈解耦：把 ωe·Lq·iq 与 ωe·(Ld·id+ψf) 直接加到 PI 输出上，使被控对象近似为一阶惯性环节 1/(Rs+sL)。此时电流环 PI 可按"零极点对消"整定：
Kp = L·ωc
Ki = Rs·ωc
ωc ≈ 2π·fc，fc 取开关频率的 1/10 ~ 1/20例如 Ld=Lq=0.5mH、Rs=0.5Ω、fc=1kHz，则 Kp=0.5e-3·6280≈3.14，Ki=0.5·6280≈3140。速度环把电流环近似为 1 阶小惯性环节，按对称最优或 PI 整定，带宽取电流环的 1/5~1/10。多轴系统中，每个轴的电流环独立运行，速度环可共享位置指令，但要注意各轴 θe 的独立采样与同步。
五、C2000 定点与浮点映射
F28379D 的 FPU32 可直接用 float 完成 Clarke/Park，配合 TMU 的 __sin、__cos、__atan2 指令，单次 Park 变换约 10~20 个周期。若用 IQmath 定点（Q15 电流、Q24 角度），需注意：
- Q15 表示范围 ±1，电流采样需先归一化到 ±1（如 ±10A 对应 ±1）；
- sin/cos 查表或 IQsin 输出 Q15，乘法后需右移 15 位并做饱和；
- 积分器用 Q24 或 32 位累加，防止小信号被截断；
- θe 用 Q24 表示 0~2π，累加 ωe·Ts 时自然回绕。
六、多轴同步与执行时序
多轴 FOC 的实时性依赖"采样—计算—输出"在一个 PWM 周期内完成。典型配置：ePWM 在计数器零点触发 ADC 对 ia、ib 采样，ADC 中断中执行 Clarke→Park→双环→逆 Park→SVPWM，结果在下一个周期生效。若三轴共用一颗 F28379D，可把电流环放入 CLA 并行执行，CPU 只做速度环与通信，从而把单轴电流环耗时压到 1~2μs 量级。判断闭环是否健康，可观察：iq 跟随 iq* 的阶跃上升时间是否接近设计带宽、id 在稳态是否接近 0、相电流 THD 是否在 5% 以内。