editoast: pathfinding: initial upperbound is based on begin/end track’s bboxes

Author: Tristramg

editoast/src/map/bounding_box.rs

@@ -54,6 +54,20 @@ impl BoundingBox {
     pub fn from_geometry(value: Geometry) -> Result<Self> {
         Self::from_geojson(value.value)
     }
+
+    /// Computes the length (in meters) of the diagonal
+    /// It represents the longest distance as the crow flies between two points in the box
+    pub fn diagonal_length(&self) -> f64 {
+        let a = osm4routing::Coord {
+            lon: self.0 .0,
+            lat: self.0 .1,
+        };
+        let b = osm4routing::Coord {
+            lon: self.1 .0,
+            lat: self.1 .1,
+        };
+        a.distance_to(b)
+    }
 }
 
 #[derive(Debug, Error, EditoastError)]

editoast/src/views/infra/pathfinding.rs

@@ -191,7 +191,16 @@ fn compute_path(
     let into_cost = |length: f64| (length * 100.).round() as u64;
     let get_length = |track: &String| track_sections[track].unwrap_track_section().length;
     let success = |step: &PathfindingStep| step.found;
-    let mut best_distance = u64::MAX;
+
+    let starting_track = track_sections[&input.starting.track.0].unwrap_track_section();
+    let ending_track = track_sections[&input.ending.track.0].unwrap_track_section();
+    let best_distance = starting_track
+        .bbox_geo
+        .clone()
+        .union(&ending_track.bbox_geo)
+        .diagonal_length();
+    let mut best_distance = into_cost(best_distance);
+
     let successors = |step: &PathfindingStep| {
         // We initially don’t know in which direction start searching the path
         // So the first step as two successors, at the same track-position, but in opposite directions