1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65

use core::fmt::Debug;
use core::fmt::Display;

use geo::CoordFloat;
use geo_types::Coord;

use crate::in_delta::in_delta;
use crate::math::EPSILON;
use crate::Transform;

/// Asserts  point projected and then inverted returns to the original location.
///
/// Helper test function.
///
/// # Panics
/// unwrap() is used here but a panic will never happen as EPSILON will always be converted into T.
pub fn projection_equal<'a, P, T>(
    projector: &P,
    expected_location: &'a Coord<T>,
    expected_point: &'a Coord<T>,
    delta_p: Option<T>,
) -> bool
where
    P: Transform<T = T>,
    T: CoordFloat + Display,
{
    let delta = delta_p.map_or_else(|| T::from(EPSILON).unwrap(), |d| d);
    println!("project_equal");
    println!(
        "1) expected location [{:?}, {:?}], expected point [{:?}, {:?}]",
        expected_location.x, expected_location.y, expected_point.x, expected_point.y,
    );
    let actual_location = projector.invert(expected_point);
    let actual_point = projector.transform(expected_location);
    println!("2) actual location {actual_location:?}, actual point {actual_point:?}");
    planar_equal(&actual_point, expected_point, delta)
        && spherical_equal(&actual_location, expected_location, delta)
}

fn planar_equal<T: CoordFloat + Debug + Display>(
    actual: &Coord<T>,
    expected: &Coord<T>,
    delta: T,
) -> bool {
    let e0 = in_delta(actual.x, expected.x, delta);
    let e1 = in_delta(actual.y, expected.y, delta);
    e0 && e1
}

fn spherical_equal<T>(actual: &Coord<T>, expected: &Coord<T>, delta: T) -> bool
where
    T: CoordFloat + Display,
{
    let e0 = logitude_equal(actual.x, expected.x, delta);
    let e1 = in_delta(actual.y, expected.y, delta);
    e0 && e1
}

fn logitude_equal<T>(actual: T, expected: T, delta: T) -> bool
where
    T: CoordFloat,
{
    let actual = (actual - expected).abs() % T::from(360_f64).unwrap();
    actual <= delta || actual >= T::from(360_f64).unwrap() - delta
}