dlp_rock.m

来自「导弹控制系统的鲁棒控制设计实例」· M 代码 · 共 48 行

% Generates the open-loop connection for the discrete-time
% rocket stabilization system and displays frequency
% responses
%
% flight time
t = input ('Enter time t = ');
% open-loop interconnection
sys_rock
% discretization interval
Ts = input ('Enter discretization interval Ts = ');
% discrete model
dsys_ic = samhld(sys_ic,Ts);
%
% nominal frequency response
G_ny1_u = sel(G_rock,10,8);
omega = logspace(-1,1.3*log10(pi/Ts),1000);
G_g = frsp(G_ny1_u,omega,Ts);
figure(1)
vplot('liv,lm',G_g,'r-'), grid
axis([0.1 10000  20  50])
xlabel('Frequency (rad/s)')
ylabel('Magnitude')
title('Magnitude plot of G_{n_{y} \delta_0}')
figure(2)
vplot('liv,p',G_g,'b-'), grid
xlabel('Frequency (rad/s)'), ylabel('Phase (rad)')
title('Phase plot of G_{n_{y} \delta_0}')
%
% model frequency response
omega = logspace(-1,1.3*log10(pi/Ts),1000);
Wm_g = frsp(Wm,omega,Ts);
figure(3)
vplot('liv,lm',Wm_g,'r-'), grid
axis([0.1 10000  10^(-0.2)  10^(0.1)])
title('Model frequency response')
xlabel('Frequency (rad/sec)')
ylabel('Magnitude')
%
% performance weighting frequency response
omega = logspace(-1,1.3*log10(pi/Ts),1000);
Wp_g = frsp(Wp,omega,Ts);
Wpi_g = minv(Wp_g);
figure(4)
vplot('liv,lm',Wpi_g,'r-'), grid
axis([0.1 10000  10^(-0.5)  10^(-0.1)])
title('Inverse of Performance Weighting Function')
xlabel('Frequency (rad/sec)')
ylabel('Magnitude')