PMSM无感FOC实战：PLL估算器与弱磁控制落地

简介：面向从事永磁同步电机控制、电机驱动开发及电力电子学习的工程师与学生，这份PDF应用笔记聚焦无传感器磁场定向控制（FOC）与PLL估算器的工程实现，针对成本敏感、安装位置受限或电气环境较恶劣的场景，提供从数学模型到硬件模块的设计思路。包内仅含1个PDF文件，压缩包约1.83MB，内容以Microchip AN2520中文应用笔记为主体，围绕表面贴装式PMSM展开，涵盖定子电流解耦、Clarke与Park变换、PI控制器、角度与速度估算器、弱磁（FW）模块及空间矢量调制（SVM）等关键环节，并说明dsPICDEM MCLV-2开发板的测试实现方式。已有2323人学习，适合需要理解PLL估算器参数、弱磁边界与恒功率运行限制的读者；文中还给出AN1078、AN908、AN1292等参考线索及永磁体消磁、机械损伤等工程注意事项，便于快速建立无感FOC调试与排错框架。

1. 需求切入：一台不能开盖的电机，怎么把转速稳到 4000 RPM

某产线设备上的一台表贴式 PMSM 装在密封腔体里，出线只有 U/V/W 三根，编码器既没空间也没预算。要求 0～4000 RPM 连续调速，稳态误差压在 ±1% 以内，高速段还要跑到基速两倍以上。这就是典型的无传感器磁场定向控制（FOC）场景：用 PLL 估算器从反电动势里把转角和转速推出来，再叠一层基于公式的弱磁，让无感控制在高速区不掉链子。

这套方案适合两类人：一类要做电机驱动方向的毕设或课设，需要一个讲得清、跑得起来、测得出数据的完整链路；另一类是从业者手上有一台成本敏感的电机，准备把霍尔或编码器砍掉。下面按需求、架构、估算器、弱磁、避坑、验收六段推演，每个模块都给到参数和代码落点。

2. 总体架构设计：FOC 主环、PLL 估算器与弱磁模块的职责划分

无感 FOC 的架构难点不在算法本身，而在模块之间的时序依赖。主环负责电流和转速，估算器负责提供角度和速度，弱磁负责在电压不够用时给 d 轴塞负电流。三者如果共用一个执行周期又不约定先后顺序，很容易出现「这一拍用上一拍的角度算出来、下一拍角度又跳了」的错拍问题，表现为电流波形上叠一层低频抖动，调 PI 怎么调都调不掉。

我的做法是把整个控制切成固定节拍，每个节拍只做一件事，估算器永远使用上一拍的 SVPWM 输出和本拍刚采到的相电流。这样虽然引入了一拍延迟，但省掉了三相电压采样电路，对于母线电压不高、开关频率 20 kHz 左右的场合，一拍延迟带来的角度误差在 4000 RPM 下不到 0.5 电角度，完全可以接受。

2.1 从双电阻采样到 SVPWM 的一条固定节拍链路

功率级是标准的三相桥，母线侧做整流和滤波，桥臂下管串采样电阻做双电阻电流采样，硬件过流走比较器直接封波。软件侧的模块清单和原文一致：Clarke 正变换、Park 正反变换、角度与速度估算器、PI 控制器、弱磁模块、SVPWM。区别只在于我把它们排进了同一张节拍表：

这张表的价值在于把「谁先谁后」写死了。T7 放在最后，是因为它需要用到 T6 已经算出来的电压，而 T3 又要用 T7 上一拍算出的角度，形成闭环。中断服务程序的骨架大致是这样：

