LQR regulator added