PMSM矢量控制Simulink仿真：双闭环与EKF无感观测器建模

简介：面向永磁同步电机控制方向的学习者与工程技术人员，这套基于Simulink的矢量控制资料，围绕电机数学模型搭建、双闭环解耦控制及无位置传感器估算，帮助读者掌握比例积分调节器参数整定到扩展卡尔曼滤波状态观测的实现路径。资料依据永磁同步电机的数学模型搭建仿真模型，采用转速外环与转矩内环的双闭环结构，基于比例积分调节器完成电流解耦控制；同时提供扩展卡尔曼滤波和自适应扩展卡尔曼滤波两种算法，用于估算转子电角度与机械转速，观测器代码使用静态变量方式定义，结构清晰，便于学习者修改与调试。资料强调文档详实、代码规范，适合课程设计、毕业设计或工程预研阶段对照学习。资源包为zip压缩格式，大小约五百三十二千字节，下载页未提供文件总数与类型明细。目前已有八十七人浏览学习，对需要深入理解永磁同步电机矢量控制原理并快速搭建仿真模型的读者具有较高参考价值。

1. Simulink 里搭 PMSM 矢量控制，跑飞是常态，不是例外

在 Simulink 里把一台永磁同步电机的矢量控制模型跑通，和把转速环带宽调过电流环之后听它啸叫，是两回事。转速外环一激进，转矩内环的 dq 轴电流就开始互相拉扯，仿真曲线在几毫秒内发散变红，线下板子直接过流报警。遇到这种情况，多数人的第一反应是去调 PI 参数，但问题往往不在 PI 本身，而是被控对象的耦合关系没有建模清楚。这套基于 PMSM 数学模型的 Simulink 仿真工程，把整条链路拆成三段：先按 dq 坐标系下的电压方程把电机本体搭出来，再用 PI 调节器实现转速外环加转矩内环的双闭环解耦控制，最后用 EKF 和 AEKF 从电流信号里估算转子电角度和机械转速，省掉编码器，为后续做 FOC 无感控制留好接口。模型自带的文档把每一级模块的公式出处都标了出来，代码也按可读性整理过，适合正在入门矢量控制、或者需要一套可改参数的 PMSM 仿真平台做算法验证的工程师和学生。

2. PMSM 的 dq 数学模型与坐标变换：先把被控对象写对

2.1 三相静止坐标系下的电压方程：耦合是麻烦的根源

PMSM 在三相静止坐标系里的定子电压方程写出来并不长：每一相电压等于电阻压降加上该相磁链的变化率。麻烦在于磁链不是常数——转子永磁体旋转，定子绕组轴线和转子磁极的相对位置时刻在变，导致三相绕组的自感和互感都是转子电角度 θe 的函数。转子每转一圈，电感矩阵里的三角函数项就完整变化一个周期，方程组的系数一直在跳变。

这种情况下，直接对三相电流设计线性控制器，PMSM 在高速段容易失控：转矩和电流的对应关系随位置波动，控制器的增益只能按最恶劣工况折中，低速沉、高速振。绕组间的互感还会让每一相电流都受到另外两相变化率的影响，电流环带宽稍微推高，d 轴和 q 轴的动态就会互相牵制，表现出来就是转矩脉动变大、转速波形出现与电频率相关的纹波。反过来说，如果能找到一个旋转坐标系，让电感矩阵变常数，控制问题就退化成两个相对独立的通道，这就是 dq 变换存在的理由。

2.2 Clark 变换与 Park 变换：把时变系数变成常数

变换分两步。Clark 变换把三相电流映射到静止的 αβ 坐标系，等幅值约定下取系数 2/3：iα = (2/3)(ia − 0.5·ib − 0.5·ic)，iβ = (1/√3)(ib − ic)。Park 变换再把 αβ 轴变量旋转到随转子同步运动的 dq 坐标系：id = iα·cosθe + iβ·sinθe，iq = −iα·sinθe + iβ·cosθe。两步合起来，电感矩阵里的位置相关项全部消失，只剩两个明确的交叉耦合项：ωe·Lq·iq 和 ωe·(Ld·id + ψf)，这两项在控制里用前馈补偿处理，后面第 3 章会专门讲。

import numpy as np def clark(ia, ib, ic): # 等幅值 Clarke 变换：三相电流 -> alpha/beta 轴 ialpha = (2.0 / 3.0) * (ia - 0.5 * ib - 0.5 * ic) ibeta = (2.0 / 3.0) * (np.sqrt(3.0) / 2.0) * (ib - ic) return ialpha, ibeta def park(ialpha, ibeta, theta_e): # Park 变换：静止坐标系 -> 与转子磁链对齐的 dq 坐标系 id_ = ialpha * np.cos(theta_e) + ibeta * np.sin(theta_e) iq_ = -ialpha * np.sin(theta_e) + ibeta * np.cos(theta_e) return id_, iq_

这段代码对应控制环路里的测量通路：采样三相电流，经 Clark 和 Park 得到反馈用的 id、iq。等幅值约定的系数 2/3 直接决定了后面转矩公式里的系数是 1.5；如果换成等功率变换，转矩公式的系数要跟着改成 1，否则整个模型的扭矩标定都是错的。Park 变换需要的 θe 在带编码器的方案里来自编码器，在无感方案里来自 EKF/AEKF 的估算输出，这就是第 4 章观测器要解决的问题。

注意：等幅值变换和等功率变换是两套系数体系，混用会导致转矩计算差 1.5 倍，Simulink 里如果同时用了自带的 Clarke/Park 模块和自己写的 S-Function，务必先核对系数约定。

2.3 dq 坐标系下的 PMSM 模型与 id=0 控制

在 dq 旋转坐标系下，PMSM 的电压方程、磁链方程和转矩方程可以写成一组常系数微分方程：

ud = Rs·id + Ld·did/dt − ωe·Lq·iq

uq = Rs·iq + Lq·diq/dt + ωe·(Ld·id + ψf)

Te = 1.5·p·(ψf·iq + (Ld − Lq)·id·iq)

其中 ωe = p·ωm，p 是极对数，ωm 是机械转速。这套方程就是第 3 章双闭环控制的被控对象模型，也是第 4 章 EKF 做状态预测时用到的状态方程。高速时 ωe 变大，交叉耦合项 ωe·Lq·iq 和 ωe·(Ld·id + ψf) 的幅值跟着变大，如果不做前馈补偿，转速越高电流环越难稳。

id=0 控制是表贴式 PMSM（Ld ≈ Lq）最常用的策略。代入转矩方程，Ld − Lq 项归零，Te = 1.5·p·ψf·iq，转矩和 q 轴电流严格成正比，这就是“转矩内环”的直接含义：内环控 iq 就是控转矩。对这种策略，d 轴电流环的目标值恒为 0，剩下的事情就是让两个电流环分别跟踪 id* 和 iq*。内置式电机的 Ld 与 Lq 差值大，id=0 并不是最优工作点，需要 MTPA 或弱磁控制，那是另一套逻辑，这个模型不展开。

这组示例参数取自一套常见的表贴式 PMSM 仿真模型，后面第 3 章的 PI 整定和第 4 章的 EKF 初值都以它为准。搭 Simulink 模型时建议把参数写成 MATLAB 工作区变量或者 Mask 参数，不要直接写死在模块里，这样后续换电机只需要改一个参数脚本，不用逐个模块翻。

3. 双闭环 dq 解耦控制：转速外环 + 转矩内环的 PI 整定

3.1 带宽分配：外环内环怎么分工

