pub fn normalize_angle_to_positive(angle: f64) -> f64
Normalizes an angle in radians to the range [0, 2π).