Ejemplo n.º 1
0
 void ExpMapQuaternion::applyDiffRetractation_(
     RefMat out, const ConstRefMat& in, const ConstRefVec& x, ReusableTemporaryMap& m)
 {
   mnf_assert(in.cols() == OutputDim_ && "Dimensions mismatch" );
   Eigen::Map<Eigen::MatrixXd, Eigen::Aligned> a = m.getMap(in.rows(),3);
   a.noalias() = in*diffRetractation_(x);
   out = a;
 }
Ejemplo n.º 2
0
Eigen::MatrixXd Manifold::diffRetractation(const ConstRefVec& x) const
{
  mnf_assert(isValid() || seeMessageAbove());
  mnf_assert(x.size() == representationDim_);
  return diffRetractation_(x);
}