永磁同步电机全速域无感控制：高频方波注入与SMO加权切换方案

永磁同步电机全速域控制，一直是做电驱、伺服和电动汽车驱动的人绕不开的坎。标题里这三个关键点——高频方波注入、滑模观测器SMO、加权切换矢量控制，基本就覆盖了从零速到高速的全工况观测与切换思路。我最近完整跑通了一套Simulink仿真，把这三块整合在同一套控制系统里，实现无位置传感器全速域运转，这里把整个过程、原理、参数和踩过的坑完整拆开讲。

先说结论：这套方案的核心思路，是低速零速用高频方波注入法（也就是利用凸极性估算转子位置），中高速用滑模观测器（SMO，靠反电动势估算位置和转速），两者之间通过加权切换实现无缝过渡。Simulink里搭建这套仿真，不是简单把两个模块并联，关键在切换逻辑、观测器收敛速度、滤波器相位补偿这三块，处理不好就会在切换点出现转速波动甚至失步。

1. 为什么选择“注入+SMO+加权切换”的组合方案

单靠一种观测器想覆盖全速域，在工程上基本是不可能的。常规的观测方法各有各的物理极限：

• 高频注入法（包括旋转高频注入和脉振高频注入）依赖电机的凸极效应工作。转子位置不同，高频激励下的电流响应会有差异，通过解调就能提取出位置信号。问题是反电动势观测器在零速和极低速时基本失效，因为此时反电动势幅度接近零，信噪比太差，根本没有可靠信号可以提取。
• 滑模观测器（SMO）走的是另一条路，它从电机数学模型中的反电动势项来估算转子位置。在中高速区域反电动势信号强，SMO收敛速度快、鲁棒性好。但一旦转速掉到额定转速的5%以下，反电动势淹没在噪声和死区效应里，观测器就会漂移甚至跑飞。

所以工程界最通用的做法，就是高低速分区，再用逻辑把两者接起来。这里选择的加权切换，而不是硬切换，核心原因在于：硬切换会在两条观测器输出之间瞬间跳变，而两种观测器的输出在切换点通常有几度甚至十几度的相位差，直接切会造成转矩脉动、转速突变，严重时直接导致失步。加权切换则是让两条通道的输出按照权重系数线性混合，过渡平滑，系统始终处于闭环控制状态。

适用这套方案的人很明确：做永磁同步电机无感FOC控制的工程师、研究生的课题项目、以及想把低速带载启动和高速弱磁控制做到同一套代码里的开发团队。你不需要重新发明算法，但得搞清楚每个模块的物理边界和参数敏感性。

2. 高频方波注入法：零低速段的“眼睛”

2.1 为什么不选旋转高频注入

高频注入有两种主流方式，旋转高频注入和脉振高频方波注入。前者向静止坐标系注入旋转高频电压矢量，后者在估计的d轴注入方波电压。我这次用的是脉振高频方波注入，原因很直接：

脉振方波注入的电流解调路径短，不需要复杂的带通滤波器提取正负序分量，信号处理延时小。而旋转高频注入需要提取负序电流，这中间的处理链路过长，在Simulink仿真里体现不明显，但在实际MCU上会占用大量CPU时间。方波注入的另一个好处是注入频率可以提得比较高（通常1kHz到2kHz），高于电流环带宽但又远低于PWM开关频率，参数选择空间大。

2.2 高频方波注入的数学原理和Simulink实现

方波注入的核心，是让高频信号作用在估计坐标系上，然后从高频电流响应中解调出位置误差。整个仿真我基本上是用离散模型搭的，步长1e-6秒，PWM频率10kHz，注入频率1kHz。

注入电压加在估计的d轴：

[ V_{dh} = \begin{cases} +V_{inj}, & 0 < t \le T_{inj}/2 \ -V_{inj}, & T_{inj}/2 < t \le T_{inj} \end{cases} ]

其中 (V_{inj}) 是注入幅值，(T_{inj}) 是注入周期。高频电流响应可以写成：

[ \frac{di_{dh}}{dt} = \frac{V_{dh}(L_0 - L_1 \cos 2\theta_{err})}{L_0^2 - L_1^2} ]

[ \frac{di_{qh}}{dt} = \frac{-V_{dh} L_1 \sin 2\theta_{err}}{L_0^2 - L_1^2} ]

关键在于q轴高频电流分量中包含位置误差信息 (\theta_{err})。当 (\theta_{err}) 较小时，(\sin 2\theta_{err} \approx 2\theta_{err})，所以q轴电流的峰值包络就直接和位置误差成正比。

Simulink里的标准处理链路：

1. 在q轴高频电流信号上采样，取每个注入半周期末端的电流值。
2. 将相邻两个半周期的采样值做差，消除直流偏置和低频分量。
3. 得到误差信号后，送入PI调节器，输出就是转速估计值。
4. 转速积分得到位置角。

