hyzboy/CMCore
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Added DeviationMatrixComp and IsIdentity

Browse Source
This commit is contained in:
hyzboy 2024-07-17 01:54:28 +08:00
parent b07a4bb5be
commit 22bef5e154
1 changed files with 37 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

48
inc/hgl/math/Matrix.h
View File

@ -12,18 +12,20 @@ namespace hgl
{
using Quat4f=glm::quat;
using Matrix2f=glm::mat2;
using Matrix3f=glm::mat3;
using Matrix4f=glm::mat4;
using Matrix2x4f=glm::mat2x4;
using Matrix3x4f=glm::mat3x4;
using Matrix4x2f=glm::mat4x2;
using Matrix4x3f=glm::mat4x3;
#define DEFINE_MATRIX(num) using Matrix##num##f=glm::mat##num; \
constexpr const Matrix##num##f Identity##num##f=Matrix##num##f(1.0f); \
inline bool IsIdentity(const Matrix##num##f &m){return(hgl_cmp(m,Identity##num##f)==0);} \
inline int FastMatrixComp(const Matrix##num##f &m1,const Matrix##num##f &m2){return hgl_cmp(m1,m2);}
constexpr const Matrix2f Identity2f=Matrix2f(1.0f);
constexpr const Matrix3f Identity3f=Matrix3f(1.0f);
constexpr const Matrix4f Identity4f=Matrix4f(1.0f);
constexpr const Matrix3f Identity3x4f=Matrix3x4f(1.0f);
DEFINE_MATRIX(2)
DEFINE_MATRIX(3)
DEFINE_MATRIX(4)
DEFINE_MATRIX(2x4)
DEFINE_MATRIX(3x4)
DEFINE_MATRIX(4x2)
DEFINE_MATRIX(4x3)
#undef DEFINE_MATRIX
inline Matrix4f inverse(const Matrix4f &m)
{
@ -182,5 +184,29 @@ namespace hgl
{
return root*child;
}
/**
* 带误差的比较两个浮点矩阵是否相等
* @param m1 矩阵1
* @param m2 矩阵2
* @param deviation 允许的误差值
*/
template<typename M>
inline float DeviationMatrixComp(const M &m1,const M &m2,const float deviation=HGL_FLOAT_KINDA_SMALL)
{
float *f1=(float *)&m1;
float *f2=(float *)&m2;
float gap;
for(int i=0;i<sizeof(M)/sizeof(float);i++)
{
gap=*f1-*f2;
if(fabsf(gap)<deviation)
return(gap);
}
return 0;
}
}//namespace hgl
#endif//HGL_ALGORITHM_MATH_VECTOR_MATRIX_INCLUDE