Robotics, Programming, Cpp.
discrete-time LTI system represented as: where​ xk​ is the state vector at time step k. uk​ is the control input vector at time step k. A is the state transition matrix. B is the input matrix. The goal of LQR is to minimize the following quadratic cost function: subject to the system dynamics,