/* 每个 PWM 周期进入一次, 20 kHz, 周期 50 us */ void MotorControl_ISR(void) { /* T1: 采样值换算, 减去上电时标定的零点偏置 */ float ia = (AdcResult[0] - IoffA) * I_SCALE; float ib = (AdcResult[1] - IoffB) * I_SCALE; /* T2: Clarke, 三相转两相静止坐标系 */ float iAlpha, iBeta; Clarke(ia, ib, &iAlpha, &iBeta); /* T3: Park, 用上一拍的估算角做旋转坐标变换 */ float id, iq; Park(iAlpha, iBeta, rhoEstim, &id, &iq); /* T4: 弱磁模块先算 idref, 再据此限制速度环输出 */ float idRef = FluxWeakening_CalcId(omegaEstim, iqRefPrev, PSI_PM, LS, V_MAX); float iqRef = SpeedLoop_Update(omegaRef, omegaEstim, idRef); /* T5: 电流环, d/q 两路独立 PI */ float vd = PiD_Update(idRef - id); float vq = PiQ_Update(iqRef - iq); /* T6: 反 Park 加 SVPWM, 同时把 vAlpha/vBeta 存给估算器 */ InvPark(vd, vq, rhoEstim, &vAlpha, &vBeta); Svm_Update(vAlpha, vBeta, Vbus); /* T7: PLL 估算器, 用本拍电流和上一拍电压反算 BEMF */ Estimator_Update(iAlpha, iBeta, vAlphaPrev, vBetaPrev); }

电流换算系数要单独算清楚，别拍脑袋。假设采样电阻 10 mΩ、差分运放增益 75、相电流峰值 4.4 A，则送入 ADC 的电压是 4.4 × 0.01 × 75 = 3.3 V，正好压满 ADC 量程，此时 I_SCALE 就等于 4.4 A 除以 ADC 满量程码值（假设 12 位、4095）。这个系数一旦算错，后面 id/iq 的解耦比例全歪，弱磁会提前介入或者干脆不介入，是很难从波形上直接看出来的暗坑。

2.2 PLL 估算器的闭环结构：把 Ed 收敛到零当作鉴相器

估算器的核心判据只有一句话：稳态下反电动势在 d 轴上的分量必须为零。把这句话翻译成控制结构，就是一个标准 PLL——鉴相器是 Ed，环路滤波是一阶低通，压控振荡器是角度积分。转子的估算电角速度由 BEMF 的 q 轴分量除以电压常量得到，而 Ed 的符号决定这个速度是往上修还是往下修。

用文字描述这条闭环：先由电机的定子电压方程算出 α-β 轴反电动势 Eα、Eβ，再用上一拍的估算角做 Park 变换得到 Ed、Eq，两路各走一个一阶滤波器，滤掉 ADC 噪声和软件计算引入的高频抖动；滤波后的 Eq 除以 Kφ 得到估算电角速度 ωestim，滤波后的 Ed 取其符号参与校正；ωestim 积分一次得到估算角 ρestim，送回 Park 变换和反 Park 变换使用。

电压常量 Kφ 的算法是极对数乘以转子永磁磁链，单位取决于你怎么定义角速度。如果 ωestim 用电角速度（rad/s），Kφ 就是 P × ψPM，单位 V·s/rad；如果习惯用 RPM，就要多一步 2π/60 的换算。这两种写法在很多开源工程里混着出现，是新手最容易踩的坑之一——单位对不上时现象是「估算速度正好差一个极对数倍」，看起来像算法坏了，其实只是常数写错。

2.3 弱磁模块的接入位置：放在电流参考层，优先级高于 iq

弱磁有两种接法：一种直接改 SVPWM 的调制比，一种在电流参考层注入负的 id。前者响应快但不可控，容易把电流环带进饱和；后者把弱磁变成一个「给 d 轴下负电流指令」的常规问题，交给电流环去执行，稳态精度和可观测性都好得多。表贴式 PMSM 的 Ld = Lq，磁阻转矩为零，所以 d 轴电流除了削弱磁链没有任何产转矩的作用，注入它是纯粹的「用转矩换转速」，必须限得死。

优先级必须明确：d 轴电流先行。先把弱磁需要的 id 算出来占住电流圆的一部分，再用剩下的额度去限 iq。如果反过来先算 iq 再补 id，会在高速段出现 id 和 iq 抢电流、两者都往参考值上撞、实际矢量超出电流圆的现象，驱动器要么过流保护，要么进入一种「电流上不去、转速也上不去」的僵持状态。动态电压调整的思路也是同一个道理：电压的 d 分量优先分配，q 分量拿剩下的。

3. 估算器落地：BEMF 反算、一阶滤波与角度积分

