diff --git a/util/Matrix.cc b/util/Matrix.cc
index a1e7d58..5a46fe7 100644
--- a/util/Matrix.cc
+++ b/util/Matrix.cc
@@ -199,4 +199,13 @@ Vector operator*(const Matrix & m, const Vector & v)
 
 bool operator==(const Matrix & m1, const Matrix & m2)
 {
+    for (int i = 0; i < 4; i++)
+    {
+        for (int j = 0; j < 4; j++)
+        {
+            if (! FP_EQ(m1[i][j], m2[i][j]))
+                return false;
+        }
+    }
+    return true;
 }