双闭环结构上很简单：转速外环把给定转速和反馈转速的误差经过 PI 运算，输出 q 轴电流给定 iq*，作为转矩内环的指令；电流内环跟踪 id*、iq*，输出 dq 轴电压，再经坐标反变换和 SVPWM 驱动逆变器。这里的前提条件只有一个：电流内环的动态响应要明显快于转速外环，否则外环输出的 iq* 变化时，内环跟踪不上，电流相位滞后，dq 轴出现交叉耦合，整个系统就会振荡。

工程上经验分配是电流环带宽取转速环的 5~10 倍，数值上受开关频率约束。开关频率 f_sw 决定了电流环的实际控制频率，每个 PWM 周期更新一次电流环输出，考虑一拍计算延迟后，电流环带宽设计在 f_sw/10 附近比较稳妥。比如 f_sw = 10 kHz，电流环带宽取 1 kHz 左右；转速环带宽再降到 100~200 Hz。带负载扰动时，转速环的响应速度决定了转速跌落幅度，带宽太低则负载突变后转速恢复慢，带宽太高则 iq* 频繁冲击电流环限幅，两者需要折中。先把这套带宽关系写死在设计里，后面整定才不会把内环推上不稳定的增益。

3.2 电流环 PI 参数：极点配置法的推导

电流环被控对象是 R-L 一阶电路加上反电动势扰动。忽略反电动势变化，从电压到电流的传递函数近似为 1/(L·s + R)。让 PI 调节器的零点对消被控对象的极点，即 Ki/Kp = Rs/Ld，闭环特征方程变成一阶方程，带宽直接由 Kp/Ld 决定。按期望带宽 ωc_i 反推：

Kp_i = Ld·ωc_i，Ki_i = Rs·ωc_i

这个结果是解析的，不需要试凑。需要注意两点：一是 ωc_i 的单位是 rad/s，设计时用 2π×期望频率换算；二是数字控制在离散化后会引入 1.5 拍等效延迟，所以 ωc_i 别超过 f_sw/10 太多，否则相位裕度不够，实际电流环会振荡，电流波形出现与开关频率相关的毛刺。

3.3 转速环整定与离线验证脚本

转速环的被控对象从 iq* 到机械转速 ωm，中间串联了转矩常数 Kt = 1.5·p·ψf 和转子转动惯量 J，近似为 Kt/(J·s)，而电流内环在带宽足够高的前提下可以等效成一阶惯性环节 1/(1 + s/ωc_i)。按临界阻尼（ζ = 1）配置转速环闭环极点，令自然频率 ωc_n = ωc_i/10，得到：

Kp_n = 2·ζ·ωc_n·J/Kt，Ki_n = ωc_n²·J/Kt

这些公式写成脚本，换电机参数时直接跑一遍就出初始值。下面这个 Python 脚本用的是和模型一致的电机参数，输出的数值可以直接填进 Simulink 的 PI 模块，再根据仿真波形微调。

import math # 表贴式 PMSM 参数，与 Simulink 模型保持一致 Rs = 0.958 # 定子电阻 Ω Ld = 0.00525 # d 轴电感 H Lq = 0.00525 # q 轴电感 H flux = 0.1827 # 永磁磁链 Wb p = 4 # 极对数 J = 0.003 # 转动惯量 kg·m^2 B = 0.008 # 阻尼系数 N·m·s f_sw = 10000 # 逆变器开关频率 Hz wc_i = 2 * math.pi * f_sw / 10 # 电流环带宽 rad/s，取 f_sw/10 Kp_i = Ld * wc_i # 电流环 Kp：带宽由 Kp/Ld 决定 Ki_i = Rs * wc_i # 电流环 Ki：零点对消电机极点 wc_n = wc_i / 10 # 转速环带宽 rad/s，取电流环 1/10 zeta = 1.0 # 临界阻尼配置 Kt = 1.5 * p * flux # 转矩常数 N·m/A Kp_n = 2 * zeta * wc_n * J / Kt # 转速环 Kp Ki_n = wc_n * wc_n * J / Kt # 转速环 Ki print(f"电流环 Kp_i={Kp_i:.2f}, Ki_i={Ki_i:.0f}") print(f"转速环 Kp_n={Kp_n:.3f}, Ki_n={Ki_n:.0f}")

