Commit df380d70 authored by Justin Carpentier's avatar Justin Carpentier Committed by GitHub
Browse files

Merge pull request #400 from florent-lamiraux/fix-assertion

In exp3, modify assertion
parents 6b43b692 e729e656
......@@ -40,7 +40,9 @@ namespace se3
template <typename D> Eigen::Matrix<typename D::Scalar,3,3,Eigen::internal::traits<D>::Options>
exp3(const Eigen::MatrixBase<D> & v)
assert (v.size () == 3);
typename D::Scalar nv = v.norm();
if (nv > 1e-14)
return Eigen::AngleAxis<typename D::Scalar>(nv, v / nv).matrix();
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment