pid1.m

《MATLAB在控制系统中的应用》实例程序

% ------ pid1.m ------
% 摆杆角度PID控制
% 输入倒立摆传递函数 G1(S)=num1/den1
M = 0.5;
m = 0.2;
b = 0.1;
I = 0.006;
g = 9.8;
l = 0.3;
q = (M+m)*(I+m*l^2)-(m*l)^2;  
num1 = [m*l/q  0 0];
den1 = [1  b*(I+m*l^2)/q  -(M+m)*m*g*l/q  -b*m*g*l/q 0];
% 输入控制器PID数学模型 Gc(s)=numPID/denPID
Kp = 1;
Ki = 1; 
Kd = 1;
numPID = [Kd Kp Ki];
denPID = [1 0];
% 计算闭环系统传递函数G(s)=num/den
% 多项式相乘
num = conv(num1,denPID);
% 多项式相加
den = polyadd(conv(denPID,den1),conv(numPID,num1 ));
% 求整个系统传递函数的极点
[r,p,k] = residue(num,den);
% 显示极点
s = p 
% 求取多项式传递函数的脉冲响应
t=0:0.005:5;
impulse(num,den,t)
% 显示范围：横坐标0-5，纵坐标0-10，此条语句参数可根据仿真输出曲线调整
axis([0 5 0 10])
grid
% ------ end ------