diff --git a/src/quaternion.hh b/src/quaternion.hh index 7728d6256b2d88125d963cbbff1fbf187f3d5be5..5937ffc1c98118e4b664a046299909b69eb47abb 100644 --- a/src/quaternion.hh +++ b/src/quaternion.hh @@ -12,6 +12,16 @@ public: Quaternion() {} Quaternion(const Dune::FieldVector<T,4>& other) : Dune::FieldVector<T,4>(other) {} + /** \brief Return the identity element */ + static Quaternion<T> identity() { + Quaternion<T> id; + id[0] = 0; + id[1] = 0; + id[2] = 0; + id[3] = 1; + return id; + } + /** \brief The exponential map from \f$ \mathfrak{so}(3) \f$ to \f$ SO(3) \f$ */ static Quaternion<T> exp(const T& v0, const T& v1, const T& v2) {