clc;
clear all;
M_g=diag([0.125 0.034 0.016]);
E= blkdiag(eye(3), M_g, zeros(6));L_gg=[0.058 0 0;0 0.063 0; 0 0 0.059];
L_gl=[-0.058 0 0 0 0 0;0 -0.063 0 0 0 0;0 0 -0.059 0 0 0];
L_lg=L_gl';
L_ll=[0.235 0 0 -0.085 -0.092 0;0 0.296 0 -0.161 0 -0.072; 0 0 0.330 0 -0.170 -0.101;-0.085 -0.161 0 0.246 0 0;-0.092 0 -0.170 0 0.262 0;0 -0.072 -0.101 0 0 0.173];
D_g=diag([0.125 0.068 0.048]);A=-[zeros(3) -eye(3) zeros(3,6);L_gg D_g L_gl;L_lg zeros(6,3) L_ll];B=[zeros(3,1);ones(3,1);ones(6,1)];K =[-0.0484 -0.0571 -0.0644 -0.1775 -0.2210 -0.2689 -0.0436 -0.0461 -0.0475 -0.0330 -0.0323 -0.0308];E_rank=rank(E);
[T_1,EE, T_2]=svd(E);AA=T_1*A*T_2;
BB=T_1*B;
KK=K*T_2;A_11=AA(1:6,[1 2 3 4 5 6]);
A_12=AA(1:6,[7 8 9 10 11 12]);
A_21=AA(7:12,[1 2 3 4 5 6]);
A_22=AA(7:12,[7 8 9 10 11 12]);B_1=BB(1:6,1);
B_2=BB(7:12,1);K_1=KK(1,[1 2 3 4 5 6]);
K_2=KK(1,[7 8 9 10 11 12]);A_1r=A_11-A_12*inv(A_22)*A_21;
B1_1r=B_1*K_1-A_12*inv(A_22)*B_2*K_1;
B2_1r=B_1*K_2-A_12*inv(A_22)*B_2*K_2;A_2r=A_11-A_12*inv(A_22)*A_21;
B1_2r=B_1*K_1-A_12*inv(A_22)*B_2*K_1;
B2_2r=B_1*K_2-A_12*inv(A_22)*B_2*K_2;A_3r=A_11-A_12*inv(A_22)*A_21;F_1=diag([0.04 0.04 0.04 0.04 0.04 0.04]);
F_2=diag([0.25 0.25 0.25 0.25 0.25 0.25]);alfa=0.31;
beta_1=0.51;
beta_2=0.56;h=0.2;
eata_0=1;
kappa=3;
T=5;
tau_d=5;a=1/T;
b=0.6;c=0.4
setlmis([]);
P_11=lmivar(1,[6 1]);
N_1=lmivar(1,[6 1]);
N_2=lmivar(1,[6 1]);
N_3=lmivar(1,[6 1]);
W=lmivar(1,[6 1]);D_1=lmivar(1,[6 1]);
D_2=lmivar(1,[6 1]);
lmiterm([1 1 1 P_11],-1,1);
lmiterm([2