mirror/eigen
2
0
Fork 0
mirror of https://gitlab.com/libeigen/eigen.git synced 2025-03-07 18:27:40 +08:00
Code Issues Packages Projects Releases Wiki Activity

add normalization functions to Quaternion and fix compilation

Browse Source 
issue with custom types
This commit is contained in:
Gael Guennebaud 2008-09-14 12:21:22 +00:00
parent db030d4e28
commit 0940ad7127
1 changed files with 10 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
Eigen/src/Geometry/Quaternion.h
View File

@ -162,6 +162,13 @@ public:
* \sa Quaternion::norm2(), MatrixBase::norm()
*/
inline Scalar norm() const { return m_coeffs.norm(); }
/** Normalizes the quaternion \c *this
* \sa normalized(), MatrixBase::normalize() */
inline void normalize() { m_coeffs.normalize(); }
/** \returns a normalized version of \c *this
* \sa normalize(), MatrixBase::normalized() */
inline Quaternion normalized() const { Quaternion(m_coeffs.normalized()); }
/** \returns the dot product of \c *this and \a other
* Geometrically speaking, the dot product of two unit quaternions
@ -414,9 +421,9 @@ struct ei_quaternion_assign_impl<Other,3,3>
Scalar t = mat.trace();
if (t > 0)
{
t = ei_sqrt(t + 1.0);
q.w() = 0.5*t;
t = 0.5/t;
t = ei_sqrt(t + Scalar(1.0));
q.w() = Scalar(0.5)*t;
t = Scalar(0.5)/t;
q.x() = (mat.coeff(2,1) - mat.coeff(1,2)) * t;
q.y() = (mat.coeff(0,2) - mat.coeff(2,0)) * t;
q.z() = (mat.coeff(1,0) - mat.coeff(0,1)) * t;