lead1.m

来自「matlab在控制系统中的应用（内附使用方法及每章内容、程序）」· M 代码 · 共 18 行

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;