function y = state_control(x) % K = [1.0000 1.5595 8.5598 1.6970]; K = [2 1 6 1]; y = K*x;