估算器这段代码量不大，但每一行都有讲究。整段逻辑依赖三个电机参数——相电阻 Rs、相电感 Ls、电压常量 Kφ，参数错一点，估算角就偏一点，偏到一定程度电机直接失步。所以这一章的顺序是：先把参数测准（第 6 章会给测量和验收方法），再谈代码。

3.1 Clarke、Park 与 BEMF 反算的代码落点

Clarke 变换用等幅值形式，省掉一个 2/3 系数，后面所有电流和电压的量纲都是「峰值」，不要再混进 RMS。Park 变换用估算角做旋转，注意 sin/cos 每拍只算一次并存成全局，别在三个函数里各算一遍，20 kHz 下这是实打实的算力浪费。

/* Clarke: 等幅值形式, ia + ib + ic = 0 */ static inline void Clarke(float ia, float ib, float *iAlpha, float *iBeta) { *iAlpha = ia; *iBeta = (ia + 2.0f * ib) * ONE_BY_SQRT3; /* 1/sqrt(3) */ } /* Park: 把静止坐标系投影到估算的转子坐标系 */ static inline void Park(float alpha, float beta, float rho, float *d, float *q) { float s = sinf(rho), c = cosf(rho); *d = alpha * c + beta * s; *q = -alpha * s + beta * c; } /* 反算反电动势: v = R*i + L*di/dt + e => e = v - R*i - L*di/dt */ static inline void Bemf_Calc(float vAlpha, float vBeta, float iAlpha, float iBeta, float iAlphaPrev, float iBetaPrev, float *eAlpha, float *eBeta) { float diA = (iAlpha - iAlphaPrev) * INV_TS; /* 后向差分, INV_TS = 1/50us */ float diB = (iBeta - iBetaPrev ) * INV_TS; *eAlpha = vAlpha - RS * iAlpha - LS * diA; *eBeta = vBeta - RS * iBeta - LS * diB; }

这里的 vAlpha、vBeta 是上一拍反 Park 的输出，也就是实际送给 SVPWM 的电压指令。用指令值代替实测值是有代价的：逆变器死区、管压降、母线电压跌落都不在模型里，低速时这些误差占反电动势的比例很大，所以低速段估算精度天然差，这也是无感控制在极低速必须靠开环强拖的根本原因，不是算法调不好，是物理上信噪比不够。

后向差分那一步在高转速下没问题，在转速突变时会放大噪声，如果实测发现估算速度毛刺大，可以换成对电流先滤波再差分，或者用带遗忘因子的离散形式，别直接去调大 Rs 和 Ls，那是拿模型误差换噪声，会把稳态角度带偏。

3.2 一阶滤波常量：带宽、噪声与相位滞后的三角平衡

BEMF 的 d-q 分量和估算速度都要滤波，滤波器形式统一成一阶：

/* y(n) = y(n-1) + K * (x(n) - y(n-1)) */ #define KFILT(fc, ts) (2.0f * PI * (fc) * (ts) / (1.0f + 2.0f * PI * (fc) * (ts))) static float eDf, eQf, omegaF; void Estimator_Filter(float eD, float eQ, float omegaRaw) { eDf += KFILT_D * (eD - eDf); /* 例如 KFILT_D = 0.059 */ eQf += KFILT_Q * (eQ - eQf); omegaF += KFILT_W * (omegaRaw - omegaF); }

常量 K 由两个东西决定：开关周期 Ts 和想要的截止频率 fc。Ts = 50 μs、fc = 200 Hz 时，2π × 200 × 50e-6 ≈ 0.0628，K ≈ 0.059。fc 越高，滤波越弱、响应越快、噪声越大；fc 越低，噪声压得越干净，但相位滞后越大，在高速段滞后会直接转化成角度误差，表现为 iq 上不去、效率变差，严重时失步。

我一般这么定：BEMF 分量的 fc 取开关频率的 1/50 到 1/100，20 kHz 开关对应 200～400 Hz；速度环的 fc 再低一个数量级，取 20～50 Hz，因为机械时间常数远大于电气时间常数。另外要注意，弱磁区里 BEMF 的变化本身很慢（没有转矩突变、没有高加速斜坡），可以把 fc 压得更低；基速以下的加速段变化快，fc 要放开。如果工程允许，做成分段常量比死调一个值省事得多。