这一套处理可以用一个很小的Matlab Function模块搞定，也可以用基本的乘法器和累加器搭。我更推荐直接写个函数，方便调节采样时机，也方便移植到C代码时保持逻辑一致。

2.3 高频注入的一个关键坑：滤波器延时

很多人仿真时结果好看，一到硬件就崩盘，绝大多数问题出在滤波器上。为了从带高频分量的电流里提取出有用的位置误差信号，大多数人习惯先加一个带通滤波器隔离高频分量。带通滤波器会引入相位延迟，延迟后的信号和真实位置之间存在固定偏差，而这个偏差会随转速变化而变化。

我的建议是，在仿真的电流反馈通道上，注入频率范围内的信号相位延迟必须提前建模并补偿。你在Simulink里用的是理想采样，看不出问题；但实际系统里ADC采样、滤波、运算都需要时间，这一串延迟会让观测器输出的角度滞后于真实角度。解决思路两个：一是在位置角输出端加超前补偿网络；二是尽量减短信号链路，用“差值采样法”，不经过滤波器，直接在PWM中点采样，配合方波注入的周期性天然做差分，这样相位延迟最小。

我仿真中的具体参数：

3. 滑模观测器SMO：中高速段的“主心骨”

转速起来以后，注入法的信噪比优势就没有了，此时要切换到SMO。SMO的原理很简单：构造一个电机电流模型，用滑模控制项把实际电流和观测电流之间的误差驱动到零，此时滑模控制量的等效值里就嵌着反电动势信息，而反电动势方向直接对应转子位置。

3.1 SMO在Simulink里的标准搭建方法

电机在静止坐标系下的电压方程：

[ \frac{di_\alpha}{dt} = -\frac{R_s}{L_s} i_\alpha + \frac{1}{L_s} (u_\alpha - e_\alpha) ]

[ \frac{di_\beta}{dt} = -\frac{R_s}{L_s} i_\beta + \frac{1}{L_s} (u_\beta - e_\beta) ]

其中反电动势：

[ e_\alpha = -\psi_f \omega_e \sin \theta_e ]

[ e_\beta = \psi_f \omega_e \cos \theta_e ]

SMO观测器表达式：

[ \frac{d\hat{i}\alpha}{dt} = -\frac{R_s}{L_s} \hat{i}\alpha + \frac{1}{L_s} (u_\alpha - \hat{e}_\alpha) ]

其中：

[ \hat{e}\alpha = K \cdot \text{sgn}(\hat{i}\alpha - i_\alpha) ]

[ \hat{e}\beta = K \cdot \text{sgn}(\hat{i}\beta - i_\beta) ]

这里的 (K) 是滑模增益，必须足够大，保证滑模面可达，但太大又会引入严重的抖振。仿真里我最后用了分段增益，启动时用较大值加快收敛，稳态后自动降增益减小抖振。实现不难，用一个关于转速查表的小模块就能完成。

3.2 反电动势到位置角的提取

得到反电动势估计值后，最理想的做法是直接用反正切函数求角度：

[ \hat{\theta}e = -\text{atan2}(\hat{e}\alpha, \hat{e}_\beta) ]

但这个做法在噪声存在的情况下会引入大量角度抖动，且反正切计算里的符号跳变处理不好会直接造成角度突变。更稳妥的方案是使用锁相环（PLL）结构，把反电动势相位信息变换到同步坐标系，让q轴分量为零，PI调节器收敛到的就是位置角。

PLL结构的优势在于它相当于一个低通滤波器，天然抑制了SMO滑模抖振带来的高频噪声。仿真中我在PLL前加了一阶低通滤波器截止频率500Hz，然后调节PLL带宽到50Hz，最终位置噪声从±8度缩小到±2度以内。

3.3 SMO的相位补偿问题

这是整个SMO部分最隐蔽的坑。无论是低通滤波器还是观测器本身的离散化误差，都会导致估计角滞后于真实角。滞后量大约正比于转速和滤波时间常数的乘积。如果不做补偿，高速时位置误差可能到十几度，转矩会明显下降，甚至可能正反馈失稳。

我用了一个简单有效的方法：转速自适应补偿。实时计算当前电角速度 (\omega_e)，乘上补偿系数 (k_\text{comp}) 加到估计角度上：

[ \hat{\theta}\text{comp} = \hat{\theta}\text{SMO} + k_\text{comp} \cdot \omega_e ]

补偿系数根据低通滤波器的相位特性离线计算，仿真里从0转速到5000rpm，全范围内位置误差控制在3度以内。这个方法简单粗暴但可靠，比设计复杂观测器更划算。

4. 加权切换策略：把两条观测器输出无缝接起来

