FOC 磁场定向控制 — 三环架构、Clarke/Park 推导、MTPA 凸极最优角、弱磁扩速、PI 极点消零整定

控制采样L4别名 FOC · Field Oriented Control · 磁场定向控制 · Vector Control · 矢量控制 · Park transform · Clarke transform · dq0 · id-iq decoupling · flux weakening · 弱磁 · MTPA · Maximum Torque per Ampere · PMSM 控制 · 电流环 · 速度环 · 位置环 · 更新

本质与导读

本质 FOC 的物理本质是一个坐标变换技巧:把转子坐标系里本来是恒定量的磁链,在定子坐标系里看变成周期性交变量;Clarke+Park 把定子电流"跟着转子转",让耦合的时变非线性方程在旋转 dq 帧里退化成两路独立的 RL 电路——每路各跑一个 PI,这才是 "简单控制" 的工程根因。代价:dq 坐标原点就是转子 d 轴,位置误差直接变成转矩误差,encoder/resolver 同步精度是全链硬约束。

主线坐标:第 6 站 · 电机 + 控制采样 · ↑ 全景主线

1. 三相耦合模型 — 解耦必要性的物理根因

FOC 一切推导的起点是三相电机方程本身耦合、时变、非线性,无法直接用固定系数 PI 控制。三相 PMSM 定子电压方程(矢量形式):

三相磁链包含永磁体磁链 psif 和绕组自感互感,其中永磁分量随电角度 theta 周期变化:

对于 IPMSM(内置式,Ld 不等于 Lq),自感 Laa 本身随 theta 周期变化(凸极效应)。结果:系数矩阵是转角的函数,方程是时变非线性的,无法用固定系数 PI 控制。

解耦思路是选与转子同步旋转的坐标系(dq 帧)。在 dq 帧里,稳态时磁链 psid = Ld id + psifpsiq = Lq iq 均为常数,电压方程退化为带交叉耦合项的两路一阶线性系统——加前馈项消掉耦合即可独立 PI 控制。

2. Clarke 变换 — 全源推导与归一化选择(Gotcha 1 高危)

Clarke 变换把三相 ABC 静止坐标系投影到两相正交 alpha-beta 静止坐标系,减少控制变量维度。推导从三相对称条件出发:ia + ib + ic = 0(无零序分量时),投影要求 alpha 轴与 a 轴对齐,beta 轴超前 alpha 轴 90 度。

采用幅值不变约定(工业控制标准,2/3 系数):

幅值不变的含义:三相对称时 ia = Im cos(theta),变换后 ialpha = Im cos(theta)(幅值 Im 不变)。此约定下转矩公式带 3/2 系数:Te = (3/2) p (psid iq - psiq id)

功率不变约定(sqrt(2/3) 系数):矩阵前乘 sqrt(2/3) 替代 2/3,保持三相功率等于 alpha-beta 功率(P = valpha ialpha + vbeta ibeta),转矩公式不带 3/2。

两套约定混用是量产高危错误(见 §10 G1)——本页与 三相变换页 §2 及 电机控制 §9 的 SSOT 一致,全部采用幅值不变约定(2/3);TI SPRABS4、ST、Infineon EV 电机库同此约定。

3. Park 变换 — 旋转坐标系推导

Park 变换把静止 alpha-beta 坐标系旋转到与转子同步的 dq 坐标系,旋转角 theta_e(电角度):

反 Park(dq 到 alpha-beta,用于把 PI 输出的 Vd/Vq 还原成 SVPWM 输入):

旋转矩阵是正交矩阵:逆矩阵等于转置矩阵(cos 保持、sin 变号)。

3.1 dq 帧稳态方程

在 dq 旋转坐标系中,PMSM 稳态电压方程含 omega_e 引起的交叉耦合项:

其中 -omega_e Lq iqomega_e Ld id 是 dq 交叉耦合项(电流环 PI 输出叠加前馈补偿这两项,才能真正解耦)。转矩方程:

