wsa_rock.m

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

% Sensor models 
%
% Accelerometer transfer function
numWa = [1];
denWa = [0.001^2  0.002  1];       % f = 150 Hz, ksi = 1     
gainWa = 0.4;                      % V/g
Wa = nd2sys(numWa,denWa,gainWa);
%
% Accelerometer noise shaping function
numWan = [0.12   1];
denWan = [0.001  1];
gainWan = 0.0002;
Wan = nd2sys(numWan,denWan,gainWan);
%
% Rate gyro transfer function
numWg= [1];
denWg = [0.0016^2  0.0023  1];     % f = 100 Hz, ksi = 0.707
gainWg = 5.5;
Wg = nd2sys(numWg,denWg,gainWg);
%
% Rate gyro noise shaping function
numWgn = [0.18   1];
denWgn = [0.002  1];
gainWgn = 0.00006;
Wgn = nd2sys(numWgn,denWgn,gainWgn);