lead5.m

来自「PID性能分析」· M 代码 · 共 15 行

function [ngc,dgc]=lead5(ng0,dg0,KK,Pm,wc,w);
[mu,pu]=bode(KK*ng0,dg0,w);
ngv=polyval(KK*ng0,j*wc);
dgv=polyval(dg0,j*wc);
g=ngv/dgv;
theta=180*angle(g)/pi;
alf=ceil(Pm-(theta+180)+5);
phi=(alf)*pi/180;
a=(1+sin(phi))/(1-sin(phi));
dbmu=20*log10(mu);
mm=-10*log10(a);
wgc=spline(dbmu,w,mm);
T=1/(wgc*sqrt(a));
ngc=[a*T,1];
dgc=[T,1];