第一项 psif iq 是永磁转矩,第二项 (Ld - Lq) id iq 是磁阻转矩(IPMSM 中 Ld < Lq,故 id < 0 时磁阻转矩为正贡献)。

4. FOC 三环嵌套架构

FOC 不是单个 PI,而是三个嵌套环:位置环(外/慢)、速度环(中)、电流环(内/快),带宽逐层降约 10 倍,保证内环动态远快于外环。下图把前向信号链(指令到 PI 到坐标反变换到 SVPWM 到逆变器到电机)与反馈回环(相电流采样到 Clarke/Park 到 dq 反馈;转子位置 theta/速度 omega)画在一起。

FOC 控制环框图 — 速度环+电流 dq 双环 PI,Clarke/Park 坐标变换(需转子位置 theta),反 Park→SVPWM→逆变器→PMSM,d 轴磁通/q 轴转矩解耦

4.1 电流环(最内、最快)

电流环直接控制 dq 电流并输出电压指令,是三环里带宽最高的一环(典型 1-2 kHz,受 fsw/5 约束)。输入 idref/iqref,反馈经 Clarke+Park 得到 id/iq,输出 Vd/Vq 经反 Park + SVPWM 成 PWM。d/q 各跑一路独立 PI,且必须叠加解耦前馈(消掉 §3.1 的交叉耦合与 BEMF):

4.2 速度环(中)

速度环把转速误差转成转矩(即 iqref)指令,带宽约电流环的 1/10(典型 100-200 Hz,受机械时间常数 J/B 限制)。输入 omega_ref,反馈由 theta_e 微分或观测器得到 omega,输出 iqref,控制器为 PI。

4.3 位置环(最外、最慢)

位置环仅用于伺服/定位应用,带宽约速度环的 1/10(典型 10-50 Hz)。输入 theta_ref,反馈 theta_e,输出 omega_ref,控制器 PI 或 PD。EV 主驱通常不要位置环,只做速度+转矩控制。

4.4 EV 主驱特殊架构

EV 主驱是转矩控制(踩油门映射为转矩)而非速度控制,因此没有速度/位置外环——整车 VCU 直接给转矩参考 Tref,经 MTPA 分解为 idref+iqref,再交给电流环。整车层的车速闭环由 VCU 完成,不在电机控制器内部。

5. MTPA 最优角推导 — IPMSM 凸极电机

MTPA(Maximum Torque Per Ampere)求解:给定电流幅值 Is = sqrt(id^2 + iq^2),找最大转矩对应的 id/iq 比例。用电流角 beta(从 q 轴度量)参数化:id = -Is sin(beta)iq = Is cos(beta)(beta > 0 对应 id < 0):

整理成关于 id 的二次方程(令 DeltaL = Lq - Ld > 0):

求负根(id < 0 为 IPMSM MTPA 方向)得闭合解,与 MTPA 弱磁深度页 §4 同一 SSOT:

退化检验:当 DeltaL 趋于 0(SPMSM),分子分母同趋于 0,极限 idMTPA 趋于 0(即 id=0 控制)成立。物理含义:MTPA 角 beta 随 Is 变化(高电流对应更大 beta,磁阻分量比例更大);工程上用以 Is 为索引的 LUT 实现。

6. 弱磁扩速策略 — 电压椭圆与电流圆

电机运行受电流圆(器件/散热硬约束)与电压椭圆(母线电压上限)双重约束:

高速时电压椭圆收缩(omega_e 增大),中心固定在 (-psif/Ld, 0)、半轴正比于 Vmax/omega_e 收缩(完整几何见 MTPA 弱磁深度页 §2-§5)。