4.1 切换区间和权重设计逻辑

核心问题：什么时候用注入法，什么时候用SMO，中间怎么过渡。

我设计的策略是在转速闭环之外设置一个切换调度器。设定两个转速阈值，(n_\text{low})（通常为额定转速的5%，我这里是150rpm）和 (n_\text{high})（额定转速的10%，300rpm），切换区间在两者之间。当转速低于150rpm时，位置角完全来自高频注入；高于300rpm时，完全来自SMO；在150到300rpm之间，位置角按权重混合：

[ \hat{\theta} = (1 - w) \cdot \hat{\theta}\text{inj} + w \cdot \hat{\theta}\text{SMO} ]

权重系数 (w) 怎么给？最常见的有两种：

• 线性权重：(w = (n - n_\text{low}) / (n_\text{high} - n_\text{low}))
• 平滑权重（S曲线）：(w = 0.5 - 0.5\cos\left(\pi \cdot \frac{n - n_\text{low}}{n_\text{high} - n_\text{low}}\right))

仿真中我对比了两种权重，S曲线的切换过程更平稳，在150rpm和300rpm两个临界点附近，转矩脉动更小。因为线性权重在边界点导数不连续，切换瞬间权重变化率突变，对应着力矩的冲击。

4.2 切换时还需要同步处理的其他变量

光切换位置角还不够。注入法和SMO各自都带一个转速估计通道。注入法通过位置误差PI输出的转速，SMO通过PLL输出的转速，两者数值在过渡区间通常不一致。如果只切位置角而转速还各自独立，转速环就会乱。所以转速也要同样加权混合。

另外，两个观测器的初始积分状态要保持同步。切换到SMO时，SMO的积分器初始值必须等于注入法的当前输出值，否则SMO从零状态开始建立，至少要花几百毫秒收敛，这段时间位置角完全不可用。我用了一个简单的变量初始化机制：在THETA端子上接一个1-z⁻¹的差分逻辑，切换瞬间把当前值写入SMO积分器的初始条件。Simulink里通过Set Initial Value的From Workspace变量绑过去。

4.3 防止频繁切换的迟滞策略

如果系统在切换阈值附近来回晃，权重会在150rpm上下反复跳变，注入和SMO的输出来回交替，系统会非常不稳定。我的做法是引入迟滞比较：进入300rpm以上的区域后，必须回落到250rpm以下才退出SMO主导区；进入150rpm以下区域后，必须回升到200rpm以上才退出注入主导区。实际效果是切换决策一旦做出，就不会因为微小波动立刻反悔。

5. 整套Simulink仿真的实际搭建过程

5.1 仿真架构总览

整套模型分五个主要部分：

• 永磁同步电机本体
• 三相逆变器
• 电流采样与坐标变换
• 观测器模块（注入法观测器 + SMO观测器）
• 切换与闭环控制模块（转速环PI、电流环PI、SVPWM）

我用的电机参数：

注意Ld和Lq不等，凸极率约2，这保证了高频注入法有足够的凸极效应可以使用。内嵌式永磁电机（IPM）天然适合这种方案，表贴式（SPM）凸极率接近1的话，高频注入法的信号会非常微弱，很难解调。

5.2 注入法观测器的Simulink核心代码

这里给出Matlab Function的核心实现，供参考。

function [theta_est, speed_est] = hf_inj_observer(ia, ib, ic, theta_prev, Ts) % 坐标变换 ialpha = ia; ibeta = (ia + 2*ib) / sqrt(3); % 高频电流提取，前面已得到解调后的误差信号 % 这一步假设err_signal已经通过采样差分得到 err_signal = theta_prev * 0; % 占位 % PI调节器，带宽80Hz Kp_pi = 3.5; Ki_pi = 150; err_integral = err_integral + err_signal * Ts; speed_est = Kp_pi * err_signal + Ki_pi * err_integral; % 位置积分 theta_est = theta_prev + speed_est * Ts; end

实际模型中，q轴高频电流的采样和差分解调会更复杂，建议直接用Simulink的采样保持器（Sample & Hold）来实现半个注入周期末端的电流捕获。

5.3 SMO观测器的Simulink搭建要点

这一块我全部用的基础模块搭建，没有用内嵌函数，方便大家看清数据流：

• 电流误差计算：用加法器减法器
• 滑模控制项：sgn函数用Sign模块，增益用Gain模块
• 反电动势滤波：一阶低通滤波器，截止频率500Hz
• 扩展反电动势处理：将滤波后的反电动势送入PLL
• PLL结构：标准二阶环路，PI输出为转速，积分输出为角度

有个细节需要注意：SMO的滑模增益不要一开始就给满，否则启动瞬间电流冲击很大。我采用的是随转速线性增长的增益策略，转速低于500rpm时增益只有稳定值的一半，到2000rpm时逐步加满。

