core: pathfinding: filter out routes without blocks

Author: eckter

core/src/main/java/fr/sncf/osrd/api/pathfinding/PathfindingResultConverter.java

@@ -2,6 +2,7 @@
 
 import static fr.sncf.osrd.railjson.schema.common.graph.EdgeDirection.START_TO_STOP;
 import static fr.sncf.osrd.railjson.schema.common.graph.EdgeDirection.STOP_TO_START;
+import static fr.sncf.osrd.sim_infra.utils.BlockRecoveryKt.recoverBlocks;
 import static fr.sncf.osrd.utils.KtToJavaConverter.toIntList;
 import static fr.sncf.osrd.utils.indexing.DirStaticIdxKt.toDirection;
 import static fr.sncf.osrd.utils.indexing.DirStaticIdxKt.toValue;
@@ -17,13 +18,11 @@
 import fr.sncf.osrd.railjson.schema.infra.RJSRoutePath;
 import fr.sncf.osrd.railjson.schema.infra.trackranges.RJSDirectionalTrackRange;
 import fr.sncf.osrd.reporting.warnings.DiagnosticRecorderImpl;
-import fr.sncf.osrd.sim_infra.api.BlockInfra;
-import fr.sncf.osrd.sim_infra.api.PathProperties;
-import fr.sncf.osrd.sim_infra.api.RawSignalingInfra;
-import fr.sncf.osrd.sim_infra.api.RawSignalingInfraKt;
+import fr.sncf.osrd.sim_infra.api.*;
 import fr.sncf.osrd.utils.Direction;
 import fr.sncf.osrd.utils.DistanceRangeMap;
 import fr.sncf.osrd.utils.graph.Pathfinding;
+import fr.sncf.osrd.utils.indexing.MutableStaticIdxArrayList;
 import java.util.ArrayList;
 import java.util.Collection;
 import java.util.Comparator;
@@ -193,7 +192,7 @@ static List<RJSRoutePath> makeRoutePath(
                 .map(Pathfinding.EdgeRange::edge)
                 .toList();
         var chunkPath = chunksOnBlocks(blockInfra, blocks);
-        var routes = chunksToRoutes(rawInfra, chunkPath);
+        var routes = chunksToRoutes(rawInfra, blockInfra, chunkPath);
         var startOffset = findStartOffset(blockInfra, rawInfra, chunkPath.get(0), routes.get(0), ranges.get(0));
         var endOffset = findEndOffset(blockInfra, rawInfra, Iterables.getLast(chunkPath),
                 Iterables.getLast(routes), Iterables.getLast(ranges));
@@ -347,12 +346,13 @@ private static List<Integer> chunksOnBlocks(BlockInfra blockInfra, List<Integer>
     /** Converts a list of dir chunks into a list of routes */
     public static List<Integer> chunksToRoutes(
             RawSignalingInfra infra,
+            BlockInfra blockInfra,
             List<Integer> pathChunks
     ) {
         var chunkStartIndex = 0;
         var res = new ArrayList<Integer>();
         while (chunkStartIndex < pathChunks.size()) {
-            var route = findRoute(infra, pathChunks, chunkStartIndex, chunkStartIndex != 0);
+            var route = findRoute(infra, blockInfra, pathChunks, chunkStartIndex, chunkStartIndex != 0);
             res.add(route);
             var chunkSetOnRoute = new HashSet<>(toIntList(infra.getChunksOnRoute(route)));
             while (chunkStartIndex < pathChunks.size() && chunkSetOnRoute.contains(pathChunks.get(chunkStartIndex)))
@@ -364,6 +364,7 @@ public static List<Integer> chunksToRoutes(
     /** Finds a valid route that follows the given path */
     private static int findRoute(
             RawSignalingInfra infra,
+            BlockInfra blockInfra,
             List<Integer> chunks,
             int startIndex,
             boolean routeMustIncludeStart
@@ -374,19 +375,22 @@ private static int findRoute(
         routes.sort(Comparator.comparingInt(r -> -infra.getChunksOnRoute(r).getSize()));
 
         for (var routeId : routes)
-            if (routeMatchPath(infra, chunks, startIndex, routeMustIncludeStart, routeId))
+            if (routeMatchPath(infra, blockInfra, chunks, startIndex, routeMustIncludeStart, routeId))
                 return routeId;
         throw new RuntimeException("Couldn't find a route matching the given chunk list");
     }
 
     /** Returns false if the route differs from the path */
     private static boolean routeMatchPath(
             RawSignalingInfra infra,
+            BlockInfra blockInfra,
             List<Integer> chunks,
             int chunkIndex,
             boolean routeMustIncludeStart,
             int routeId
     ) {
+        if (!routeHasBlockPath(infra, blockInfra, routeId))
+            return false; // Filter out routes that don't have block, they would cause issues later on
         var firstChunk = chunks.get(chunkIndex);
         var routeChunks = infra.getChunksOnRoute(routeId);
         var routeChunkIndex = 0;
@@ -408,4 +412,18 @@ private static boolean routeMatchPath(
             chunkIndex++;
         }
     }
+
+    /** Returns true if the route contains a valid block path */
+    private static boolean routeHasBlockPath(
+            RawSignalingInfra infra,
+            BlockInfra blockInfra,
+            int routeId
+    ) {
+        var routeIds = new MutableStaticIdxArrayList<Route>();
+        routeIds.add(routeId);
+        var blockPaths = recoverBlocks(
+                infra, blockInfra, routeIds, null
+        );
+        return !blockPaths.isEmpty();
+    }
 }

core/src/main/java/fr/sncf/osrd/standalone_sim/ScheduleMetadataExtractor.kt

@@ -78,7 +78,7 @@ fun run(envelope: Envelope, trainPath: PathProperties, chunkPath: ChunkPath, sch
     val simulator = fullInfra.signalingSimulator
 
     // get a new generation route path
-    val routePath = toRouteIdList(chunksToRoutes(rawInfra, toIntList(chunkPath.chunks)))
+    val routePath = toRouteIdList(chunksToRoutes(rawInfra, fullInfra.blockInfra, toIntList(chunkPath.chunks)))
 
     // recover blocks from the route paths
     val detailedBlockPath = recoverBlockPath(simulator, fullInfra, routePath)