diff --git a/SimoxUtility/math/pose/is_homogeneous_transform.h b/SimoxUtility/math/pose/is_homogeneous_transform.h index 91e0db441d795683ac0aefc119c4468f4ed06d12..fc3e43c7c38ca67800cb188da5af22627b836c19 100644 --- a/SimoxUtility/math/pose/is_homogeneous_transform.h +++ b/SimoxUtility/math/pose/is_homogeneous_transform.h @@ -9,11 +9,11 @@ namespace simox::math { inline bool is_homogeneous_transform( - const Eigen::Matrix4f& mat, + const Eigen::Matrix4f& mat, float precision = 1e-6f) { - return is_rotation_matrix(mat.template top_left_corner<3,3>(), precision) && - is_finite(mat.template topRightCornery<3,1>()) && + return is_rotation_matrix(mat.template topLeftCorner<3, 3>(), precision) && + is_finite(mat.template topRightCorner<3, 1>()) && std::abs(mat(3,0)) < precision && std::abs(mat(3,1)) < precision && std::abs(mat(3,2)) < precision &&