弱磁机制:增大 |id|(更负),减小有效磁链 omega_e psif + omega_e Ld id,使 Vq 下降,腾出电压裕量维持 iq 输出转矩。EV 主驱典型分区:

  • 0 到基速:MTPA 控制,|V| <= Vmax
  • 基速到约 2 倍基速(弱磁 I 区):电压环检测 |V| 逼近 Vmax,输出负的 delta-id 叠加到 MTPA 的 id 上;iq 按电流圆约束减小
  • 约 2 倍基速以上(弱磁 II 区 / 过调制):进一步增大 |id|,iq 随之降低,进入恒功率段(过调制细节见 SVPWM 调制策略)

7. PI 电流环极点消零整定

加前馈解耦后,d/q 轴电流环各等效为一阶 RL 系统:

PI 控制器写成零极点形式 C(s) = Kp + Ki/s = Kp (s + Ki/Kp)/s。极点消零法:令 PI 零点 Ki/Kp 等于 RL 极点 Rs/L,消去被控对象极点,闭环退化为纯一阶:

加入积分器后闭环为 (Kp/L)/(s + Kp/L),设定 Kp/L = omega_bw(目标带宽)得:

d/q 轴各一套参数(因 Ld 不等于 Lq),比例增益 Kpd = Ld omega_bwKpq = Lq omega_bw 按各轴电感缩放;而 Ki = Rs omega_bw 与 L 无关,两轴 Ki 相同——若代码里 d/q 两轴 Ki 数值差异大,说明整定逻辑有误(通用方法见 PI 环路设计方法论)。

8. 100 kW EV IPMSM 端到端 Worked Design(TC397)

本 Worked Design 与 电机控制 §9 共用同一组内部自洽的 IPMSM 参数(凸极比 Lq/Ld = 2 为 IPMSM 典型),逐行可复核。

参数符号取值说明
极对数p48 极
定子电阻Rs10 mΩ (25°C)温升影响见 C1
d 轴电感Ld0.3 mH凸极比 Lq/Ld = 2
q 轴电感Lq0.6 mHIPMSM 典型
永磁磁链psif0.08 Wb温度漂移见 C1/C3
相峰值电流Imax250 Ainverter 电流限
母线电压Vdc400 VVmax = Vdc/sqrt(3) = 231 V(SVPWM 线性区)
开关频率fsw10 kHzTs = 100 μs

Step 1:MTPA 最优工作点

先算特征量 X = psif/(2 DeltaL)

id^2 + iq^2 = 250^2 电流圆上迭代 MTPA 闭合解,得工作点 id = -122 A、iq = 218 A。验证 MTPA 条件 DeltaL id^2 - psif id - DeltaL iq^2 = 0

两种策略在同样 Is = 250 A 下的转矩:

MTPA 利用凸极磁阻使转矩提升 (152 - 120)/120 = +27%。这 -122 A 的负 id 不是代价,它同时贡献磁阻转矩并抬高基速(见 Step 3)。

Step 2:PI 极点消零参数

目标带宽取 fbw = fsw/10 = 1 kHz(单周期采样-计算延迟下的稳定边界),omega_bw = 2 pi × 1000 = 6283 rad/s(小于 fsw/5):

Ki 单位为 V/(A·s);d/q 两轴 Ki 相同(均 62.8),只有 Kp 按 L 等比缩放——这些数字与 电机控制 §9.3 完全吻合。

Step 3:基速验证

MTPA 满载点在多高转速撞上电压天花板决定基速。稳态下(id、iq 时间导数为零)取电角速度 omega_base = 1662 rad/s:

对应机械转速 n_base = 60 omega/(2 pi p) = 60 × 1662/(2 pi × 4) = 3968 rpm——MTPA 满载点恰好触达 Vmax,确认此即基速(与 电机控制 §9.2 一致)。

Step 4:弱磁 I 区分析(到 2 倍基速)

omega' = 2 × 1662 = 3324 rad/s(约 7940 rpm),若仍维持 id = -122 A:

