Function wrap_to_pi

pub fn wrap_to_pi<T>(angle: T) -> T
where
    T: PartialOrd + Copy + SubAssign + AddAssign + From<f64>,

Wrap an angle to the range 0 to 2*pi radians This function is generic and can be used with any type that implements the necessary traits.