LQR linear quadratic regulator to calculate gain for several known variables