TheCloud/panda3d
1
0
Fork 0
mirror of https://github.com/panda3d/panda3d.git synced 2025-10-04 02:42:49 -04:00
Code Issues Packages Projects Releases Wiki Activity

add is_same_direction

Browse Source
This commit is contained in:
David Rose 2003-11-11 15:57:34 +00:00
parent 27a8da21ec
commit c32922ee15
2 changed files with 55 additions and 13 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

57
panda/src/linmath/lquaternion_src.I
View File

@ -142,25 +142,50 @@ operator *(const FLOATNAME(LMatrix4) &m) {
// Function: LQuaternion::almost_equal
// Access: public
// Description: Returns true if two quaternions are memberwise equal
// within a specified tolerance.
// within a default tolerance based on the numeric type.
////////////////////////////////////////////////////////////////////
INLINE_LINMATH bool FLOATNAME(LQuaternion)::
almost_equal(const FLOATNAME(LQuaternion)& c, FLOATTYPE threshold) const {
return (IS_THRESHOLD_EQUAL(_v.data[0], c._v.data[0], threshold) &&
IS_THRESHOLD_EQUAL(_v.data[1], c._v.data[1], threshold) &&
IS_THRESHOLD_EQUAL(_v.data[2], c._v.data[2], threshold) &&
IS_THRESHOLD_EQUAL(_v.data[3], c._v.data[3], threshold));
almost_equal(const FLOATNAME(LQuaternion) &other) const {
return almost_equal(other, NEARLY_ZERO(FLOATTYPE));
}
////////////////////////////////////////////////////////////////////
// Function: LQuaternion::almost_equal
// Access: public
// Description: Returns true if two quaternions are memberwise equal
// within a default tolerance based on the numeric type.
// within a specified tolerance.
////////////////////////////////////////////////////////////////////
INLINE_LINMATH bool FLOATNAME(LQuaternion)::
almost_equal(const FLOATNAME(LQuaternion)& c) const {
return almost_equal(c, NEARLY_ZERO(FLOATTYPE));
almost_equal(const FLOATNAME(LQuaternion) &other,
FLOATTYPE threshold) const {
return (IS_THRESHOLD_EQUAL(_v.data[0], other._v.data[0], threshold) &&
IS_THRESHOLD_EQUAL(_v.data[1], other._v.data[1], threshold) &&
IS_THRESHOLD_EQUAL(_v.data[2], other._v.data[2], threshold) &&
IS_THRESHOLD_EQUAL(_v.data[3], other._v.data[3], threshold));
}
////////////////////////////////////////////////////////////////////
// Function: LQuaternion::is_same_direction
// Access: public
// Description: Returns true if two quaternions represent the same
// rotation within a default tolerance based on the
// numeric type.
////////////////////////////////////////////////////////////////////
INLINE_LINMATH bool FLOATNAME(LQuaternion)::
is_same_direction(const FLOATNAME(LQuaternion) &other) const {
return almost_same_direction(other, NEARLY_ZERO(FLOATTYPE));
}
////////////////////////////////////////////////////////////////////
// Function: LQuaternion::almost_same_direction
// Access: public
// Description: Returns true if two quaternions represent the same
// rotation within a specified tolerance.
////////////////////////////////////////////////////////////////////
INLINE_LINMATH bool FLOATNAME(LQuaternion)::
almost_same_direction(const FLOATNAME(LQuaternion) &other,
FLOATTYPE threshold) const {
return ((*this) * invert(other)).is_almost_identity(threshold);
}
////////////////////////////////////////////////////////////////////
@ -354,7 +379,19 @@ invert_in_place() {
////////////////////////////////////////////////////////////////////
INLINE_LINMATH bool FLOATNAME(LQuaternion)::
is_identity() const {
return (IS_NEARLY_EQUAL(_v.v._0, -1.0f) || IS_NEARLY_EQUAL(_v.v._0, 1.0f));
return is_almost_identity(NEARLY_ZERO(FLOATTYPE));
}
////////////////////////////////////////////////////////////////////
// Function: LQuaternion::is_almost_identity
// Access: Public
// Description: Returns true if this quaternion represents the
// identity transformation within a given tolerance.
////////////////////////////////////////////////////////////////////
INLINE_LINMATH bool FLOATNAME(LQuaternion)::
is_almost_identity(FLOATTYPE tolerance) const {
return (IS_THRESHOLD_EQUAL(_v.v._0, -1.0f, tolerance) ||
IS_THRESHOLD_EQUAL(_v.v._0, 1.0f, tolerance));
}
////////////////////////////////////////////////////////////////////

9
panda/src/linmath/lquaternion_src.h
View File

@ -42,8 +42,12 @@ PUBLISHED:
INLINE_LINMATH FLOATNAME(LMatrix3) operator *(const FLOATNAME(LMatrix3) &);
INLINE_LINMATH FLOATNAME(LMatrix4) operator *(const FLOATNAME(LMatrix4) &);
INLINE_LINMATH bool almost_equal(const FLOATNAME(LQuaternion) &, FLOATTYPE) const;
INLINE_LINMATH bool almost_equal(const FLOATNAME(LQuaternion) &) const;
INLINE_LINMATH bool almost_equal(const FLOATNAME(LQuaternion) &other) const;
INLINE_LINMATH bool almost_equal(const FLOATNAME(LQuaternion) &other,
FLOATTYPE threshold) const;
INLINE_LINMATH bool is_same_direction(const FLOATNAME(LQuaternion) &other) const;
INLINE_LINMATH bool almost_same_direction(const FLOATNAME(LQuaternion) &other,
FLOATTYPE threshold) const;
INLINE_LINMATH void output(ostream&) const;
@ -74,6 +78,7 @@ PUBLISHED:
INLINE_LINMATH bool invert_in_place();
INLINE_LINMATH bool is_identity() const;
INLINE_LINMATH bool is_almost_identity(FLOATTYPE tolerance) const;
INLINE_LINMATH static const FLOATNAME(LQuaternion) &ident_quat();
private: