Implement the Quaternion::normalize() function

For some reason it was forgotten when the class was added

diff --git a/source/geometry/quaternion.h b/source/geometry/quaternion.h
index 809259710884b2f2931ad6674913f65d1909a81d..5cb45fffcbcc6a20f31114a235d534efdaef9394 100644 (file)
--- a/source/geometry/quaternion.h
+++ b/source/geometry/quaternion.h
@@ -166,6 +166,19 @@ T Quaternion<T>::norm() const
        return sqrt(a*a+b*b+c*c+d*d);
 }
 
+template<typename T>
+Quaternion<T> &Quaternion<T>::normalize()
+{
+       return *this /= norm();
+}
+
+template<typename T>
+Quaternion<T> normalize(const Quaternion<T> &q)
+{
+       Quaternion<T> r = q;
+       return r.normalize();
+}
+
 template<typename T>
 Quaternion<T> Quaternion<T>::inverse() const
 {