LQG主动悬架 maltab simulink实现

用matlab m文件以及simulink实现LQG主动悬架设计和仿真

clear all
%% White Noise
Tin=（0:0.0025:100）‘;
m=length（Tin）;
n=1;
time=1:1:m;
p=23;
f=1024;
ts=400;
wr=wgn（mnp）;

%% parameter values
%路面不平度系数
G0=16e-6;
G1=64e-6;
G2=256e-6;
G3=1024e-6;
%前进速度
u0=20;
%下截止频率
f0=0.1;


%% Road excitation modeling
Ard=-2*pi*f0;
Brd0=2*pi*sqrt（G0*u0）;
Brd1=2*pi*sqrt（G1*u0）;
Brd2=2*pi*sqrt（G2*u0）;
Brd3=2*pi*sqrt（G3*u0）;
Crd=1;
Drd=0;

%% Lsim simulation for Road excitation
sys_r0=ss（ArdBrd0CrdDrd）;
Y_r0=lsim（sys_r0wrTin）;
[P0f0]=pwelch（Y_r0[][]fts‘onesided‘）;
P_n0=P0*u0;
f_n0=f0/u0;
Sn0=G0*f_n0.^-2;

sys_r1=ss（ArdBrd1CrdDrd）;
Y_r1=lsim（sys_r1wrTin）;
[P1f1]=pwelch（Y_r1[][]fts‘onesided‘）;
P_n1=P1*u0;
f_n1=f1/u0;
Sn1=G1*f_n1.^-2;

sys_r2=ss（ArdBrd2CrdDrd）;
Y_r2=lsim（sys_r2wrTin）;
[P2f2]=pwelch（Y_r2[][]fts‘onesided‘）;
P_n2=P2*u0;
f_n2=f2/u0;
Sn2=G2*f_n2.^-2;

sys_r3=ss（ArdBrd3CrdDrd）;
Y_r3=lsim（sys_r3wrTin）;
[P3f3]=pwelch（Y_r3[][]fts‘onesided‘）;
P_n3=P3*u0;
f_n3=f3/u0;
Sn3=G3*f_n3.^-2;

loglog（f_n0P_n0‘r‘f_n0Sn0‘r‘...
       f_n1P_n1‘b‘f_n1Sn1‘b‘...
       f_n2P_n2‘y‘f_n2Sn2‘y‘...
       f_n3P_n3‘g‘f_n3Sn3‘g‘）;
axis（[10^-1.510^110^-810^1.6]）;
ylabel（‘Displacement power spectrum density‘）;
xlabel（‘Space Frequancy（1/m）‘）;
grid on;

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2012-11-14 11:51  active suspension\
     文件        1326  2012-11-14 11:30  active suspension\A_B_C_D_power.m
     文件        2625  2012-11-15 23:12  active suspension\LQG.m
     目录           0  2013-02-27 14:30  active suspension\simulink_m\
     文件       38055  2012-11-17 15:51  active suspension\simulink_m\lqg.mdl
     文件       38077  2013-02-27 14:32  active suspension\simulink_m\lqg.mdl.autosave
     文件        2112  2012-11-17 15:44  active suspension\simulink_m\lqg_Parameters.m
     文件        1826  2012-11-14 11:48  active suspension\simulink_m\lqg_Parameters_passive_only.m
     文件       23012  2013-02-27 13:36  active suspension\simulink_m\untitled1.mdl.autosave