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;
110 DtMatrix4<T> DtMatrix4<T>::theIdentityMatrix = DtMatrix4<T>(1,0,0,0
127 memcpy(_m, rhs, 16*
sizeof(T));
132 , T m10, T m11, T m12, T m13
133 , T m20, T m21, T m22, T m23
134 , T m30, T m31, T m32, T m33)
136 m[0][0]=m00;m[0][1]=m01;m[0][2]=m02;m[0][3]=m03;
137 m[1][0]=m10;m[1][1]=m11;m[1][2]=m12;m[1][3]=m13;
138 m[2][0]=m20;m[2][1]=m21;m[2][2]=m22;m[2][3]=m23;
139 m[3][0]=m30;m[3][1]=m31;m[3][2]=m32;m[3][3]=m33;
145 memcpy(m, rhs, 16*
sizeof(T));
186 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];
187 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];
188 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];
189 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];
191 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];
192 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];
193 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];
194 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];
196 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];
197 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];
198 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];
199 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];
201 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];
202 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];
203 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];
204 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];
223 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;
224 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;
225 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;
226 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;
234 memset(_m, 0, 16*
sizeof(T));
241 m[0][0] = m[1][1] = m[2][2] = m[3][3] = 1;
248 m[0][0], m[1][0], m[2][0], m[3][0]
249 , m[0][1], m[1][1], m[2][1], m[3][1]
250 , m[0][2], m[1][2], m[2][2], m[3][2]
251 , m[0][3], m[1][3], m[2][3], m[3][3]
259 result[2][0] = (result[2][0] + result[3][0])*0.5f;
260 result[2][1] = (result[2][1] + result[3][1])*0.5f;
261 result[2][2] = (result[2][2] + result[3][2])*0.5f;
262 result[2][3] = (result[2][3] + result[3][3])*0.5f;
270 for(
size_t i = 0; i < 4; ++i)
272 for(
size_t j = 0; j < 4; ++j)
285 return isEqual(rhs, tolerance);
298 m[0][0] = rhs[0][0]; m[0][1] = rhs[0][1]; m[0][2] = rhs[0][2];
299 m[1][0] = rhs[1][0]; m[1][1] = rhs[1][1]; m[1][2] = rhs[1][2];
300 m[2][0] = rhs[2][0]; m[2][1] = rhs[2][1]; m[2][2] = rhs[2][2];
306 return m[3][0] == 0 && m[3][1] == 0 && m[3][2] == 0 && m[3][3] == 1;
317 m[0][0]*v.
x + m[0][1]*v.
y + m[0][2]*v.
z + + m[0][3]
318 , m[1][0]*v.
x + m[1][1]*v.
y + m[1][2]*v.
z + + m[1][3]
319 , m[2][0]*v.
x + m[2][1]*v.
y + m[2][2]*v.
z + + m[2][3]
331 m[0][0]*v.
x + m[0][1]*v.
y + m[0][2]*v.
z + + m[0][3]
332 , m[1][0]*v.
x + m[1][1]*v.
y + m[1][2]*v.
z + + m[1][3]
333 , m[2][0]*v.
x + m[2][1]*v.
y + m[2][2]*v.
z + + m[2][3]
341 T m00 = m[0][0], m01 = m[0][1], m02 = m[0][2], m03 = m[0][3];
342 T m10 = m[1][0], m11 = m[1][1], m12 = m[1][2], m13 = m[1][3];
343 T m20 = m[2][0], m21 = m[2][1], m22 = m[2][2], m23 = m[2][3];
344 T m30 = m[3][0], m31 = m[3][1], m32 = m[3][2], m33 = m[3][3];
346 T v0 = m20 * m31 - m21 * m30;
347 T v1 = m20 * m32 - m22 * m30;
348 T v2 = m20 * m33 - m23 * m30;
349 T v3 = m21 * m32 - m22 * m31;
350 T v4 = m21 * m33 - m23 * m31;
351 T v5 = m22 * m33 - m23 * m32;
353 T t00 = + (v5 * m11 - v4 * m12 + v3 * m13);
354 T t10 = - (v5 * m10 - v2 * m12 + v1 * m13);
355 T t20 = + (v4 * m10 - v2 * m11 + v0 * m13);
356 T t30 = - (v3 * m10 - v1 * m11 + v0 * m12);
358 T invDet = 1 / (t00 * m00 + t10 * m01 + t20 * m02 + t30 * m03);
360 T d00 = t00 * invDet;
361 T d10 = t10 * invDet;
362 T d20 = t20 * invDet;
363 T d30 = t30 * invDet;
365 T d01 = - (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
366 T d11 = + (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
367 T d21 = - (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
368 T d31 = + (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
370 v0 = m10 * m31 - m11 * m30;
371 v1 = m10 * m32 - m12 * m30;
372 v2 = m10 * m33 - m13 * m30;
373 v3 = m11 * m32 - m12 * m31;
374 v4 = m11 * m33 - m13 * m31;
375 v5 = m12 * m33 - m13 * m32;
377 T d02 = + (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
378 T d12 = - (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
379 T d22 = + (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
380 T d32 = - (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
382 v0 = m21 * m10 - m20 * m11;
383 v1 = m22 * m10 - m20 * m12;
384 v2 = m23 * m10 - m20 * m13;
385 v3 = m22 * m11 - m21 * m12;
386 v4 = m23 * m11 - m21 * m13;
387 v5 = m23 * m12 - m22 * m13;
389 T d03 = - (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
390 T d13 = + (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
391 T d23 = - (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
392 T d33 = + (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
406 T m10 = m[1][0], m11 = m[1][1], m12 = m[1][2];
407 T m20 = m[2][0], m21 = m[2][1], m22 = m[2][2];
409 T t00 = m22 * m11 - m21 * m12;
410 T t10 = m20 * m12 - m22 * m10;
411 T t20 = m21 * m10 - m20 * m11;
413 T m00 = m[0][0], m01 = m[0][1], m02 = m[0][2];
415 T invDet = 1 / (m00 * t00 + m01 * t10 + m02 * t20);
417 t00 *= invDet; t10 *= invDet; t20 *= invDet;
419 m00 *= invDet; m01 *= invDet; m02 *= invDet;
422 T r01 = m02 * m21 - m01 * m22;
423 T r02 = m01 * m12 - m02 * m11;
426 T r11 = m00 * m22 - m02 * m20;
427 T r12 = m02 * m10 - m00 * m12;
430 T r21 = m01 * m20 - m00 * m21;
431 T r22 = m00 * m11 - m01 * m10;
433 T m03 = m[0][3], m13 = m[1][3], m23 = m[2][3];
435 T r03 = - (r00 * m03 + r01 * m13 + r02 * m23);
436 T r13 = - (r10 * m03 + r11 * m13 + r12 * m23);
437 T r23 = - (r20 * m03 + r21 * m13 + r22 * m23);
457 m[0][3] = m[0][3] - v.
x;
458 m[1][3] = m[1][3] - v.
y;
459 m[2][3] = m[2][3] - v.
z;
465 return (memcmp(ptr(), rhs.
ptr(),
sizeof(T) * 16) == 0);
471 return (memcmp(ptr(), rhs.
ptr(),
sizeof(T) * 16) != 0);
475 inline std::ostream&
operator <<
478 for(
size_t i = 0; i < 4; ++i)
480 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:402
T x
Definition: DtVector4.h:95
static DtMatrix4 theIdentityMatrix
Definition: DtMatrix4.h:75
DtMatrix4< float > Matrix4_32
Definition: DtMatrix4.h:115
DtMatrix4()
CTOR.
Definition: DtMatrix4.h:119
~DtMatrix4()
DTOR.
Definition: DtMatrix4.h:149
void translateBack(const DtVector3< T > &v)
subtract the vector from the translation column
Definition: DtMatrix4.h:455
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:105
T z
Definition: DtVector3.h:132
DtMatrix4 convert_depth_gl_to_dx() const
Definition: DtMatrix4.h:256
const T * operator[](size_t iRow) const
Definition: DtMatrix4.h:161
bool isEqual(const DtMatrix4 &rhs, T tolerance) const
Check whether this matrix is equivalent to rhs within tolerance.
Definition: DtMatrix4.h:267
void zeroOutTranslation(void)
Zero out the translation column.
Definition: DtMatrix4.h:447
T x
Definition: DtVector3.h:132
4 dimensional vector
Definition: DtMath.h:22
bool operator==(const DtMatrix4< T > &rhs) const
equality
Definition: DtMatrix4.h:463
const void * ptr(void) const
Definition: DtMatrix4.h:155
DtMatrix4< double > Matrix4_64
Definition: DtMatrix4.h:116
T z
Definition: DtVector4.h:95
void operator=(const DtMatrix3< T > &rhs)
Assignment operator.
Definition: DtMatrix4.h:294
T _m[16]
Definition: DtMatrix4.h:104
bool isAffine(void) const
Return whether the last row is (0,0,0,1);.
Definition: DtMatrix4.h:304
T w
Definition: DtVector4.h:95
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:339
void setZero(void)
Set all values to zero.
Definition: DtMatrix4.h:232
3 dimensional matrix
Definition: DtMatrix3.h:20
bool operator!=(const DtMatrix4< T > &rhs) const
inequality
Definition: DtMatrix4.h:469
bool isIdentity(T tolerance=std::numeric_limits< T >::epsilon()) const
Definition: DtMatrix4.h:282
2 dimensional vector
Definition: DtMath.h:21
void setIdentity(void)
Set matrix to identity matrix.
Definition: DtMatrix4.h:238
DtMatrix4 getTranspose(void) const
Get the transpose of this matrix.
Definition: DtMatrix4.h:245
#define ASSERT_PREDICATE(p)
Definition: DtAssert.h:28
DtVector3< T > transformAffine(const DtVector3< T > &v) const
Definition: DtMatrix4.h:310
T y
Definition: DtVector4.h:95
4 dimensional matrix
Definition: DtMatrix4.h:22