use crate::{CoordFloat, Point, MEAN_EARTH_RADIUS};
use num_traits::FromPrimitive;
use super::RhumbCalculations;
pub trait RhumbDistance<T, Rhs = Self> {
fn rhumb_distance(&self, rhs: &Rhs) -> T;
}
impl<T> RhumbDistance<T, Point<T>> for Point<T>
where
T: CoordFloat + FromPrimitive,
{
fn rhumb_distance(&self, rhs: &Point<T>) -> T {
let calculations = RhumbCalculations::new(self, rhs);
calculations.delta() * T::from(MEAN_EARTH_RADIUS).unwrap()
}
}
#[cfg(test)]
mod test {
use crate::Point;
use crate::RhumbDistance;
#[test]
fn distance1_test() {
let a = Point::new(0., 0.);
let b = Point::new(1., 0.);
assert_relative_eq!(
a.rhumb_distance(&b),
111195.0802335329_f64,
epsilon = 1.0e-6
);
}
#[test]
fn distance2_test() {
let a = Point::new(-72.1235, 42.3521);
let b = Point::new(72.1260, 70.612);
assert_relative_eq!(
a.rhumb_distance(&b),
8903668.508603323_f64,
epsilon = 1.0e-6
);
}
#[test]
fn distance3_test() {
let a = Point::new(-77.036585, 38.897448);
let b = Point::new(-77.009080, 38.889825);
assert_relative_eq!(
a.rhumb_distance(&b),
2526.7031699343006_f64,
epsilon = 1.0e-6
);
}
#[test]
fn distance3_test_f32() {
let a = Point::<f32>::new(-77.03658, 38.89745);
let b = Point::<f32>::new(-77.00908, 38.889825);
assert_relative_eq!(a.rhumb_distance(&b), 2526.7273_f32, epsilon = 1.0e-6);
}
}