3.3 电角度积分、机械转速换算与溢出保护

角度积分看起来只有一行，实际有三个细节。第一，积分的是电角速度不是机械角速度，中间差一个极对数。第二，角度必须做 0～2π 的环绕，浮点下建议用 fmodf 而不是自己写 if 判断，避免长时间运行后精度损失。第三，用于显示的机械转速和用于控制的电角速度要分开存，别图省事共用一个变量，后面做上位机波形时会发现数据全乱。

void Estimator_Update(float iAlpha, float iBeta, float vAlpha, float vBeta) { /* 1. 反算 BEMF */ float eA, eB; Bemf_Calc(vAlpha, vBeta, iAlpha, iBeta, iAlphaPrev, iBetaPrev, &eA, &eB); /* 2. 投影到估算的转子坐标系 */ float eD, eQ; Park(eA, eB, rhoEstim, &eD, &eQ); /* 3. 一阶滤波 */ Estimator_Filter(eD, eQ, omegaEstim); /* 4. Eq/Kphi 得电角速度, Ed 符号做方向校正 */ float omegaRaw = eQf * INV_KFI; /* INV_KFI = 1/(P*PSI_PM) */ omegaEstim = (eDf >= 0.0f) ? (omegaF + CORR_STEP) : (omegaF - CORR_STEP); /* 5. 积分得角度并环绕 */ rhoEstim += omegaEstim * TS; if (rhoEstim >= TWO_PI) rhoEstim -= TWO_PI; if (rhoEstim < 0.0f) rhoEstim += TWO_PI; /* 6. 机械转速只用于显示和速度环, 与控制角解耦 */ omegaMech = omegaEstim / POLE_PAIRS; speedRpm = omegaMech * 60.0f / TWO_PI; iAlphaPrev = iAlpha; iBetaPrev = iBeta; }

CORR_STEP 这个校正步长不用大，它的作用是给 PLL 一个持续往正确方向拉的力，防止滤波器把 Ed 完全平均掉之后环路失去方向感。取值太大角度会来回跳，取值太小收敛慢，通常从每拍 0.001 rad/s 这个量级试起，看启动到稳态的时间能不能压进 200 ms。

4. 弱磁落地：d 轴负电流注入与电压圆、电流圆的联合约束

基速以下，反电动势随转速线性上升，SVPWM 能输出的最大相电压是一个由母线电压决定的天花板，Vmax = Vbus/√3（相电压峰值）。转速升到某个点，需要的电压顶到这个天花板，电流环开始饱和，转速上不去了——这就是基速。想再往上，只有一条路：把转子磁链削弱，让反电动势降下来。永磁体的磁链是恒定的，能改的只有定子电流产生的电枢反应磁通，也就是往 d 轴灌负电流。

4.1 从稳态电压方程反解 id

稳态下 d/q 轴电压方程可以写成两行：

Vd = Rs*id - ωe*Ls*iq Vq = Rs*iq + ωe*(Ls*id + ψPM)

忽略电阻压降（高速段 ωe*Ls 远大于 Rs，这一项影响很小），再套电压约束 Vd² + Vq² ≤ Vmax²，可以把 id 解出来：

id = ( -ψPM - sqrt( Vmax²/ωe² - Ls²*iq² ) ) / Ls

根号里必须为正，否则说明电压圆已经小到连 iq 都支撑不了，这时候 d 轴电流必须吃满。取负号是因为我们要的是削弱磁链的方向，正号会让磁链增强，那是帮忙不是削弱，转速只会更低。落到代码里：

/* 返回负的 d 轴电流参考, 基速以下返回 0 */ float FluxWeakening_CalcId(float omegaE, float iqRef, float psiPM, float Ls, float vMax) { float vOverW, inner, idFW; if (omegaE < OMEGA_BASE) { return 0.0f; /* 基速以下不弱磁 */ } vOverW = vMax / omegaE; inner = vOverW * vOverW - Ls * Ls * iqRef * iqRef; if (inner <= 0.0f) { return -IMAX_PEAK; /* 电压圆不够, d 轴吃满 */ } idFW = (-psiPM - sqrtf(inner)) / Ls; if (idFW > 0.0f) idFW = 0.0f; if (idFW < -IMAX_PEAK) idFW = -IMAX_PEAK; return idFW; }

