lead1.m

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

function [ngc,dgc]=lead1(ng0,dg0,s1)
ngv=polyval(ng0,s1); dgv=polyval(dg0,s1);
g=ngv/dgv; theta=angle(g); phi=angle(s1);
if theta>0
phi_c=pi-theta;
end
if theta<0;
phi_c=-theta
end
theta_z=(phi+phi_c)/2; theta_p=(phi-phi_c)/2;
z_c=real(s1)-imag(s1)/tan(theta_z);
p_c=real(s1)-imag(s1)/tan(theta_p);
nk=[1 -z_c]; dgc=[1 -p_c]; kc=abs(p_c/z_c);
if theta<0
kc=-kc
end
ngc=kc*nk;