玩转控制算法与Simulink仿真：从公式到实现

代Matlab/Simulink，自动控制/电气工程仿真，教学辅导。 包括控制算法（模型预测，滑模，自适应，H无穷，鲁棒控制算法）和仿真模型（电机等，只需要对象公式即可实现），以及Simulink仿真模块制作，matlab算法实现

电机控制仿真里有个经典场景——永磁同步电机转速环控制。咱们拿模型预测控制（MPC）举个栗子，先看被控对象公式：

% PMSM机械运动方程 J*dw/dt = Te - Tl - B*w Te = 1.5*p*(psi_f*iq + (Ld-Lq)*id*iq)

这里的转速环MPC核心是滚动优化。上代码看看预测步长内的优化计算：

function u = mpc_core(x0, ref, N) % 构建QP问题 H = blkdiag(0.1*eye(N), 10*eye(N)); % 控制增量权重矩阵 f = -2*[zeros(N,1); ref*ones(N,1)]; % 目标函数线性项 % 动态约束（这里用线性化模型） Aeq = [kron(eye(N),A_model), kron(eye(N),B_model)]; beq = repmat(-A_model*x0, N, 1); options = optimoptions('quadprog','Display','off'); u_opt = quadprog(H,f,[],[],Aeq,beq,[],[],[],options); u = u_opt(1); % 取首个控制量 end

这段代码的关键在于权重矩阵的设置——0.1对应控制量变化率惩罚，10对应转速跟踪误差。实际调试时这两个参数需要根据系统惯性量调整，比如大惯量系统需要减小控制量惩罚项。

说到Simulink实现，有个骚操作是自定义S-Function模块。比如滑模控制器的切换函数：

function sys = mdlOutputs(~,~,x,u) s = x(2) - ref + lambda*(x(1)-ref_int); % 滑模面 k = 2.5; % 切换增益 iq_ref = (J/(1.5*p*psi_f))*( -k*sign(s) - B*x(2) + Tl_obs ); sys = iq_ref; end

在Simulink里封装成Masked Subsystem时，记得把lambda参数设为可调变量，仿真时直接拖滑块就能看到切换增益对抖振的影响，比改代码重新编译方便多了。

自适应控制在参数变化场景下特别有用。比如电机转动惯量J突变时的在线辨识：

% 递归最小二乘实现 function [theta, P] = rls_update(y, phi, theta_prev, P_prev) K = P_prev*phi/(1 + phi'*P_prev*phi); theta = theta_prev + K*(y - phi'*theta_prev); P = (eye(2) - K*phi')*P_prev; end

这个函数可以放在MATLAB Function模块里实时运行，配合Scope模块监视theta(1)也就是J的估计值，能看到当负载突变时，估计值大概在0.5秒内就能跟上真实值。

最后分享一个鲁棒控制调试技巧：在H无穷控制器设计后，用sigmaplot命令绘制灵敏度函数曲线，确保在所有频段都低于逆加权函数。当曲线出现尖峰时，需要重新调整加权函数的转折频率，这比直接跑时域仿真能更快定位问题。