OMEGA_BASE 是基速对应的电角速度，可以由额定转速反推。vMax 不要直接用 Vbus/√3 的理论值，留 5%～10% 余量给死区和管压降，实测时这个余量直接决定高速段能不能稳住。

4.2 iq 限幅：先算 id 再回头限 iq 的执行顺序

d 轴占了电流圆的一部分，iq 就只能在剩下的额度里活动，这是公式化的电流圆约束：

/* 电流圆限幅: id² + iq² ≤ Imax² */ float iqLimit = sqrtf(fmaxf(IMAX_PEAK * IMAX_PEAK - idRef * idRef, 0.0f)); iqRef = Saturate(iqRef, -iqLimit, iqLimit);

注意这里的耦合：算 id 的时候用到了 iq，限 iq 的时候又用到了 id。工程上就用上一拍的 iq 去算本拍的 id，再用本拍的 id 限本拍的 iq，一拍延迟在这个环里完全可以容忍。

限幅带来的直接后果是转矩能力下降——这是弱磁的本质，用转矩换转速，不是免费的。所以在高速段看到电流上去了、转矩下来了，这是正常的物理规律，别以为是算法出了问题跑去调 PI，越调越乱。

4.3 弱磁区的 1/Kφ 修正与估算器稳定性

这是整套方案里最容易被忽略、也最容易翻车的一处。PLL 估算器靠 BEMF = ω × Kφ 来推速度，Kφ 被当成常数。基速以下没问题，弱磁区里 d 轴负电流把气隙磁通削掉了一部分，等效磁链变成 ψPM + Ls × id，Kφ 不再是常数，BEMF 也不再随转速线性变化。这时候如果还用固定的 1/Kφ，估算速度会系统性偏高，环路为了把速度拉回来会继续加大 id，形成正反馈，深度弱磁时直接失步。

修正的方法很直接：把等效磁链代回去。

/* 弱磁区的电压常量修正, 带下限保护防除零 */ float psiEff = psiPM + LS * idRef; if (psiEff < PSI_MIN) psiEff = PSI_MIN; /* 例如 0.2 * psiPM */ float invKfi = 1.0f / (POLE_PAIRS * psiEff);

高电感电机或者深度弱磁（id 负得比较多）时，这个修正带来的差别非常明显，能到 10% 以上；低电感电机在轻度弱磁时几乎看不出来，但只要有高速段，就该加上。PSI_MIN 这个下限是保命的， глубину弱磁时 psiEff 可能接近零，除下去估算速度直接爆表，驱动器立刻过流。

5. 避坑与常见问题：无感 FOC 最容易翻车的六个点

这一章是从实际调试记录里挑出来的，每条都按「现象 → 原因 → 解决」写。前四条集中在启动和切换段，后两条集中在参数和采样通道，这两块占了无感 FOC 调试问题的大半。

5.1 启动、切换与闭环入口的四个坑

坑一：开环强拖一切闭环就抖，甚至直接停转。现象是切换瞬间电流尖峰、转速掉一下再爬。原因是切换点转速太低，此时反电动势幅值只有几十毫伏，被采样噪声和死区误差淹没，估算出来的角度基本是随机的。解决是把切换点抬到额定转速的 15%～20%，同时把开环阶段的 q 轴电流给足，让电机在切换前已经带载加速到目标转速，切换时只切角度来源，不切别的。

坑二：切换瞬间角度跳变，电机「咯噔」一下。现象是切换后第一两个周期电流波形明显畸变。原因是强制角和估算角在切换时刻不重合，两者差多少就跳多少。解决是在开环阶段就把估算器跑起来（但不参与控制），切换前把估算角往强制角上做一段斜坡对齐，或者用一个加权过渡，让两个角度在几十毫秒内平滑交接。

坑三：开环阶段电机不转只会嗡嗡响。现象是给定了 q 轴电流，转子在原地小幅摆动。原因是锁定时间不够，转子还没对齐到指定位置就开始加速；或者初始加速度给太快，转子跟不上旋转磁场。解决是把锁定时间按负载转动惯量往上调，重载场合锁定时间要从几百毫秒起步；加速度从低往高试，找到不失步的最大值再留 30% 余量。

