use std::f64::consts::PI;
use crate::constants::DPI;
pub fn principal_angle(angle_radians: f64) -> f64 {
angle_radians.rem_euclid(DPI)
}
pub fn angle_diff(first_angle_radians: f64, second_angle_radians: f64) -> f64 {
let normalized_first_angle = principal_angle(first_angle_radians);
let normalized_second_angle = principal_angle(second_angle_radians);
let mut signed_difference = normalized_first_angle - normalized_second_angle;
if signed_difference > PI {
signed_difference -= DPI;
} else if signed_difference < -PI {
signed_difference += DPI;
}
signed_difference
}