geo/algorithm/
geodesic_bearing.rs1use crate::Point;
2use geo_types::CoordNum;
3use geographiclib_rs::{Geodesic, InverseGeodesic};
4
5pub trait GeodesicBearing<T: CoordNum> {
11 fn geodesic_bearing(&self, point: Point<T>) -> T;
27
28 fn geodesic_bearing_distance(&self, point: Point<T>) -> (T, T);
50}
51
52impl GeodesicBearing<f64> for Point<f64> {
53 fn geodesic_bearing(&self, rhs: Point<f64>) -> f64 {
54 let (azi1, _, _) = Geodesic::wgs84().inverse(self.y(), self.x(), rhs.y(), rhs.x());
55 azi1
56 }
57
58 fn geodesic_bearing_distance(&self, rhs: Point<f64>) -> (f64, f64) {
59 let (distance, azi1, _, _) =
60 Geodesic::wgs84().inverse(self.y(), self.x(), rhs.y(), rhs.x());
61 (azi1, distance)
62 }
63}
64
65#[cfg(test)]
66mod test {
67 use super::*;
68 use crate::point;
69
70 #[test]
71 fn north_bearing() {
72 let p_1 = point!(x: 9., y: 47.);
73 let p_2 = point!(x: 9., y: 48.);
74 let bearing = p_1.geodesic_bearing(p_2);
75 assert_relative_eq!(bearing, 0.);
76 }
77
78 #[test]
79 fn east_bearing() {
80 let p_1 = point!(x: 9., y: 10.);
81 let p_2 = point!(x: 18.118501133357412, y: 9.875322179340463);
82 let bearing = p_1.geodesic_bearing(p_2);
83 assert_relative_eq!(bearing, 90.);
84 }
85
86 #[test]
87 fn northeast_bearing() {
88 let p_1 = point!(x: 9.177789688110352f64, y: 48.776781529534965);
89 let p_2 = point!(x: 9.27411867078536, y: 48.8403266058781);
90 let bearing = p_1.geodesic_bearing(p_2);
91 assert_relative_eq!(bearing, 45., epsilon = 1.0e-11);
92 }
93
94 #[test]
95 fn consistent_with_destination() {
96 use crate::algorithm::GeodesicDestination;
97 let p_1 = point!(x: 9.177789688110352, y: 48.776781529534965);
98 let p_2 = p_1.geodesic_destination(45., 10000.);
99 let (bearing, distance) = p_1.geodesic_bearing_distance(p_2);
100 assert_relative_eq!(bearing, 45., epsilon = 1.0e-11);
101 assert_relative_eq!(distance, 10000.0, epsilon = 1.0e-9);
102 }
103}