math::get_arbitrary_line_perpendicular

fyrox-math/src/lib.rs

@@ -545,6 +545,21 @@ where
     closest_index
 }
 
+#[inline]
+pub fn get_arbitrary_line_perpendicular(
+    begin: Vector3<f32>,
+    end: Vector3<f32>,
+) -> Option<Vector3<f32>> {
+    let dir = (end - begin).try_normalize(f32::EPSILON)?;
+    for axis in [Vector3::x(), Vector3::y(), Vector3::z()] {
+        let perp = dir.cross(&axis);
+        if perp.norm_squared().ne(&0.0) {
+            return Some(perp);
+        }
+    }
+    None
+}
+
 /// Returns a tuple of (point index; triangle index) closest to the given point.
 #[inline]
 pub fn get_closest_point_triangle_set<P>(