10 const Eigen::MatrixXd &b,
12 const Eigen::MatrixXd &b_proj)
19 assert(
A_.rows() ==
b_.rows());
29 const Eigen::VectorXd res =
A_ *
x -
b_;
30 const double L_penalty =
lagr_mults_.transpose() * res;
31 const double A_penalty = res.squaredNorm() / 2;
53 const Eigen::VectorXd res =
A_ *
x -
b_;
54 return res.squaredNorm();
Eigen::SparseMatrix< double, Eigen::ColMajor > StiffnessMatrix