Add GeodesicIntermediate algorithm

geo/src/algorithm/geodesic_intermediate.rs

@@ -0,0 +1,138 @@
+use crate::{CoordFloat, Point};
+use geographiclib_rs::{DirectGeodesic, Geodesic, InverseGeodesic};
+
+/// Returns a new Point along a route between two existing points on an ellipsoidal model of the earth
+
+pub trait GeodesicIntermediate<T: CoordFloat> {
+    /// Returns a new Point along a route between two existing points on an ellipsoidal model of the earth
+    ///
+    /// # Examples
+    ///
+    /// ```
+    /// # #[macro_use] extern crate approx;
+    /// #
+    /// use geo::algorithm::geodesic_intermediate::GeodesicIntermediate;
+    /// use geo::Point;
+    ///
+    /// let p1 = Point::<f64>::new(10.0, 20.0);
+    /// let p2 = Point::<f64>::new(125.0, 25.0);
+    /// let i20 = p1.geodesic_intermediate(&p2, 0.2);
+    /// let i50 = p1.geodesic_intermediate(&p2, 0.5);
+    /// let i80 = p1.geodesic_intermediate(&p2, 0.8);
+    /// let i20_should = Point::new(29.842907, 29.951445);
+    /// let i50_should = Point::new(65.879360, 37.722253);
+    /// let i80_should = Point::new(103.556796, 33.506196);
+    /// assert_relative_eq!(i20.x(), i20_should.x(), epsilon = 1.0e-6);
+    /// assert_relative_eq!(i20.y(), i20_should.y(), epsilon = 1.0e-6);
+    /// assert_relative_eq!(i50.x(), i50_should.x(), epsilon = 1.0e-6);
+    /// assert_relative_eq!(i50.y(), i50_should.y(), epsilon = 1.0e-6);
+    /// assert_relative_eq!(i80.x(), i80_should.x(), epsilon = 1.0e-6);
+    /// assert_relative_eq!(i80.y(), i80_should.y(), epsilon = 1.0e-6);
+    /// ```
+
+    fn geodesic_intermediate(&self, other: &Point<T>, f: T) -> Point<T>;
+    fn geodesic_intermediate_fill(
+        &self,
+        other: &Point<T>,
+        max_dist: T,
+        include_ends: bool,
+    ) -> Vec<Point<T>>;
+}
+
+impl GeodesicIntermediate<f64> for Point<f64> {
+    fn geodesic_intermediate(&self, other: &Point<f64>, f: f64) -> Point<f64> {
+        let g = Geodesic::wgs84();
+        let (total_distance, azi1, _azi2, _a12) =
+            g.inverse(self.lat(), self.lng(), other.lat(), other.lng());
+        let distance = total_distance * f;
+        let (lat2, lon2) = g.direct(self.lat(), self.lng(), azi1, distance);
+
+        Point::new(lon2, lat2)
+    }
+
+    fn geodesic_intermediate_fill(
+        &self,
+        other: &Point<f64>,
+        max_dist: f64,
+        include_ends: bool,
+    ) -> Vec<Point<f64>> {
+        let g = Geodesic::wgs84();
+        let (total_distance, azi1, _azi2, _a12) =
+            g.inverse(self.lat(), self.lng(), other.lat(), other.lng());
+
+        if total_distance <= max_dist {
+            if include_ends {
+                return vec![*self, *other];
+            } else {
+                return vec![];
+            }
+        }
+
+        let number_of_points = (total_distance / max_dist).ceil();
+        let interval = 1.0 / number_of_points;
+
+        let mut current_step = interval;
+        let mut points = if include_ends { vec![*self] } else { vec![] };
+
+        while current_step < 1.0 {
+            let (lat2, lon2) =
+                g.direct(self.lat(), self.lng(), azi1, total_distance * current_step);
+            let point = Point::new(lon2, lat2);
+            points.push(point);
+            current_step = current_step + interval;
+        }
+
+        if include_ends {
+            points.push(*other);
+        }
+
+        points
+    }
+}
+
+#[cfg(test)]
+mod tests {
+    use super::*;
+    use approx::assert_relative_eq;
+
+    #[test]
+    fn f_is_zero_or_one_test() {
+        let p1 = Point::<f64>::new(10.0, 20.0);
+        let p2 = Point::<f64>::new(15.0, 25.0);
+        let i0 = p1.geodesic_intermediate(&p2, 0.0);
+        let i100 = p1.geodesic_intermediate(&p2, 1.0);
+        assert_relative_eq!(i0.x(), p1.x(), epsilon = 1.0e-6);
+        assert_relative_eq!(i0.y(), p1.y(), epsilon = 1.0e-6);
+        assert_relative_eq!(i100.x(), p2.x(), epsilon = 1.0e-6);
+        assert_relative_eq!(i100.y(), p2.y(), epsilon = 1.0e-6);
+    }
+
+    #[test]
+    fn various_f_values_test() {
+        let p1 = Point::<f64>::new(10.0, 20.0);
+        let p2 = Point::<f64>::new(125.0, 25.0);
+        let i20 = p1.geodesic_intermediate(&p2, 0.2);
+        let i50 = p1.geodesic_intermediate(&p2, 0.5);
+        let i80 = p1.geodesic_intermediate(&p2, 0.8);
+        let i20_should = Point::new(29.842907, 29.951445);
+        let i50_should = Point::new(65.879360, 37.722253);
+        let i80_should = Point::new(103.556796, 33.506196);
+        assert_relative_eq!(i20.x(), i20_should.x(), epsilon = 1.0e-6);
+        assert_relative_eq!(i20.y(), i20_should.y(), epsilon = 1.0e-6);
+        assert_relative_eq!(i50.x(), i50_should.x(), epsilon = 1.0e-6);
+        assert_relative_eq!(i50.y(), i50_should.y(), epsilon = 1.0e-6);
+        assert_relative_eq!(i80.x(), i80_should.x(), epsilon = 1.0e-6);
+        assert_relative_eq!(i80.y(), i80_should.y(), epsilon = 1.0e-6);
+    }
+
+    #[test]
+    fn should_add_i50_test() {
+        let p1 = Point::<f64>::new(30.0, 40.0);
+        let p2 = Point::<f64>::new(40.0, 50.0);
+        let max_dist = 1000000.0; // meters
+        let include_ends = true;
+        let i50 = p1.clone().geodesic_intermediate(&p2, 0.5);
+        let route = p1.geodesic_intermediate_fill(&p2, max_dist, include_ends);
+        assert_eq!(route, vec![p1, i50, p2]);
+    }
+}

geo/src/algorithm/mod.rs

@@ -37,6 +37,8 @@ pub mod frechet_distance;
 pub mod geodesic_distance;
 /// Calculate the Geodesic length of a line.
 pub mod geodesic_length;
+/// Calculate a new `Point` lying on a Geodesic arc between two `Point`s.
+pub mod geodesic_intermediate;
 /// Calculate a destination `Point`, given a distance and a bearing.
 pub mod haversine_destination;
 /// Calculate the Haversine distance between two `Geometries`.

geo/src/lib.rs

@@ -105,6 +105,7 @@ pub mod prelude {
     pub use crate::algorithm::frechet_distance::FrechetDistance;
     pub use crate::algorithm::geodesic_distance::GeodesicDistance;
     pub use crate::algorithm::geodesic_length::GeodesicLength;
+    pub use crate::algorithm::geodesic_intermediate::GeodesicIntermediate;
     pub use crate::algorithm::haversine_destination::HaversineDestination;
     pub use crate::algorithm::haversine_distance::HaversineDistance;
     pub use crate::algorithm::haversine_intermediate::HaversineIntermediate;