Added util function

crates/util/src/lib.rs

@@ -2,6 +2,8 @@
 
 //! Various utilities
 
+use nalgebra::Vector2;
+
 pub mod constants;
 pub mod timing;
 
@@ -9,3 +11,9 @@ pub mod timing;
 pub fn to_radians(degrees: f32) -> f32 {
 	return (degrees / 360.0) * std::f32::consts::TAU;
 }
+
+/// Compute the clockwise angle between two vectors
+/// Returns a value in [0, 2pi]
+pub fn clockwise_angle(a: &Vector2<f32>, b: &Vector2<f32>) -> f32 {
+	(a.x * b.y - b.x * a.y).atan2(a.dot(&b))
+}