MCPcopy Create free account
hub / github.com/Simple-Robotics/proxsuite / reconstruct_with_perm

Function reconstruct_with_perm

test/src/sparse_factorization.cpp:58–70  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

56
57template<typename T, typename I>
58auto
59reconstruct_with_perm(proxsuite::linalg::veg::Slice<I> perm_inv,
60 proxsuite::linalg::sparse::MatRef<T, I> ld)
61 -> Eigen::Matrix<T, -1, -1, Eigen::ColMajor>
62{
63 using Mat = Eigen::Matrix<T, -1, -1, Eigen::ColMajor>;
64 Mat ld_eigen = to_eigen(ld);
65 auto perm_inv_eigen = to_eigen_perm(perm_inv);
66 Mat l = ld_eigen.template triangularView<Eigen::UnitLower>();
67 Mat d = ld_eigen.diagonal().asDiagonal();
68 Mat ldlt = l * d * l.transpose();
69 return perm_inv_eigen.inverse() * ldlt * perm_inv_eigen;
70}
71
72template<typename T, typename I>
73auto

Callers 1

Calls 2

to_eigenFunction · 0.85
to_eigen_permFunction · 0.85

Tested by

no test coverage detected