diff --git a/src/rotation.hh b/src/rotation.hh index e1376707e9c44d666ff138d791d131ed233452b7..cf7e48297418a9f8368475ffe7a1e7ede6257701 100644 --- a/src/rotation.hh +++ b/src/rotation.hh @@ -47,6 +47,20 @@ public: return result; } + /** \brief The exponential map from \f$ \mathfrak{so}(2) \f$ to \f$ SO(2) \f$ + */ + static Rotation<2,T> exp(const Dune::FieldVector<T,1>& v) { + Rotation<2,T> result; + result.angle_ = v[0]; + return result; + } + + /** \brief Right multiplication */ + Rotation<2,T> mult(const Rotation<2,T>& other) const { + Rotation<2,T> q = *this; + q.angle_ += other.angle_; + return q; + } //private: