diff --git a/src/Math/Matrix.h b/src/Math/Matrix.h index 432ded0d8..1db788d34 100644 --- a/src/Math/Matrix.h +++ b/src/Math/Matrix.h @@ -114,13 +114,12 @@ template class Matrix: public RectangularMatrix::equals((*this)[i].dot(), T(1))) - return false; + if(!(*this)[i].isNormalized()) return false; /* Orthogonality */ for(std::size_t i = 0; i != size-1; ++i) for(std::size_t j = i+1; j != size; ++j) - if(!TypeTraits::equals(Vector::dot((*this)[i], (*this)[j]), T(0))) + if(Vector::dot((*this)[i], (*this)[j]) > TypeTraits::epsilon()) return false; return true;