|V'| = sqrt(436^2 + 146^2) ≈ 460,远超 231 → 必须增大 |id|。弱磁目标是保持 |V| = 231 求最大转矩工作点(电流圆与电压椭圆交点,须数值迭代,完整轨迹见 MTPA 弱磁深度页)。

Step 5:TC397 FOC 执行时序

TC397 TriCore 配 GTM 独立定时器驱动 PWM、EDSADC 直连旋变,单周期典型耗时:Clarke+Park 约 1 μs,MTPA LUT 约 0.5 μs,2 路 PI + 前馈约 1.5 μs,反 Park + SVPWM 约 2 μs,ADC 就绪 + GTM 写比较值约 1.5 μs,合计约 6.5 μs。fsw = 10 kHz 时 Ts = 100 μs,对半周期 50 μs 裕量大于 7 倍,一个 PWM 周期内算完、下一周期生效——传输延迟约 1 个周期(与 电机控制 §9.4 的 FTTI 预算对接,FOC 计算链不是 FTTI 瓶颈)。

9. 无传感器 FOC(可选)

去掉 encoder/resolver 可省成本、提可靠性和体积——工业风机/泵成本敏感,家电压缩机约 90% 是无传感器 FOC。核心是用算法估计 theta_e 替代物理传感器。

9.1 中高速:反 EMF 观测器

中高速段反电势幅值足够,用滑模/Luenberger/Kalman 观测器从 dq 电流与电压反推 theta_e。转速越高,反电势信噪比越好,估计越准。

9.2 零速/低速:高频信号注入(HFI)

零速与低速段反电势趋近于零,观测器失效,改用高频信号注入——向 d 轴叠加高频电压(典型 0.5-2 kHz),利用 IPMSM 的 dq 电感各向异性(Ld 不等于 Lq)从高频响应电流中解调出转子位置。HFI 只对凸极电机有效,SPMSM 用不了(详见 位置传感 §7)。

9.3 EV 主驱的降级定位

EV 主驱安全要求高——瞬时位置失准会导致转矩反向、失控,因此必带冗余物理位置传感(双 resolver 或 编码器+霍尔)。无传感器 FOC 在 EV 主驱只作降级备份,不作主路径。

10. 10 条 Gotcha 链

每条对应真实量产陷阱,按"陷阱描述 → 物理根因 → 检测/处置"展开。

G1:Clarke 归一化约定混用(最高危、静默错误)

两套约定(幅值不变 2/3 与功率不变 sqrt(2/3))在转矩公式中分别用 3/2 和 1 系数——混用后 SVPWM 调制度带 sqrt(3/2) 偏差,导致相电流波形畸变且难以被基本测试发现(幅值只差约 22%,频谱正常)。根因:两套约定均"正确"但共存于不同教材(Bose 用功率不变,TI 用幅值不变)。处置:代码中标注约定来源;切换算法时全链核 P = va ia + vb ib + vc icP = valpha ialpha + vbeta ibeta 是否一致。

G2:极对数 p 与极数混淆(角度倍频错误)

theta_e = p × theta_mech,p 是极对数(pole pairs)= 极数/2。本页电机 8 极即 p=4。若代码把 p 填成极数(8),Park 旋转角翻倍,id/iq 相位错 90 度,转矩从满功率跌为 0 或反向。典型场景:从 p=4 电机换配置文件时未核实。处置:上电小电流开环注入 id,用示波器核 theta_e 与转子角的映射。

G3:iq 饱和弱磁失败(弱磁进不去)

只减小 iqref(直接砍指令)不等于弱磁:|V| = Vmax 的约束是二维椭圆,单减 iq 不能拉低 Vq(因 omega_e Ld id + omega_e psif 不变)。根因:弱磁必须同时加大 |id|(负方向)才能压低有效磁链。正确架构:电压环输出负的 delta-id,再由 iqmax = sqrt(Ismax^2 - id^2) 钳位 iq。若只加减 iq 外环而不动 id 通道,弱磁段电机失控。

