routee-compass-core 0.11.3

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
42
43
44
45
46
47
48
49
50
51
52

use std::borrow::Cow;

use super::map_error::MapError;
use crate::{
    model::unit::{Convert, Distance, DistanceUnit},
    util::geo::haversine,
};
use geo::Point;
use rstar::AABB;

pub fn test_threshold(
    envelope: &AABB<Point<f32>>,
    other: &Point<f32>,
    tolerance_distance: Distance,
    tolerance_distance_unit: DistanceUnit,
) -> Result<bool, MapError> {
    let this_coord = envelope.lower().0;
    let mut distance_meters = Cow::Owned(
        haversine::coord_distance_meters(&this_coord, &other.0).map_err(MapError::MapMatchError)?,
    );
    DistanceUnit::Meters.convert(&mut distance_meters, &tolerance_distance_unit)?;
    Ok(distance_meters.into_owned() >= tolerance_distance)
}

pub fn within_threshold(
    envelope: &AABB<Point<f32>>,
    other: &Point<f32>,
    tolerance_distance: Distance,
    tolerance_distance_unit: DistanceUnit,
) -> Result<(), MapError> {
    let this_coord = envelope.lower().0;
    let mut this_distance = Cow::Owned(
        haversine::coord_distance_meters(&this_coord, &other.0).map_err(MapError::MapMatchError)?,
    );
    DistanceUnit::Meters.convert(&mut this_distance, &tolerance_distance_unit)?;
    let this_distance_converted = this_distance.into_owned();
    if this_distance_converted >= tolerance_distance {
        Err(MapError::MapMatchError(
            format!(
                "coord {:?} nearest vertex coord is {:?} which is {} {} away, exceeding the distance tolerance of {} {}", 
                this_coord,
                other,
                this_distance_converted,
                tolerance_distance_unit,
                tolerance_distance,
                tolerance_distance_unit,
            )
        ))
    } else {
        Ok(())
    }
}