脚本输出：电流环 Kp_i=32.99, Ki_i=6020；转速环 Kp_n=3.439, Ki_n=1080。逻辑上，电流环的 Kp 压着电感使电流快速跟踪，Ki 对消电阻压降以消除稳态误差；转速环的 Kp 决定抗负载扰动的刚度，Ki 负责把转速稳态误差压到零。脚本里 ζ 取 1 是临界阻尼，超调小；如果希望转速响应更快，可以把 ζ 降到 0.707，对应 Kp_n 缩小，转速超调变大。把输出填进 Simulink 的 PI 模块后，先跑空载阶跃，再把负载转矩加上去，观察 dq 电流是否还有稳态偏差。

这套初始值只在 id=0 控制且电流内环带宽远大于转速环的前提下成立。改开关频率、换电机、加弱磁，都需要重新跑一遍脚本，之前调好的 PI 不能直接搬。

3.4 解耦补偿项与抗积分饱和

PI 输出的 ud、uq 只是反馈控制量，真正给到 Park 逆变换的电压还要加上解耦前馈项，把 2.3 节那两项交叉耦合压掉：

ud_ff = −ωe·Lq·iq，uq_ff = ωe·(Ld·id + ψf)

反馈加前馈之后，d 轴通道里不再有来自 q 轴电流的反电动势串扰，q 轴通道里的永磁磁链项也被抵消，两个电流环才能当作独立的线性系统看待。Simulink 里用乘积模块和求和模块即可实现，但 ωe 和 id/iq 都是反馈量，直接连线会引入代数环。

提示：前馈通路上串一个 Unit Delay，用上一拍的值做补偿。这一拍延迟对带宽低于 f_sw/10 的电流环影响很小，换来的是模型不用解代数环，仿真步长可以放得更开。

两个 PI 调节器都要加输出限幅和抗积分饱和：电流环的限幅对应逆变器最大输出电压，转速环的限幅对应允许的最大 iq*。Simulink 自带的 PI 模块支持限幅回馈到积分器，勾上 anti-windup 选项即可，不要只在输出端用 Saturation 硬截断，那样积分器会继续累加误差，恢复瞬间会猛甩一个尖峰。

4. EKF 与 AEKF 估算转子电角度和机械转速

4.1 无感 FOC 为什么绕不开观测器

去掉编码器之后，能直接测到的只有相电流和母线电压，转子电角度和机械转速都不可测。但第 2 章的坐标变换和第 3 章的闭环控制都依赖 θe 和 ωe，这就必须从可测的电流信号里把这两个状态实时估算出来。PMSM 的 dq 模型带乘积项（ωe·iq、ωe·id），系统是非线性的，常规龙贝格观测器用固定增益，在宽速域下很难同时满足低速稳定性与高速跟踪性。

EKF 的思路是对非线性状态方程在每个工作点做一阶泰勒展开，用预测-校正两步递归得到状态估计。对 PMSM 这种强耦合但模型结构清晰的系统，EKF 的收敛性和估算精度在开关频率足够高时表现稳定，而且实现上就是矩阵运算，代码写出来是固定流程，不像滑模观测器那样要专门处理抖振问题。AEKF 则是在 EKF 的框架里在线估计噪声统计特性，电机工况变化（比如负载突变）时，固定 Q/R 组合会失配，AEKF 用新息序列实时修正 R，估算抖动会小一些。

4.2 EKF 在 PMSM 上的状态方程与雅可比矩阵

取状态向量 x = [id, iq, ωm, θe]^T，输入 u = [ud, uq]^T，测量 z = [id, iq]^T。连续时间状态方程从前面的 dq 模型直接搬过来：

did/dt = (ud − Rs·id + p·ωm·Lq·iq) / Ld

