求解LQR问题