G4:死区补偿符号错(越补越坏)

死区使实际输出电压少于指令 dv = Vdc × tdead × fsw,方向取决于该相电流极性(正电流时 PWM 少导通、负电流时多导通,符号相反)。若把正半周补偿方向直接套到负半周,补偿量翻倍恶化。处置:补偿逻辑必须检测每相电流符号(带 hysteresis 避免过零抖动),正电流加 +dv、负电流减 -dv。

G5:MTPA 温漂(效率悄悄降)

NdFeB 永磁体温度系数约 -0.12%/°C,从 25°C 升到 125°C 时 psif 下降约 12%。MTPA LUT 若用 25°C 标定数据,100°C 运行时最优 id/iq 角度偏小(psif 减小应加大 |id|),实际工作点偏离 MTPA,效率降约 2-4%(高转速段更明显)。处置:LUT 以温度为第二维(Is, Tmag)做二维表,或用在线 psif 估计器修正。

G6:解耦前馈遗漏(高速失稳)

电流环 PI 只处理误差,不含解耦前馈(-omega_e Lq iqomega_e Ld id + omega_e psif)时,高速下 d/q 强耦合:iq 扰动串入 Vd 误差,PI 响应慢,闭环等效带宽随 omega_e 下降,3000 rpm 以上可能振荡。前馈必加:vdff = -omega_e Lq iqvqff = omega_e Ld id + omega_e psif,各自叠加到 PI 输出。

G7:磁阻转矩方向歧义(IPMSM id 符号)

转矩项 (Ld - Lq) id iq:IPMSM 中 Ld < Lq 故 (Ld - Lq) < 0;正转矩要 iq > 0;则 id 必须为负,磁阻项 (负)(负)(正)=正 使转矩增加。若 LUT 输出 id > 0(符号错),磁阻项变负,转矩反而减小,MTPA 变成每安最低转矩。处置:上电做 MTPA 增益测试,同 Is 下对比 id=0 与 MTPA(id<0)的输出转矩,应有约 27% 增益(否则符号反)。

G8:转子位置零点未标定(iq 不全出转矩)

FOC 要求 theta_e=0 时刻对齐转子 d 轴,但 encoder/resolver 安装存在机械零偏(典型 ±5 度电角度),必须离线标定:方法一是开环注入 d 轴电流让转子自然对齐 d 轴再读 encoder 零偏;方法二是旋转电机反算 BEMF 相位反推 theta_offset。零偏不准则 iq 不全产生转矩,效率降且弱磁失败——EV 量产下线测试必含此项(位置故障保护见 位置传感诊断 SM)。

G9:ADC 采样未与 PWM 谷点同步(5/7 次谐波)

相电流采样必须与 PWM 同步——典型在 PWM 谷点(下管全 ON)采电流,此时纹波过零、共模电压稳定、噪声最小。异步采样会引入 5/7 次电流谐波,恶化转矩纹波与铁损。处置:ADC 触发绑定到定时器谷点中断,用硬件触发而非软件轮询(采样链电流采样)。

G10:母线电压纹波未前馈(Vd/Vq 抖动)

dq 电压指令要归一化除以 Vdc 才能算调制度;Vdc 纹波(LLC 输出或电池放电)会让实际调制度抖动,进而扰动电流环。处置:Vdc 经低通滤波(约 1 kHz)后参与前馈计算,把母线波动补偿掉(母线采样诊断见 电压采样诊断 SM)。

11. 3 条 Corner 分析

超出典型工况的边界场景,暴露标定假设在温度、FTTI、寿命三个维度上的失效。

C1:125°C 高温 psif 下降 — 转矩精度超窗

NdFeB 在温升 100°C 时 psif' = 0.08 × 0.88 = 0.0704 Wb。MTPA LUT 未更新时实际转矩:

