diff --git a/matrix/Vector.hpp b/matrix/Vector.hpp
index b0e01f5555..3d19e1dac0 100644
--- a/matrix/Vector.hpp
+++ b/matrix/Vector.hpp
@@ -83,6 +83,14 @@ public:
         return (*this) / norm();
     }
 
+    Vector unit_or_zero(const Type eps = 1e-5f) {
+        const Type n = norm();
+        if (n > eps) {
+            return (*this) / n;
+        }
+        return Vector();
+    }
+
     inline Vector normalized() const {
         return unit();
     }