5.4 加权切换的Simulink编程实现

用Matlab Function写切换逻辑是最清晰的。

function [theta_out, speed_out, w_smo] = speed_switch(theta_inj, speed_inj, theta_smo, speed_smo, speed_ref, n_low, n_high) % 当前实际转速估算值 speed_est = speed_smo; % 用SMO估算用于切换判断（在过渡区速度已可靠） % 迟滞逻辑 persistent state_high; if isempty(state_high) state_high = false; end if speed_est > n_high state_high = true; elseif speed_est < (n_high - 50) state_high = false; end % 权重计算 if speed_est <= n_low w_smo = 0; elseif speed_est >= n_high w_smo = 1; else % S曲线权重 w_smo = 0.5 - 0.5 * cos(pi * (speed_est - n_low) / (n_high - n_low)); end % 加权组合 theta_out = (1 - w_smo) * theta_inj + w_smo * theta_smo; speed_out = (1 - w_smo) * speed_inj + w_smo * speed_smo; end

需要注意Matlab Function里persistent变量的使用，在变步长仿真中持久变量在reset的时候容易出问题，建议把切换状态模块化，或者用Memory模块实现滞后逻辑。

6. 仿真中遇到的典型问题与排查实录

6.1 低速带载启动时位置角发散

现象：转速命令50rpm，负载转矩加到额定值，位置角会来回漂移，电流波形畸变。

排查过程：先检查了注入电压幅值，调大后有所改善但依然漂移。随后检查解调信号，发现q轴高频电流差分信号里混入了明显的基频分量。原因是注入频率1kHz和PWM采样频率10kHz之间相差10倍，理论上不会混叠，但电流环带宽设置的400Hz，基频分量和注入高频分量之间存在交互。解决方式是在解调链路里增加一个较高的带通滤波器（中心频率1kHz，带宽200Hz），同时把电流环带宽降到200Hz，问题解决。

这个案例给到的经验是：注入频率和电流环带宽之间至少要隔3到5倍，给滤波器留出足够的过渡带空间。

6.2 SMO在中高速切换到高速时角度滞后过大

现象：转速超过2500rpm后，q轴电流增大，输出转矩下降，电机无法升到额定转速。

排查：通过将观测角度和实际角度对比，发现超过2500rpm后滞后急剧增大到十几度。低通滤波器截止频率500Hz，在2500rpm时电频率约167Hz，此时滞后约18度。调整方案：把截止频率从500Hz提高到1kHz，同时把相位补偿系数调大，最终在3000rpm保持误差在4度以内。

6.3 切换点转速波动

现象：从300rpm加速到500rpm过程中，转速有周期性波动，波动幅度约30rpm。

排查：在切换点附近观察权重和位置角的混合过程，发现S曲线权重没有问题，但两个观测器的位置角之间存在一个约8度的相位差。这个8度是两种方法在过渡区内的固有误差差异。处理办法不是消除这个差值，而是让切换更平滑——把切换区间从150/300扩展为150/450rpm，让斜坡更长。延长切换区让位置角有更长时间过渡，转速波动下降到5rpm以内。

6.4 减小SMO抖振的实用技巧

SMO天生存在抖振，仿真里不会导致硬件损坏，但会让转速估计噪声很大。我的处理方式：

• 用饱和函数（sat）替代符号函数（sgn），边界层厚度0.01。
• 反电动势输出后级联一个截止频率500Hz到1kHz的低通滤波器。
• PLL带宽不要太高，50Hz左右足够。
• 电流采样使用平均值采样替代瞬时值采样，利用PWM中心对齐特性。

7. 给新手的参数整定速查表

8. 关于整套方案的个人体会

这次仿真做完，最大的感受是：算法本身的数学推导很多人都会，真正决定系统能不能稳定运行的，是滤波器延时、控制器带宽分配、切换逻辑的一致性这些工程细节。比如相位补偿，原理一句话能讲完，但不实测不建模，永远不知道滞后量比你想象的大得多。

另外，整套系统在Simulink里跑顺了以后，往代码移植时还是要重新过一次时序。仿真里你用Simulink的连续模块把一阶滤波器当成理想模拟器件，MCU上是离散实现，计算周期、采样延时都不一样。我移植到实际控制板时，把注入频率从1kHz下调到800Hz，给中断服务程序留出更多裕量，才最终稳定。

最后还想提一个容易被忽略的点：仿真中的负载模型要尽量贴近实际。我带载启动时用的负载是风机类负载（转矩正比于转速平方），而不是恒定转矩负载，两种负载对切换区和观测器收敛性的考验完全不同。如果你做仿真只是为了跑通波形，恒定负载没问题；但如果今后要上实际设备，建议一定用贴近实际工况的负载模型多压测几次。