u1 = 1;
u2 = 1;
u3 = 1;

a1 = 1/2;
a2 = 1/3;
a3 = 1/5;

b1 = 2;
b2 = 3;
b3 = 5;

min = 9999999;
z1m = 9999999;
z2m = 9999999;
z3m = 9999999;

y_z = [1;1;1];

H = [0,0,1;0,1,0;1,0,0];
A = [a1,0,0;0,a2,0;0,0,a3];
B = [b1,0,0;0,b2,0;0,0,b3];
I = eye(3);

K = (I-A*H)^(-1)*B;
U = K^(-1)*y_z;

u1 = U(1);
u2 = U(2);
u3 = U(3);

sim('simu1.slx');

for i= 1:1:10000000
    z1 = rand()/6.66;
    z2 = rand()/6.66;
    z3 = rand()/6.66;

    Uz = [z1;z2;z3];
    Yz = K*Uz;

    Q = (Yz(1)-1)^2 + (Yz(2)-1)^2 + (Yz(3)-1)^2;

   if Q<min
       min = Q;
       z1m = z1;
       z2m = z2;
       z3m = z3;
   end
end


u1 = z1;
u2 = z2;
u3 = z3;

sim('simu1.slx');