diq/dt = (uq − Rs·iq − p·ωm·(Ld·id + ψf)) / Lq

dωm/dt = (Te − B·ωm) / J

dθe/dt = p·ωm

把状态方程对 x 求偏导得到雅可比矩阵 F，离散化时用一阶近似 A ≈ I + F·dt。F 中关键的两个偏导项：第三行对 iq 的偏导来自 Te 里的 1.5·p·ψf·iq，第四行对 ωm 的偏导就是极对数 p。观测矩阵 H 只取前两列，因为可测的只有电流。这个模型假设负载转矩 TL 归入 Q 阵的模型噪声里，不单独作为状态估计；如果负载频繁突变且幅值大，可以把 TL 加进状态向量，代价是雅可比矩阵从 4×4 变成 5×5，计算量增加不明显，但调参难度会上升。

4.3 Python 实现 EKF 预测-校正循环

import numpy as np def pmsp_ekf_step(x, u, z, dt, P, Q, R, prm): # x: 状态向量 [id, iq, wm, theta_e] # u: 控制输入 [ud, uq]，z: 电流测量 [id_mea, iq_mea] id_, iq_, wm, theta = x ud, uq = u Rs, Ld, Lq, flux, p, J, B = prm # 预测：按 dq 模型积分一拍 Te = 1.5 * p * (flux * iq_ + (Ld - Lq) * id_ * iq_) f = np.array([ (ud - Rs * id_ + p * wm * Lq * iq_) / Ld, (uq - Rs * iq_ - p * wm * (Ld * id_ + flux)) / Lq, (Te - B * wm) / J, wm ]) x_pred = x + f * dt # 雅可比矩阵 F（对状态 x 求偏导），用于协方差传递 F = np.array([ [-Rs / Ld, p * wm * Lq / Ld, p * Lq * iq_ / Ld, 0], [-p * wm * Ld / Lq, -Rs / Lq, -p * (Ld * id_ + flux) / Lq, 0], [1.5 * p * (Ld - Lq) * iq_ / J, 1.5 * p * (flux + (Ld - Lq) * id_) / J, -B / J, 0], [0, 0, p, 0] ]) A = np.eye(4) + F * dt P_pred = A @ P @ A.T + Q # 校正：只观测 id/iq，H 是 2x4 矩阵 H = np.array([[1, 0, 0, 0], [0, 1, 0, 0]]) S = H @ P_pred @ H.T + R K = P_pred @ H.T @ np.linalg.inv(S) y = z - H @ x_pred x_upd = x_pred + K @ y # Joseph 形式的协方差更新，数值上保证 P 半正定 I = np.eye(4) P_upd = (I - K @ H) @ P_pred @ (I - K @ H).T + K @ R @ K.T return x_upd, P_upd

每个仿真步长调用一次这个函数。预测步用电机模型推一拍，协方差 P 通过雅可比矩阵更新，反映状态估计的不确定度在变大；校正步用电流测量值计算新息，卡尔曼增益 K 决定相信模型多一点还是相信测量多一点。Q 越大，模型不确定性越大，K 越偏向信任电流测量；R 越大，电流测量越脏，K 越偏向模型预测。F 矩阵第三行第二列是转矩对 iq 的偏导，表贴式电机 Ld = Lq 时括号内第二项里的 (Ld − Lq)·id 归零，只剩 1.5·p·ψf/J；如果模型里含凸极效应，这一项要保留。协方差更新用 Joseph 形式而不是简化的 P = (I − KH)P，因为每次更新时减法运算容易破坏对称性和半正定性，Joseph 形式在长时仿真里更稳。

4.4 AEKF 的自适应调整思路与正定性约束

AEKF 与 EKF 的唯一区别在于，每个步长用新息序列在线修正 R 或 Q。简化版本的 Sage-Husa 自适应律令 d_k = (1 − b)/(1 − b^k)，b 取 0.95~0.99，遗忘因子越小，自适应响应越快，但方差估计也越抖：

