简介面向永磁同步电机控制方向的学习者与工程技术人员这套基于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/3iα (2/3)(ia − 0.5·ib − 0.5·ic)iβ (1/√3)(ib − ic)。Park 变换再把 αβ 轴变量旋转到随转子同步运动的 dq 坐标系id iα·cosθe iβ·sinθeiq −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 模型与 id0 控制在 dq 旋转坐标系下PMSM 的电压方程、磁链方程和转矩方程可以写成一组常系数微分方程ud Rs·id Ld·did/dt − ωe·Lq·iquq Rs·iq Lq·diq/dt ωe·(Ld·id ψf)Te 1.5·p·(ψf·iq (Ld − Lq)·id·iq)其中 ωe p·ωmp 是极对数ωm 是机械转速。这套方程就是第 3 章双闭环控制的被控对象模型也是第 4 章 EKF 做状态预测时用到的状态方程。高速时 ωe 变大交叉耦合项 ωe·Lq·iq 和 ωe·(Ld·id ψf) 的幅值跟着变大如果不做前馈补偿转速越高电流环越难稳。id0 控制是表贴式 PMSMLd ≈ Lq最常用的策略。代入转矩方程Ld − Lq 项归零Te 1.5·p·ψf·iq转矩和 q 轴电流严格成正比这就是“转矩内环”的直接含义内环控 iq 就是控转矩。对这种策略d 轴电流环的目标值恒为 0剩下的事情就是让两个电流环分别跟踪 id* 和 iq*。内置式电机的 Ld 与 Lq 差值大id0 并不是最优工作点需要 MTPA 或弱磁控制那是另一套逻辑这个模型不展开。参数符号物理含义示例数值定子电阻Rs每相绕组电阻0.958 Ωd 轴电感Ldd 轴等效电感5.25 mHq 轴电感Lqq 轴等效电感5.25 mH永磁磁链ψf转子永磁体产生的磁链0.1827 Wb极对数p转子极对数4转动惯量J转子加负载折算惯量0.003 kg·m²这组示例参数取自一套常见的表贴式 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_iKi_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/KtKi_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_i32.99, Ki_i6020转速环 Kp_n3.439, Ki_n1080。逻辑上电流环的 Kp 压着电感使电流快速跟踪Ki 对消电阻压降以消除稳态误差转速环的 Kp 决定抗负载扰动的刚度Ki 负责把转速稳态误差压到零。脚本里 ζ 取 1 是临界阻尼超调小如果希望转速响应更快可以把 ζ 降到 0.707对应 Kp_n 缩小转速超调变大。把输出填进 Simulink 的 PI 模块后先跑空载阶跃再把负载转矩加上去观察 dq 电流是否还有稳态偏差。环路参数初始值调整方向电流环id/iqKp_i33.0电流响应慢就适当增大注意电流纹波电流环id/iqKi_i6.02×10³稳态电流偏差小时不动偏差大再增转速环Kp_n3.44转速抗扰动不足时增太大引起转矩脉动转速环Ki_n1.08×10³转速静差存在时增振荡时先减 Ki这套初始值只在 id0 控制且电流内环带宽远大于转速环的前提下成立。改开关频率、换电机、加弱磁都需要重新跑一遍脚本之前调好的 PI 不能直接搬。3.4 解耦补偿项与抗积分饱和PI 输出的 ud、uq 只是反馈控制量真正给到 Park 逆变换的电压还要加上解耦前馈项把 2.3 节那两项交叉耦合压掉ud_ff −ωe·Lq·iquq_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) / Lddiq/dt (uq − Rs·iq − p·ωm·(Ld·id ψf)) / Lqdωm/dt (Te − B·ωm) / Jdθ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/iqH 是 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 形式在长时仿真里更稳。符号含义维度x状态向量 [id, iq, ωm, θe]4×1u控制输入 [ud, uq]2×1z电流测量 [id_mea, iq_mea]2×1F / A连续/离散状态转移雅可比4×4H观测矩阵2×4Q过程噪声协方差4×4R测量噪声协方差2×24.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 的对角元观察转速估计波形和电角度误差。现象优先调整项调整方向稳态转速估计纹波大Q(3,3)减小模型噪声过大会让估计跟着测量抖启动阶段转速跟踪明显滞后Q(3,3)、Q(4,4)增大提高对模型偏差的补偿能力电角度漂移、低速定位不准Q(4,4)、P(4,4)增大 Q(4,4)检查初始角度是否给错波形整体发散Q、R 同时先检查 dt 是否和模型步长一致再缩小 Q判断收敛质量时不要看单条波形。把 θe 估算值和真实值带编码器仿真里可以直接拉出来做差稳态偏差在 ±3° 以内、转速纹波小于额定转速的 2%才算这组 Q/R 可用。最后把每组 Q/R 跑出来的电角度误差 IAE 和转速超调记在参数表里先做 500 r/min 再做 1500 r/min 阶跃低速看收敛、高速看跟踪两组波形对照之后是观测器问题还是 PI 带宽问题立刻就能区分开。本文还有配套的精品资源点击获取 
长河君 · 2026/9/14 5:28:32 · 阅读 1.2k 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/3iα (2/3)(ia − 0.5·ib − 0.5·ic)iβ (1/√3)(ib − ic)。Park 变换再把 αβ 轴变量旋转到随转子同步运动的 dq 坐标系id iα·cosθe iβ·sinθeiq −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 模型与 id0 控制在 dq 旋转坐标系下PMSM 的电压方程、磁链方程和转矩方程可以写成一组常系数微分方程ud Rs·id Ld·did/dt − ωe·Lq·iquq Rs·iq Lq·diq/dt ωe·(Ld·id ψf)Te 1.5·p·(ψf·iq (Ld − Lq)·id·iq)其中 ωe p·ωmp 是极对数ωm 是机械转速。这套方程就是第 3 章双闭环控制的被控对象模型也是第 4 章 EKF 做状态预测时用到的状态方程。高速时 ωe 变大交叉耦合项 ωe·Lq·iq 和 ωe·(Ld·id ψf) 的幅值跟着变大如果不做前馈补偿转速越高电流环越难稳。id0 控制是表贴式 PMSMLd ≈ Lq最常用的策略。代入转矩方程Ld − Lq 项归零Te 1.5·p·ψf·iq转矩和 q 轴电流严格成正比这就是“转矩内环”的直接含义内环控 iq 就是控转矩。对这种策略d 轴电流环的目标值恒为 0剩下的事情就是让两个电流环分别跟踪 id* 和 iq*。内置式电机的 Ld 与 Lq 差值大id0 并不是最优工作点需要 MTPA 或弱磁控制那是另一套逻辑这个模型不展开。参数符号物理含义示例数值定子电阻Rs每相绕组电阻0.958 Ωd 轴电感Ldd 轴等效电感5.25 mHq 轴电感Lqq 轴等效电感5.25 mH永磁磁链ψf转子永磁体产生的磁链0.1827 Wb极对数p转子极对数4转动惯量J转子加负载折算惯量0.003 kg·m²这组示例参数取自一套常见的表贴式 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_iKi_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/KtKi_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_i32.99, Ki_i6020转速环 Kp_n3.439, Ki_n1080。逻辑上电流环的 Kp 压着电感使电流快速跟踪Ki 对消电阻压降以消除稳态误差转速环的 Kp 决定抗负载扰动的刚度Ki 负责把转速稳态误差压到零。脚本里 ζ 取 1 是临界阻尼超调小如果希望转速响应更快可以把 ζ 降到 0.707对应 Kp_n 缩小转速超调变大。把输出填进 Simulink 的 PI 模块后先跑空载阶跃再把负载转矩加上去观察 dq 电流是否还有稳态偏差。环路参数初始值调整方向电流环id/iqKp_i33.0电流响应慢就适当增大注意电流纹波电流环id/iqKi_i6.02×10³稳态电流偏差小时不动偏差大再增转速环Kp_n3.44转速抗扰动不足时增太大引起转矩脉动转速环Ki_n1.08×10³转速静差存在时增振荡时先减 Ki这套初始值只在 id0 控制且电流内环带宽远大于转速环的前提下成立。改开关频率、换电机、加弱磁都需要重新跑一遍脚本之前调好的 PI 不能直接搬。3.4 解耦补偿项与抗积分饱和PI 输出的 ud、uq 只是反馈控制量真正给到 Park 逆变换的电压还要加上解耦前馈项把 2.3 节那两项交叉耦合压掉ud_ff −ωe·Lq·iquq_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) / Lddiq/dt (uq − Rs·iq − p·ωm·(Ld·id ψf)) / Lqdωm/dt (Te − B·ωm) / Jdθ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/iqH 是 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 形式在长时仿真里更稳。符号含义维度x状态向量 [id, iq, ωm, θe]4×1u控制输入 [ud, uq]2×1z电流测量 [id_mea, iq_mea]2×1F / A连续/离散状态转移雅可比4×4H观测矩阵2×4Q过程噪声协方差4×4R测量噪声协方差2×24.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 的对角元观察转速估计波形和电角度误差。现象优先调整项调整方向稳态转速估计纹波大Q(3,3)减小模型噪声过大会让估计跟着测量抖启动阶段转速跟踪明显滞后Q(3,3)、Q(4,4)增大提高对模型偏差的补偿能力电角度漂移、低速定位不准Q(4,4)、P(4,4)增大 Q(4,4)检查初始角度是否给错波形整体发散Q、R 同时先检查 dt 是否和模型步长一致再缩小 Q判断收敛质量时不要看单条波形。把 θe 估算值和真实值带编码器仿真里可以直接拉出来做差稳态偏差在 ±3° 以内、转速纹波小于额定转速的 2%才算这组 Q/R 可用。最后把每组 Q/R 跑出来的电角度误差 IAE 和转速超调记在参数表里先做 500 r/min 再做 1500 r/min 阶跃低速看收敛、高速看跟踪两组波形对照之后是观测器问题还是 PI 带宽问题立刻就能区分开。本文还有配套的精品资源点击获取