routee-compass-core 0.17.0

The core routing algorithms and data structures of the RouteE-Compass energy-aware routing engine
Documentation 
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

use super::map_error::MapError;
use crate::util::geo::haversine;
use geo::Point;
use rstar::AABB;
use uom::si::f64::Length;

pub fn test_threshold(
    envelope: &AABB<Point<f32>>,
    other: &Point<f32>,
    tolerance_distance: Length,
) -> Result<bool, MapError> {
    let this_coord = envelope.lower().0;
    let distance =
        haversine::coord_distance(&this_coord, &other.0).map_err(MapError::MapMatchError)?;
    Ok(distance >= tolerance_distance)
}

pub fn within_threshold(
    envelope: &AABB<Point<f32>>,
    other: &Point<f32>,
    tolerance_distance: Length,
) -> Result<(), MapError> {
    let this_coord = envelope.lower().0;
    let this_distance =
        haversine::coord_distance(&this_coord, &other.0).map_err(MapError::MapMatchError)?;
    if this_distance >= tolerance_distance {
        Err(MapError::MapMatchError(
            format!(
                "coord {:?} nearest vertex coord is {:?} which is {} {} away, exceeding the distance tolerance of {} {}", 
                this_coord,
                other,
                this_distance.get::<uom::si::length::meter>(),
                "meters",
                tolerance_distance.get::<uom::si::length::meter>(),
                "meters"
            )
        ))
    } else {
        Ok(())
    }
}