Added DeviationMatrixComp and IsIdentity

inc/hgl/math/Matrix.h

@@ -12,18 +12,20 @@ namespace hgl
 {
     using Quat4f=glm::quat;
 
-    using Matrix2f=glm::mat2;
+#define DEFINE_MATRIX(num)  using Matrix##num##f=glm::mat##num;  \
-    using Matrix3f=glm::mat3;
+                            constexpr const Matrix##num##f Identity##num##f=Matrix##num##f(1.0f); \
-    using Matrix4f=glm::mat4;
+                            inline bool IsIdentity(const Matrix##num##f &m){return(hgl_cmp(m,Identity##num##f)==0);}    \
-    using Matrix2x4f=glm::mat2x4;
+                            inline int FastMatrixComp(const Matrix##num##f &m1,const Matrix##num##f &m2){return hgl_cmp(m1,m2);}
-    using Matrix3x4f=glm::mat3x4;
-    using Matrix4x2f=glm::mat4x2;
-    using Matrix4x3f=glm::mat4x3;
 
-    constexpr const Matrix2f Identity2f=Matrix2f(1.0f);
+    DEFINE_MATRIX(2)
-    constexpr const Matrix3f Identity3f=Matrix3f(1.0f);
+    DEFINE_MATRIX(3)
-    constexpr const Matrix4f Identity4f=Matrix4f(1.0f);
+    DEFINE_MATRIX(4)
-    constexpr const Matrix3f Identity3x4f=Matrix3x4f(1.0f);
+    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