误差 (152 - 140)/152 = -8%,在 ASIL D 扭矩精度窗口(典型 ±10%)内,但叠加电流采样偏差(约 ±1%)、死区误差(约 ±0.5%)会临近边界。须在标定数据库中用 NTC 测磁体温度动态修正 psif。

C2:FTTI 压缩至 50 ms — ASC 阈速与安全状态联动

若系统级 FTTI 因 L4 自动驾驶收紧到 50 ms,硬件 DESAT 短路保护路径(约 1.2 μs,见 电机控制 §9.4)裕量不受影响,但软件 FSM 的调度周期(典型 10-15 ms 一拍)与安全状态选择须重推。ASC(主动短路)阈速的 SSOT 与推导在 扭矩安全 §11.4,采相 Back-EMF 峰值对 Vdc/2 的保守判据:

本页 psif=0.08 对应约 5970 rpm(比 扭矩安全 §11.4 平台的 3670 rpm 高,因该平台 psif=0.130 更强);n < nASCSTO free-wheel,n > nASC 必须切 ASC 防高速 Back-EMF 不控制动扭矩。FTTI 压缩后若 FSM 响应变慢,安全状态切换点须重新用故障注入验证

C3:EOL 退磁 — MTPA LUT 与弱磁边界双重漂移

EV 主驱运行 15 年,高温叠加大电流去磁脉冲累积,psif 可长期漂移约 -5% 到 -10%(不可逆退磁)。影响双重:(1) MTPA 最优角偏移,最优 id 应更负;(2) 基速下降(nbase 正比于 psif),弱磁区扩大,原弱磁 II 区落入原弱磁 I 区,参数不匹配。处置:EOL 重标定(每次 OTA 升级跑全速域标定例程),或在线估计 psif(BEMF 观测器)自适应更新 LUT 与 nbase。

核心要点

FOC 通过 Clarke/Park 把三相耦合非线性问题转成 dq 两路独立 RL 系统,是 EV 主驱高性能转矩控制的唯一主流方法。三环嵌套(电流 1-2 kHz、速度 100-200 Hz、位置 10-50 Hz)带宽逐级降 10 倍,EV 主驱去掉位置/速度外环、VCU 直接给 Tref。电流环极点消零整定(Kp = L omega_bwKi = Rs omega_bw)是量产标准,d/q 轴 Kp 不同但 Ki 相同。MTPA 利用 IPMSM 凸极磁阻转矩(闭合解 idMTPA = psif/(2 DeltaL) - sqrt((psif/(2 DeltaL))^2 + iq^2)),100 kW EV worked design(p=4, Ld=0.3 mH, Lq=0.6 mH, Rs=10 mΩ, psif=0.08 Wb)验证 id=-122 A、iq=218 A、+27% 转矩增益、基速 3968 rpm。弱磁靠加大负 id 压制有效磁链、iq 联动钳位,单减 iq 无效。三大高危 Gotcha:Clarke 约定混用(静默幅值偏差)、解耦前馈遗漏(高速振荡)、MTPA 温漂(效率悄降);量产三关键:转子零点标定、死区补偿、ADC-PWM 谷点同步。

Engineering Objects

引用此页的结构化 Engineeri…

引用此页的结构化 Engineering Object(v2.0 Copilot 自动生成,不要手动编辑此段)。

  • case · case_aircon_pmsm_compressor — Variable-Speed AC Compressor (PMSM + Sensorless FOC)
  • diagnostic · diagnostic_motor_parameter_id — Motor Parameter Identification (Auto-Tune)
  • mechanism · mechanism_dtc — Direct Torque Control (DTC)
  • mechanism · mechanism_field_weakening — Field Weakening Control
  • mechanism · mechanism_foc — Field Oriented Control (FOC)
  • mechanism · mechanism_mtpa — MTPA (Maximum Torque Per Ampere)

Cross-references