R_k = (1 − d_k)·R_{k−1} + d_k·(r_k·r_k^T − H·P_pred·H^T)

其中 r_k = z_k − H·x_pred 是新息。注意从括号里减去 H·P·H^T 之后，R 的对角元可能被减成负值，协方差矩阵要求半正定，所以实现时必须加保护。

注意：R 自适应更新后，对角元要做下限保护，比如统一取 max(diag_value, 1e-6)，否则一个负的对角元会让卡尔曼增益出现负增益，估算直接发散。

工程实践中，Q 一般保持固定，只让 R 自适应，因为 R 的物理意义更明确，就是电流传感器的噪声水平，工况变化时它的变化趋势好预测。如果连 Q 一起自适应，两个矩阵同时动，很容易出现 Q、R 互相补偿导致估计方差虚小，看起来收敛但实际上对参数失配没有鲁棒性。

5. 把 EKF 工程化写进 Simulink：静态变量、Q/R 整定与波形判读

5.1 用 persistent 变量实现观测器模块

MATLAB Function 模块里用 persistent 声明状态变量，这样 x、P、Q、R 在两次调用之间保持住，只在第一次调用时初始化。这种写法对应到 C 代码生成，就是嵌入式 C 里的静态局部变量，状态不会每次进入函数重新置零，是工程里最通用的实现方式，也和模型里“观测器采用静态变量定义编写”的做法一致。

function [theta_est, wm_est] = ekf_observer(ud, uq, id_mea, iq_mea, dt) persistent x P Q R prm if isempty(x) x = [0; 0; 0; 0.01]; % 初始电角度给 0.01 rad，避开 0 的特殊位型 P = eye(4) * 0.1; % 初始协方差，别给太小，留收敛空间 Q = diag([1e-4, 1e-4, 1e-2, 1e-4]); % 过程噪声：机械转速通道放宽 R = diag([1e-4, 1e-4]); % 电流测量噪声，按传感器噪声量级给 prm = struct('Rs',0.958,'Ld',0.00525,'Lq',0.00525,... 'Flux',0.1827,'P',4,'J',0.003,'B',0.008); end % 预测和校正部分与第 4 章的 Python 版一致，结构相同，直接按矩阵运算改写 % x = update_ekf(x, [ud; uq], [id_mea; iq_mea], dt, P, Q, R, prm) theta_est = x(4); wm_est = x(3); end

模块输入是 ud、uq 和测量电流 id_mea、iq_mea，输出分别接给 Park 变换和转速环反馈。ud、uq 直接从电流环输出端取，但要注意是补上解耦项之后的值，不要取 PI 的原始输出，否则 EKF 模型和实际加在电机上的电压不一致，估算会偏。

提示：θe 初始值给 0.01 而不是 0，是为了避免 cos 和 sin 在零角度附近出现的数值敏感问题，某些求解器在完全对齐的初始位型上会多花时间收敛。

5.2 调 Q/R 看波形：先定 R 再动 Q

观测器的整定顺序和 PI 不同，PI 先动 Kp 再动 Ki，观测器先固定 R 只动 Q。R 的初值可以从电流传感器数据手册的噪声密度估出来，或者直接从仿真里看 id_mea 的纹波方差取量级；R 定住之后，逐个调整 Q 的对角元，观察转速估计波形和电角度误差。

判断收敛质量时不要看单条波形。把 θe 估算值和真实值（带编码器仿真里可以直接拉出来）做差，稳态偏差在 ±3° 以内、转速纹波小于额定转速的 2%，才算这组 Q/R 可用。最后把每组 Q/R 跑出来的电角度误差 IAE 和转速超调记在参数表里，先做 500 r/min 再做 1500 r/min 阶跃，低速看收敛、高速看跟踪，两组波形对照之后，是观测器问题还是 PI 带宽问题立刻就能区分开。

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