33 , T m10, T m11, T m12, T m13
34 , T m20, T m21, T m22, T m23
35 , T m30, T m31, T m32, T m33);
66 bool isIdentity(T tolerance = std::numeric_limits<T>::epsilon())
const;
73 const void*
ptr(
void)
const;
113 DtMatrix4<T> DtMatrix4<T>::theIdentityMatrix = DtMatrix4<T>(1,0,0,0
130 memcpy(_m, rhs, 16*
sizeof(T));
135 , T m10, T m11, T m12, T m13
136 , T m20, T m21, T m22, T m23
137 , T m30, T m31, T m32, T m33)
139 m[0][0]=m00;m[0][1]=m01;m[0][2]=m02;m[0][3]=m03;
140 m[1][0]=m10;m[1][1]=m11;m[1][2]=m12;m[1][3]=m13;
141 m[2][0]=m20;m[2][1]=m21;m[2][2]=m22;m[2][3]=m23;
142 m[3][0]=m30;m[3][1]=m31;m[3][2]=m32;m[3][3]=m33;
148 memcpy(m, rhs, 16*
sizeof(T));
189 result.
m[0][0] = lhs.
m[0][0]*rhs.
m[0][0] + lhs.
m[0][1]*rhs.
m[1][0] + lhs.
m[0][2]*rhs.
m[2][0] + lhs.
m[0][3]*rhs.
m[3][0];
190 result.
m[0][1] = lhs.
m[0][0]*rhs.
m[0][1] + lhs.
m[0][1]*rhs.
m[1][1] + lhs.
m[0][2]*rhs.
m[2][1] + lhs.
m[0][3]*rhs.
m[3][1];
191 result.
m[0][2] = lhs.
m[0][0]*rhs.
m[0][2] + lhs.
m[0][1]*rhs.
m[1][2] + lhs.
m[0][2]*rhs.
m[2][2] + lhs.
m[0][3]*rhs.
m[3][2];
192 result.
m[0][3] = lhs.
m[0][0]*rhs.
m[0][3] + lhs.
m[0][1]*rhs.
m[1][3] + lhs.
m[0][2]*rhs.
m[2][3] + lhs.
m[0][3]*rhs.
m[3][3];
194 result.
m[1][0] = lhs.
m[1][0]*rhs.
m[0][0] + lhs.
m[1][1]*rhs.
m[1][0] + lhs.
m[1][2]*rhs.
m[2][0] + lhs.
m[1][3]*rhs.
m[3][0];
195 result.
m[1][1] = lhs.
m[1][0]*rhs.
m[0][1] + lhs.
m[1][1]*rhs.
m[1][1] + lhs.
m[1][2]*rhs.
m[2][1] + lhs.
m[1][3]*rhs.
m[3][1];
196 result.
m[1][2] = lhs.
m[1][0]*rhs.
m[0][2] + lhs.
m[1][1]*rhs.
m[1][2] + lhs.
m[1][2]*rhs.
m[2][2] + lhs.
m[1][3]*rhs.
m[3][2];
197 result.
m[1][3] = lhs.
m[1][0]*rhs.
m[0][3] + lhs.
m[1][1]*rhs.
m[1][3] + lhs.
m[1][2]*rhs.
m[2][3] + lhs.
m[1][3]*rhs.
m[3][3];
199 result.
m[2][0] = lhs.
m[2][0]*rhs.
m[0][0] + lhs.
m[2][1]*rhs.
m[1][0] + lhs.
m[2][2]*rhs.
m[2][0] + lhs.
m[2][3]*rhs.
m[3][0];
200 result.
m[2][1] = lhs.
m[2][0]*rhs.
m[0][1] + lhs.
m[2][1]*rhs.
m[1][1] + lhs.
m[2][2]*rhs.
m[2][1] + lhs.
m[2][3]*rhs.
m[3][1];
201 result.
m[2][2] = lhs.
m[2][0]*rhs.
m[0][2] + lhs.
m[2][1]*rhs.
m[1][2] + lhs.
m[2][2]*rhs.
m[2][2] + lhs.
m[2][3]*rhs.
m[3][2];
202 result.
m[2][3] = lhs.
m[2][0]*rhs.
m[0][3] + lhs.
m[2][1]*rhs.
m[1][3] + lhs.
m[2][2]*rhs.
m[2][3] + lhs.
m[2][3]*rhs.
m[3][3];
204 result.
m[3][0] = lhs.
m[3][0]*rhs.
m[0][0] + lhs.
m[3][1]*rhs.
m[1][0] + lhs.
m[3][2]*rhs.
m[2][0] + lhs.
m[3][3]*rhs.
m[3][0];
205 result.
m[3][1] = lhs.
m[3][0]*rhs.
m[0][1] + lhs.
m[3][1]*rhs.
m[1][1] + lhs.
m[3][2]*rhs.
m[2][1] + lhs.
m[3][3]*rhs.
m[3][1];
206 result.
m[3][2] = lhs.
m[3][0]*rhs.
m[0][2] + lhs.
m[3][1]*rhs.
m[1][2] + lhs.
m[3][2]*rhs.
m[2][2] + lhs.
m[3][3]*rhs.
m[3][2];
207 result.
m[3][3] = lhs.
m[3][0]*rhs.
m[0][3] + lhs.
m[3][1]*rhs.
m[1][3] + lhs.
m[3][2]*rhs.
m[2][3] + lhs.
m[3][3]*rhs.
m[3][3];
226 vResult.
x = lhs.
m[0][0]*rhs.
x + lhs.
m[0][1]*rhs.
y + lhs.
m[0][2]*rhs.
z + lhs.
m[0][3]*rhs.
w;
227 vResult.
y = lhs.
m[1][0]*rhs.
x + lhs.
m[1][1]*rhs.
y + lhs.
m[1][2]*rhs.
z + lhs.
m[1][3]*rhs.
w;
228 vResult.
z = lhs.
m[2][0]*rhs.
x + lhs.
m[2][1]*rhs.
y + lhs.
m[2][2]*rhs.
z + lhs.
m[2][3]*rhs.
w;
229 vResult.
w = lhs.
m[3][0]*rhs.
x + lhs.
m[3][1]*rhs.
y + lhs.
m[3][2]*rhs.
z + lhs.
m[3][3]*rhs.
w;
241 vResult.
x = lhs.
m[0][0] * rhs.
x + lhs.
m[1][0] * rhs.
y + lhs.
m[2][0] * rhs.
z + lhs.
m[3][0] * rhs.
w;
242 vResult.
y = lhs.
m[0][1] * rhs.
x + lhs.
m[1][1] * rhs.
y + lhs.
m[2][1] * rhs.
z + lhs.
m[3][1] * rhs.
w;
243 vResult.
z = lhs.
m[0][2] * rhs.
x + lhs.
m[1][2] * rhs.
y + lhs.
m[2][2] * rhs.
z + lhs.
m[3][2] * rhs.
w;
244 vResult.
w = lhs.
m[0][3] * rhs.
x + lhs.
m[1][3] * rhs.
y + lhs.
m[2][3] * rhs.
z + lhs.
m[3][3] * rhs.
w;
252 memset(_m, 0, 16*
sizeof(T));
259 m[0][0] = m[1][1] = m[2][2] = m[3][3] = 1;
266 m[0][0], m[1][0], m[2][0], m[3][0]
267 , m[0][1], m[1][1], m[2][1], m[3][1]
268 , m[0][2], m[1][2], m[2][2], m[3][2]
269 , m[0][3], m[1][3], m[2][3], m[3][3]
277 result[2][0] = (result[2][0] + result[3][0])*0.5f;
278 result[2][1] = (result[2][1] + result[3][1])*0.5f;
279 result[2][2] = (result[2][2] + result[3][2])*0.5f;
280 result[2][3] = (result[2][3] + result[3][3])*0.5f;
288 for(
size_t i = 0; i < 4; ++i)
290 for(
size_t j = 0; j < 4; ++j)
303 return isEqual(rhs, tolerance);
316 m[0][0] = rhs[0][0]; m[0][1] = rhs[0][1]; m[0][2] = rhs[0][2];
317 m[1][0] = rhs[1][0]; m[1][1] = rhs[1][1]; m[1][2] = rhs[1][2];
318 m[2][0] = rhs[2][0]; m[2][1] = rhs[2][1]; m[2][2] = rhs[2][2];
324 return m[3][0] == 0 && m[3][1] == 0 && m[3][2] == 0 && m[3][3] == 1;
335 m[0][0]*v.
x + m[0][1]*v.
y + m[0][2]*v.
z + + m[0][3]
336 , m[1][0]*v.
x + m[1][1]*v.
y + m[1][2]*v.
z + + m[1][3]
337 , m[2][0]*v.
x + m[2][1]*v.
y + m[2][2]*v.
z + + m[2][3]
349 m[0][0]*v.
x + m[0][1]*v.
y + m[0][2]*v.
z + + m[0][3]
350 , m[1][0]*v.
x + m[1][1]*v.
y + m[1][2]*v.
z + + m[1][3]
351 , m[2][0]*v.
x + m[2][1]*v.
y + m[2][2]*v.
z + + m[2][3]
359 T m00 = m[0][0], m01 = m[0][1], m02 = m[0][2], m03 = m[0][3];
360 T m10 = m[1][0], m11 = m[1][1], m12 = m[1][2], m13 = m[1][3];
361 T m20 = m[2][0], m21 = m[2][1], m22 = m[2][2], m23 = m[2][3];
362 T m30 = m[3][0], m31 = m[3][1], m32 = m[3][2], m33 = m[3][3];
364 T v0 = m20 * m31 - m21 * m30;
365 T v1 = m20 * m32 - m22 * m30;
366 T v2 = m20 * m33 - m23 * m30;
367 T v3 = m21 * m32 - m22 * m31;
368 T v4 = m21 * m33 - m23 * m31;
369 T v5 = m22 * m33 - m23 * m32;
371 T t00 = + (v5 * m11 - v4 * m12 + v3 * m13);
372 T t10 = - (v5 * m10 - v2 * m12 + v1 * m13);
373 T t20 = + (v4 * m10 - v2 * m11 + v0 * m13);
374 T t30 = - (v3 * m10 - v1 * m11 + v0 * m12);
376 T invDet = 1 / (t00 * m00 + t10 * m01 + t20 * m02 + t30 * m03);
378 T d00 = t00 * invDet;
379 T d10 = t10 * invDet;
380 T d20 = t20 * invDet;
381 T d30 = t30 * invDet;
383 T d01 = - (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
384 T d11 = + (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
385 T d21 = - (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
386 T d31 = + (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
388 v0 = m10 * m31 - m11 * m30;
389 v1 = m10 * m32 - m12 * m30;
390 v2 = m10 * m33 - m13 * m30;
391 v3 = m11 * m32 - m12 * m31;
392 v4 = m11 * m33 - m13 * m31;
393 v5 = m12 * m33 - m13 * m32;
395 T d02 = + (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
396 T d12 = - (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
397 T d22 = + (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
398 T d32 = - (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
400 v0 = m21 * m10 - m20 * m11;
401 v1 = m22 * m10 - m20 * m12;
402 v2 = m23 * m10 - m20 * m13;
403 v3 = m22 * m11 - m21 * m12;
404 v4 = m23 * m11 - m21 * m13;
405 v5 = m23 * m12 - m22 * m13;
407 T d03 = - (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
408 T d13 = + (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
409 T d23 = - (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
410 T d33 = + (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
424 T m10 = m[1][0], m11 = m[1][1], m12 = m[1][2];
425 T m20 = m[2][0], m21 = m[2][1], m22 = m[2][2];
427 T t00 = m22 * m11 - m21 * m12;
428 T t10 = m20 * m12 - m22 * m10;
429 T t20 = m21 * m10 - m20 * m11;
431 T m00 = m[0][0], m01 = m[0][1], m02 = m[0][2];
433 T invDet = 1 / (m00 * t00 + m01 * t10 + m02 * t20);
435 t00 *= invDet; t10 *= invDet; t20 *= invDet;
437 m00 *= invDet; m01 *= invDet; m02 *= invDet;
440 T r01 = m02 * m21 - m01 * m22;
441 T r02 = m01 * m12 - m02 * m11;
444 T r11 = m00 * m22 - m02 * m20;
445 T r12 = m02 * m10 - m00 * m12;
448 T r21 = m01 * m20 - m00 * m21;
449 T r22 = m00 * m11 - m01 * m10;
451 T m03 = m[0][3], m13 = m[1][3], m23 = m[2][3];
453 T r03 = - (r00 * m03 + r01 * m13 + r02 * m23);
454 T r13 = - (r10 * m03 + r11 * m13 + r12 * m23);
455 T r23 = - (r20 * m03 + r21 * m13 + r22 * m23);
475 m[0][3] = m[0][3] - v.
x;
476 m[1][3] = m[1][3] - v.
y;
477 m[2][3] = m[2][3] - v.
z;
483 return (memcmp(ptr(), rhs.
ptr(),
sizeof(T) * 16) == 0);
489 return (memcmp(ptr(), rhs.
ptr(),
sizeof(T) * 16) != 0);
493 inline std::ostream&
operator <<
496 for(
size_t i = 0; i < 4; ++i)
498 o<<mat[i][0]<<
" "<<mat[i][1]<<
" "<<mat[i][2]<<
" "<<mat[i][3]<<std::endl;
DtMatrix4< T > getInverseAffine(void) const
Get the inverse of this matrix. This matrix must be affine to.
Definition: DtMatrix4.h:420
T x
Definition: DtVector4.h:113
static DtMatrix4 theIdentityMatrix
Definition: DtMatrix4.h:75
DtMatrix4< float > Matrix4_32
Definition: DtMatrix4.h:118
DtMatrix4()
CTOR.
Definition: DtMatrix4.h:122
~DtMatrix4()
DTOR.
Definition: DtMatrix4.h:152
void translateBack(const DtVector3< T > &v)
subtract the vector from the translation column
Definition: DtMatrix4.h:473
DtMatrix4 operator*(const DtMatrix4 &rhs) const
Multiply 2 matrices. Returns this*rhs.
#define ASSERT_PREDICATE_RETURN_ZERO(p)
Definition: DtAssert.h:41
T m[4][4]
Definition: DtMatrix4.h:108
T z
Definition: DtVector3.h:132
DtMatrix4 convert_depth_gl_to_dx() const
Definition: DtMatrix4.h:274
const T * operator[](size_t iRow) const
Definition: DtMatrix4.h:164
bool isEqual(const DtMatrix4 &rhs, T tolerance) const
Check whether this matrix is equivalent to rhs within tolerance.
Definition: DtMatrix4.h:285
void zeroOutTranslation(void)
Zero out the translation column.
Definition: DtMatrix4.h:465
T x
Definition: DtVector3.h:132
4 dimensional vector
Definition: DtMath.h:22
const DtVector4< T > transposeMultiply(const DtVector4< T > &rhs) const
This is equal to: this->GetTranspose() * rhs (but potentialy faster)
Definition: DtMatrix4.h:235
bool operator==(const DtMatrix4< T > &rhs) const
equality
Definition: DtMatrix4.h:481
const void * ptr(void) const
Definition: DtMatrix4.h:158
DtMatrix4< double > Matrix4_64
Definition: DtMatrix4.h:119
T z
Definition: DtVector4.h:113
void operator=(const DtMatrix3< T > &rhs)
Assignment operator.
Definition: DtMatrix4.h:312
T _m[16]
Definition: DtMatrix4.h:107
bool isAffine(void) const
Return whether the last row is (0,0,0,1);.
Definition: DtMatrix4.h:322
T w
Definition: DtVector4.h:113
T y
Definition: DtVector3.h:132
static bool isEqual(int32 lhs, int32 rhs, int32 tolerance=std::numeric_limits< int32 >::epsilon())
Test equality with tolerance.
DtMatrix4< T > getInverse(void) const
Get the inverse of this matrix.
Definition: DtMatrix4.h:357
void setZero(void)
Set all values to zero.
Definition: DtMatrix4.h:250
3 dimensional matrix
Definition: DtMatrix3.h:20
bool operator!=(const DtMatrix4< T > &rhs) const
inequality
Definition: DtMatrix4.h:487
bool isIdentity(T tolerance=std::numeric_limits< T >::epsilon()) const
Definition: DtMatrix4.h:300
2 dimensional vector
Definition: DtMath.h:21
void setIdentity(void)
Set matrix to identity matrix.
Definition: DtMatrix4.h:256
DtMatrix4 getTranspose(void) const
Get the transpose of this matrix.
Definition: DtMatrix4.h:263
#define ASSERT_PREDICATE(p)
Definition: DtAssert.h:28
DtVector3< T > transformAffine(const DtVector3< T > &v) const
Definition: DtMatrix4.h:328
T y
Definition: DtVector4.h:113
4 dimensional matrix
Definition: DtMatrix4.h:22