pnx/spectre
1
0
Fork 0
Code Releases 2 Activity

include/Spectre/Math/Matrix3.h: Add inverse()

Browse source
This commit is contained in:
Henrik Hautakoski 2023-08-18 17:54:19 +02:00
parent 910bad0fb7
commit d8db86e40c
2 changed files with 27 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

3
include/Spectre/Math/Matrix3.h
View file

@ -78,6 +78,9 @@ struct Matrix3
// Transpose matrix.
Matrix3<T> transpose() const;
// Inverse
Matrix3<T> inverse() const;
};
template <typename T>

24
include/Spectre/Math/Matrix3.inl
View file

@ -136,6 +136,30 @@ float Matrix3<T>::det() const
return det;
}
template<typename T>
Matrix3<T> Matrix3<T>::inverse() const
{
float d = det();
if (d != 0.0f) {
float a00 = (v[4] * v[8]) - (v[7] * v[5]);
float a01 = -((v[1] * v[8]) - (v[7] * v[2]));
float a02 = (v[1] * v[5]) - (v[4] * v[2]);
float a10 = -((v[3] * v[8]) - (v[6] * v[5]));
float a11 = (v[0] * v[8]) - (v[6] * v[2]);
float a12 = -((v[0] * v[5]) - (v[3] * v[2]));
float a20 = (v[3] * v[7]) - (v[6] * v[4]);
float a21 = -((v[0] * v[7]) - (v[6] * v[1]));
float a22 = (v[0] * v[4]) - (v[3] * v[1]);
return Matrix3<T>(a00, a01, a02, a10, a11, a12, a20, a21, a22) / d;
}
return Matrix3<T>::Identity;
}
template<typename T>
Matrix3<T> Matrix3<T>::transpose() const
{