47 const Eigen::MatrixXd &Q,
const Eigen::MatrixXd &R,
48 const Eigen::MatrixXd &M,
const double tolerance,
49 const uint max_num_iteration, Eigen::MatrixXd *ptr_K,
50 uint *iterate_num,
double *result_diff);
64 const Eigen::MatrixXd &Q,
const Eigen::MatrixXd &R,
65 const double tolerance,
const uint max_num_iteration,
66 Eigen::MatrixXd *ptr_K, uint *iterate_num,
void SolveLQRProblem(const Matrix &A, const Matrix &B, const Matrix &Q, const Matrix &R, const Matrix &M, const double tolerance, const uint max_num_iteration, Matrix *ptr_K, uint *iterate_num, double *result_diff)