30 , T m10, T m11, T m12, T m13
31 , T m20, T m21, T m22, T m23
32 , T m30, T m31, T m32, T m33);
62 bool isIdentity(T tolerance = std::numeric_limits<T>::epsilon())
const;
69 const void*
ptr(
void)
const;
100 DtMatrix4<T> DtMatrix4<T>::theIdentityMatrix = DtMatrix4<T>(1,0,0,0
117 memcpy(_m, rhs, 16*
sizeof(T));
122 , T m10, T m11, T m12, T m13
123 , T m20, T m21, T m22, T m23
124 , T m30, T m31, T m32, T m33)
126 m[0][0]=m00;m[0][1]=m01;m[0][2]=m02;m[0][3]=m03;
127 m[1][0]=m10;m[1][1]=m11;m[1][2]=m12;m[1][3]=m13;
128 m[2][0]=m20;m[2][1]=m21;m[2][2]=m22;m[2][3]=m23;
129 m[3][0]=m30;m[3][1]=m31;m[3][2]=m32;m[3][3]=m33;
135 memcpy(m, rhs, 16*
sizeof(T));
175 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];
176 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];
177 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];
178 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];
180 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];
181 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];
182 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];
183 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];
185 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];
186 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];
187 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];
188 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];
190 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];
191 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];
192 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];
193 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];
212 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;
213 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;
214 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;
215 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;
223 memset(_m, 0, 16*
sizeof(T));
230 m[0][0] = m[1][1] = m[2][2] = m[3][3] = 1;
237 m[0][0], m[1][0], m[2][0], m[3][0]
238 , m[0][1], m[1][1], m[2][1], m[3][1]
239 , m[0][2], m[1][2], m[2][2], m[3][2]
240 , m[0][3], m[1][3], m[2][3], m[3][3]
248 result[2][0] = (result[2][0] + result[3][0])*0.5f;
249 result[2][1] = (result[2][1] + result[3][1])*0.5f;
250 result[2][2] = (result[2][2] + result[3][2])*0.5f;
251 result[2][3] = (result[2][3] + result[3][3])*0.5f;
259 for(
size_t i = 0; i < 4; ++i)
261 for(
size_t j = 0; j < 4; ++j)
274 return isEqual(rhs, tolerance);
287 m[0][0] = rhs[0][0]; m[0][1] = rhs[0][1]; m[0][2] = rhs[0][2];
288 m[1][0] = rhs[1][0]; m[1][1] = rhs[1][1]; m[1][2] = rhs[1][2];
289 m[2][0] = rhs[2][0]; m[2][1] = rhs[2][1]; m[2][2] = rhs[2][2];
295 return m[3][0] == 0 && m[3][1] == 0 && m[3][2] == 0 && m[3][3] == 1;
306 m[0][0]*v.
x + m[0][1]*v.
y + m[0][2]*v.
z + + m[0][3]
307 , m[1][0]*v.
x + m[1][1]*v.
y + m[1][2]*v.
z + + m[1][3]
308 , m[2][0]*v.
x + m[2][1]*v.
y + m[2][2]*v.
z + + m[2][3]
320 m[0][0]*v.
x + m[0][1]*v.
y + m[0][2]*v.
z + + m[0][3]
321 , m[1][0]*v.
x + m[1][1]*v.
y + m[1][2]*v.
z + + m[1][3]
322 , m[2][0]*v.
x + m[2][1]*v.
y + m[2][2]*v.
z + + m[2][3]
330 T m00 = m[0][0], m01 = m[0][1], m02 = m[0][2], m03 = m[0][3];
331 T m10 = m[1][0], m11 = m[1][1], m12 = m[1][2], m13 = m[1][3];
332 T m20 = m[2][0], m21 = m[2][1], m22 = m[2][2], m23 = m[2][3];
333 T m30 = m[3][0], m31 = m[3][1], m32 = m[3][2], m33 = m[3][3];
335 T v0 = m20 * m31 - m21 * m30;
336 T v1 = m20 * m32 - m22 * m30;
337 T v2 = m20 * m33 - m23 * m30;
338 T v3 = m21 * m32 - m22 * m31;
339 T v4 = m21 * m33 - m23 * m31;
340 T v5 = m22 * m33 - m23 * m32;
342 T t00 = + (v5 * m11 - v4 * m12 + v3 * m13);
343 T t10 = - (v5 * m10 - v2 * m12 + v1 * m13);
344 T t20 = + (v4 * m10 - v2 * m11 + v0 * m13);
345 T t30 = - (v3 * m10 - v1 * m11 + v0 * m12);
347 T invDet = 1 / (t00 * m00 + t10 * m01 + t20 * m02 + t30 * m03);
349 T d00 = t00 * invDet;
350 T d10 = t10 * invDet;
351 T d20 = t20 * invDet;
352 T d30 = t30 * invDet;
354 T d01 = - (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
355 T d11 = + (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
356 T d21 = - (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
357 T d31 = + (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
359 v0 = m10 * m31 - m11 * m30;
360 v1 = m10 * m32 - m12 * m30;
361 v2 = m10 * m33 - m13 * m30;
362 v3 = m11 * m32 - m12 * m31;
363 v4 = m11 * m33 - m13 * m31;
364 v5 = m12 * m33 - m13 * m32;
366 T d02 = + (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
367 T d12 = - (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
368 T d22 = + (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
369 T d32 = - (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
371 v0 = m21 * m10 - m20 * m11;
372 v1 = m22 * m10 - m20 * m12;
373 v2 = m23 * m10 - m20 * m13;
374 v3 = m22 * m11 - m21 * m12;
375 v4 = m23 * m11 - m21 * m13;
376 v5 = m23 * m12 - m22 * m13;
378 T d03 = - (v5 * m01 - v4 * m02 + v3 * m03) * invDet;
379 T d13 = + (v5 * m00 - v2 * m02 + v1 * m03) * invDet;
380 T d23 = - (v4 * m00 - v2 * m01 + v0 * m03) * invDet;
381 T d33 = + (v3 * m00 - v1 * m01 + v0 * m02) * invDet;
395 T m10 = m[1][0], m11 = m[1][1], m12 = m[1][2];
396 T m20 = m[2][0], m21 = m[2][1], m22 = m[2][2];
398 T t00 = m22 * m11 - m21 * m12;
399 T t10 = m20 * m12 - m22 * m10;
400 T t20 = m21 * m10 - m20 * m11;
402 T m00 = m[0][0], m01 = m[0][1], m02 = m[0][2];
404 T invDet = 1 / (m00 * t00 + m01 * t10 + m02 * t20);
406 t00 *= invDet; t10 *= invDet; t20 *= invDet;
408 m00 *= invDet; m01 *= invDet; m02 *= invDet;
411 T r01 = m02 * m21 - m01 * m22;
412 T r02 = m01 * m12 - m02 * m11;
415 T r11 = m00 * m22 - m02 * m20;
416 T r12 = m02 * m10 - m00 * m12;
419 T r21 = m01 * m20 - m00 * m21;
420 T r22 = m00 * m11 - m01 * m10;
422 T m03 = m[0][3], m13 = m[1][3], m23 = m[2][3];
424 T r03 = - (r00 * m03 + r01 * m13 + r02 * m23);
425 T r13 = - (r10 * m03 + r11 * m13 + r12 * m23);
426 T r23 = - (r20 * m03 + r21 * m13 + r22 * m23);
446 m[0][3] = m[0][3] - v.
x;
447 m[1][3] = m[1][3] - v.
y;
448 m[2][3] = m[2][3] - v.
z;
452 inline std::ostream&
operator <<
455 for(
size_t i = 0; i < 4; ++i)
457 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:391
T x
Definition: DtVector4.h:62
static DtMatrix4 theIdentityMatrix
Definition: DtMatrix4.h:71
DtMatrix4< float > Matrix4_32
Definition: DtMatrix4.h:105
DtMatrix4()
CTOR.
Definition: DtMatrix4.h:109
~DtMatrix4()
DTOR.
Definition: DtMatrix4.h:139
void translateBack(const DtVector3< T > &v)
subtract the vector from the translation column
Definition: DtMatrix4.h:444
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:95
T z
Definition: DtVector3.h:87
DtMatrix4 convert_depth_gl_to_dx() const
Definition: DtMatrix4.h:245
const T * operator[](size_t iRow) const
Definition: DtMatrix4.h:150
bool isEqual(const DtMatrix4 &rhs, T tolerance) const
Check whether this matrix is equivalent to rhs within tolerance.
Definition: DtMatrix4.h:256
void zeroOutTranslation(void)
Zero out the translation column.
Definition: DtMatrix4.h:436
T x
Definition: DtVector3.h:87
4 dimensional vector
Definition: DtVector4.h:24
const void * ptr(void) const
Definition: DtMatrix4.h:144
DtMatrix4< double > Matrix4_64
Definition: DtMatrix4.h:106
T z
Definition: DtVector4.h:62
void operator=(const DtMatrix3< T > &rhs)
Assignment operator.
Definition: DtMatrix4.h:283
T _m[16]
Definition: DtMatrix4.h:94
bool isAffine(void) const
Return whether the last row is (0,0,0,1);.
Definition: DtMatrix4.h:293
T w
Definition: DtVector4.h:62
T y
Definition: DtVector3.h:87
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:328
void setZero(void)
Set all values to zero.
Definition: DtMatrix4.h:221
3 dimensional matrix
Definition: DtMatrix3.h:20
bool isIdentity(T tolerance=std::numeric_limits< T >::epsilon()) const
Definition: DtMatrix4.h:271
2 dimensional vector
Definition: DtVector3.h:26
void setIdentity(void)
Set matrix to identity matrix.
Definition: DtMatrix4.h:227
DtMatrix4 getTranspose(void) const
Get the transpose of this matrix.
Definition: DtMatrix4.h:234
#define ASSERT_PREDICATE(p)
Definition: DtAssert.h:28
DtVector3< T > transformAffine(const DtVector3< T > &v) const
Definition: DtMatrix4.h:299
T y
Definition: DtVector4.h:62
4 dimensional matrix
Definition: DtMatrix4.h:19