坑四：空载能起，带载起不来。现象是空载启动顺畅，一挂负载就失步。原因是开环 q 轴电流给的转矩不够。开环阶段没有速度环，q 轴电流是硬编码的，本质上就是一个固定转矩指令。解决是按最大预期负载的 1.5 倍去给这个电流，同时确认驱动器和电机的额定电流撑得住，撑不住就得改方案，不是调参数能解决的。

5.2 参数测量与采样通道的两个坑

坑五：估算角持续偏移，转速越高偏得越多。现象是稳态运行时 id 不为零，iq 有效值偏大，效率明显低于预期。原因八成是相电阻、相电感测错了接法。电机端子处量到的是线值，星形接法要除以 2 得到相值，三角形接法要乘 1.5，再把三角形等效成星形还要再除以 3。这几个系数搞混一个，估算出来的 BEMF 就系统性偏，角度自然跟着偏。

坑六：运行一分钟后精度变差，冷机没事。现象是刚上电测什么都准，跑一分钟左右 id 开始漂、电流上升。原因是温升。铜的电阻温度系数大约是每摄氏度 0.4%，绕组温升 50 ℃ 相电阻就涨 20%，而估算器里的 Rs 是冷态测量的常数，模型和实物对不上，误差全部转成角度偏差。解决分两步：测试阶段把每个工况的连续运行时间限制在一分钟以内，保证数据可比；产品阶段要么做温度补偿，要么选参数敏感度低的电机，这不是调代码能绕过去的物理问题。

提示：六条里前四条能靠调参和流程解决，后两条必须回到硬件和测量环节，别指望在代码里打补丁。分不清是算法问题还是参数问题的时候，先做一次静止参数复测，通常十分钟就能定位。

6. 验收与答辩：用一张转速-电流表和三次阶跃把方案讲圆

验收不要堆波形图，评委和主管看不过来。我的做法是只准备两样东西：一张覆盖基速上下和弱磁深区的稳态表，三次阶跃的动态响应。

稳态表按参考转速从低到高扫，每一档记录实测转速、负载转矩、相电流有效值。判据有三条：实测转速与参考值的偏差在 ±1% 以内（4000 RPM 那档可以放宽到 ±2%，因为已经进入弱磁）；基速以下相电流随负载单调、无明显跳变；基速以上相电流开始回升，说明弱磁确实在工作而不是靠过调制硬顶。

这张表里最值得讲的是 2500 到 3000 那一行：负载转矩降了，相电流反而升了，这正是 d 轴负电流开始注入的特征。答辩时如果被问「你怎么证明弱磁真的生效了」，指着这一行就够了——如果是靠过调制硬顶上去的，相电流不会出现这个拐点。

动态部分准备三次阶跃：基速以下（1500 → 2000 RPM）、基速附近（2800 → 3200 RPM）、深弱磁区（3500 → 4000 RPM）。每次记录转速响应和 iq 波形，看三件事：超调量、调节时间、有没有稳态误差。基速以下要求超调小于 5%、调节时间小于 300 ms；进入弱磁区这两项指标一定会变差，如实报出来，然后说明这是转矩能力下降导致的，属于预期行为。主动暴露边界，比被追问出来强得多。

被问得最多的还有一个问题：「没有传感器，你怎么知道估算的角度是对的？」标准答法是做一次对照实验——在台架上临时装一个编码器，只做数据采集不参与控制，把编码器读出的角度和估算角同时录下来，画两条曲线的差值。基速以下差值应该稳定在几度电角度以内，弱磁区会变大，量化报出来。这个实验花不了半天，但能让整套方案的可信度上一个台阶。

血泪经验是：这套东西的调试顺序绝对不能乱。先静止测参数，再开环强拖验证相序和电流方向，再切闭环跑基速以下，最后才碰弱磁。我见过不止一次有人上来就开弱磁，结果基速以下的角度都没对上，高速段一通乱调，最后连问题出在哪一段都分不清。从那以后我每次起新电机都强制走一遍这个顺序，一步不跳，宁可多花两小时，也不想在高速段对着波形猜黑匣子。希望帮到你。

本文还有配套的精品资源，点击获取