3. 坐标系与变换

在关节电机的FOC控制中,电机三相绕组中流动的电流是随时间快速变化的正弦量。如果直接在静止三相坐标系下设计控制器,会面临三个耦合、时变、非线性的电流分量,控制难度极大。FOC的核心思想,就是通过一系列坐标变换,把三相交流量“搬到”一个随转子一起旋转的坐标系里,使交流量变成直流量,从而用简单的PI调节器就能实现精准的力矩控制。本节围绕Clarke变换、Park变换、反变换以及旋转坐标系的物理意义展开。

一、三个坐标系与变换链

FOC中涉及三个坐标系:

  • 三相静止坐标系(abc):三个轴互差120°,电流为三相正弦量,物理上对应真实绕组。
  • 两相静止坐标系(αβ):α轴与a轴重合,β轴超前90°,电流仍为交流量,但已从三轴降为两轴。
  • 两相旋转坐标系(dq):d轴对准转子磁链方向,q轴超前90°,随转子同步旋转,电流为直流量。

从abc到αβ用Clarke变换,从αβ到dq用Park变换,控制完成后再经Park反变换和Clarke反变换回到三相,形成完整的信号链。

FOC 坐标系变换信号链 三相静止 ia, ib, ic 交流量 Clarke 两相静止 iα, iβ 交流量 Park 两相旋转 id, iq 直流量 PI 调节 ud, uq 直流量控制 反Park uα, uβ 两相静止电压 反Clarke ua, ub, uc 三相电压指令 SVPWM 驱动逆变器 转子位置 θ 编码器/观测器

二、Clarke变换:从三轴到两轴

Clarke变换的作用是把三相电流投影到两相静止坐标系。对于对称三相系统,ia+ib+ic=0,因此只有两个独立变量。等幅值Clarke变换公式为:

iα = ia
iβ = (ia + 2·ib) / √3

// 矩阵形式(等幅值)
[iα]   [ 1      0       0    ] [ia]
[iβ] = [ 1/√3   2/√3    0    ] [ib]
                               [ic]

变换后,iα和iβ仍然是随时间变化的正弦量,但已经从三个耦合量变成两个正交分量。这一步的物理意义是:把三相绕组产生的合成磁动势,用一个等效的两相正交绕组来表示,磁动势大小和方向完全不变。

三、Park变换:从静止到旋转

Park变换把αβ坐标系中的交流量旋转到随转子同步旋转的dq坐标系。设转子电角度为θe,则:

id =  iα·cosθe + iβ·sinθe
iq = -iα·sinθe + iβ·cosθe

// 反Park变换
iα = id·cosθe - iq·sinθe
iβ = id·sinθe + iq·cosθe

Park变换的关键在于θe必须准确。θe来自编码器、霍尔传感器或无位置观测器。如果θe有偏差,id和iq就会耦合,力矩输出会波动,效率下降。

旋转坐标系的物理意义:想象你站在转子上,和转子一起旋转。此时定子电流产生的旋转磁动势相对于你来说是静止的。d轴方向是转子磁链方向,q轴方向是力矩方向。id控制磁场强弱(对表贴式PMSM,id通常给定为0),iq直接对应力矩大小。这样,交流电机就像直流电机一样,用两个直流量分别控制磁场和力矩。

四、反变换:从控制量回到三相

PI调节器输出ud和uq后,需要经过反Park变换回到αβ,再经反Clarke变换回到abc,最后送入SVPWM生成驱动信号。反Clarke变换(等幅值)为:

ua = uα
ub = -0.5·uα + (√3/2)·uβ
uc = -0.5·uα - (√3/2)·uβ

整个变换链的时序必须与PWM周期严格同步。通常在每个PWM周期中点采样电流,然后依次执行Clarke、Park、PI、反Park、反Clarke、SVPWM更新。如果时序错乱,θe与电流采样不对应,dq电流会出现纹波。

五、变换参数与常见误区

项目 正确做法 常见误区
Clarke变换系数 等幅值:2/3系数;等功率:√(2/3) 混用等幅值和等功率,导致iq标定错误
θe对齐 编码器零位与d轴对齐,校准后使用 未做零位校准,id/iq耦合,力矩波动
id给定 表贴式PMSM:id*=0;内置式:可弱磁 表贴式电机给id≠0,白白发热不出力
采样时刻 PWM中点采样,避开开关噪声 在开关瞬间采样,电流尖峰进入控制环
角度补偿 考虑采样到输出的延迟,补偿θe 高速时忽略延迟,dq电流相位滞后

六、案例:关节电机低速力矩控制

某协作关节电机采用表贴式PMSM,编码器分辨率19位。在低速大力矩场景下,若Park变换的θe存在约5°电角度偏差,iq实际值会比指令值低约0.4%,同时产生约8.7%的id分量。这会导致电机额外发热,力矩线性度变差。通过编码器零位校准和采样延迟补偿后,id被控制在接近0,iq跟随误差小于1%,力矩输出平稳。

调试建议:上电后先做编码器零位校准,再验证Clarke/Park变换。可以在线观察id和iq波形:给定iq阶跃,id应保持接近0;若id随iq变化,说明θe有偏差或变换系数不一致。
注意:Park变换和反Park变换必须使用同一个θe。如果在不同中断或不同时刻更新θe,会造成变换不一致,dq电流出现周期性波动。建议在电流环中断中统一锁存θe。

总结来说,Clarke变换完成三轴到两轴的降维,Park变换完成静止到旋转的坐标旋转,反变换把控制量还原为三相电压。旋转坐标系的物理意义在于:把交流电机等效为直流电机,用id和iq两个直流量分别控制磁场和力矩。理解这条变换链,是掌握FOC电流环设计和调试的基础。