function y = state_control(x)
K = [3.0000    1.0000    5.9000    1.0000];
y = K*x;