Skip to content
Snippets Groups Projects
Commit 0705eb2d authored by Youett, Jonathan's avatar Youett, Jonathan Committed by akbib@FU-BERLIN.DE
Browse files

add exponential method for real tangent vectors

[[Imported from SVN: r8115]]
parent d5e5afd2
Branches
No related tags found
No related merge requests found
......@@ -267,6 +267,20 @@ public:
// The actual exponential map
return exp(p, vMatrix);
}
/** \brief The exponential map from a given point $p \in SO(3)$.
\param v A tangent vector.
*/
static Rotation<3,T> exp(const Rotation<3,T>& p, const TangentVector& v) {
// embedded tangent vector
Dune::FieldMatrix<T,3,4> basis = p.orthonormalFrame();
Quaternion<T> embeddedTangent;
basis.mtv(v, embeddedTangent);
return exp(p,embeddedTangent);
}
/** \brief Compute tangent vector from given basepoint and skew symmetric matrix. */
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment