diff --git a/nav2_bringup/launch/localization_launch.py b/nav2_bringup/launch/localization_launch.py
index bba1eb15e54..5e3de548f12 100644
--- a/nav2_bringup/launch/localization_launch.py
+++ b/nav2_bringup/launch/localization_launch.py
@@ -20,6 +20,8 @@
 from launch.actions import DeclareLaunchArgument, GroupAction
 from launch.actions import SetEnvironmentVariable
 from launch.conditions import IfCondition
+from launch.substitutions import EqualsSubstitution
+from launch.substitutions import NotEqualsSubstitution
 from launch.substitutions import LaunchConfiguration, PythonExpression
 from launch_ros.actions import LoadComposableNodes, SetParameter
 from launch_ros.actions import Node
diff --git a/nav2_bringup/params/nav2_params.yaml b/nav2_bringup/params/nav2_params.yaml
index cee35319b97..38ad8a262c7 100644
--- a/nav2_bringup/params/nav2_params.yaml
+++ b/nav2_bringup/params/nav2_params.yaml
@@ -318,7 +318,7 @@ waypoint_follower:
 
 route_server:
   ros__parameters:
-    graph_filepath: "/home/carma/ros2_ws_route_humble/src/navigation2/nav2_route/graphs/turtlebot3_world_graph.geojson"
+    graph_filepath: "/home/steve/Documents/nav2_ws/src/navigation2/nav2_route/graphs/aws_graph.geojson"
     boundary_radius_to_achieve_node: 1.0
     radius_to_achieve_node: 2.0
     operations: ["AdjustSpeedLimit", "ReroutingService", "CollisionMonitor"]
diff --git a/nav2_route/graphs/turtlebot3_world_graph.geojson b/nav2_route/graphs/turtlebot3_world_graph.geojson
index ee05129e43d..c02ce85510f 100644
--- a/nav2_route/graphs/turtlebot3_world_graph.geojson
+++ b/nav2_route/graphs/turtlebot3_world_graph.geojson
@@ -3,90 +3,90 @@
     "name": "graph",
     "crs": { "type": "name", "properties": { "name": "urn:ogc:def:crs:EPSG::3857" } },
     "features": [
-    { "type": "Feature", "properties": { "id": 1 }, "geometry": { "type": "Point", "coordinates": [ -0.6, -1.5946 ] } },
-    { "type": "Feature", "properties": { "id": 2 }, "geometry": { "type": "Point", "coordinates": [ 0.6, -1.5946 ] } },
-    { "type": "Feature", "properties": { "id": 3 }, "geometry": { "type": "Point", "coordinates": [ 0.0, -1.9946 ] } },
-    { "type": "Feature", "properties": { "id": 4 }, "geometry": { "type": "Point", "coordinates": [ -1.6, -1.5946 ] } },
-    { "type": "Feature", "properties": { "id": 5 }, "geometry": { "type": "Point", "coordinates": [ -0.6, -0.5946 ] } },
-    { "type": "Feature", "properties": { "id": 6 }, "geometry": { "type": "Point", "coordinates": [ 0.6, -0.5946 ] } },
-    { "type": "Feature", "properties": { "id": 7 }, "geometry": { "type": "Point", "coordinates": [ -1.6, -0.5946 ] } },
-    { "type": "Feature", "properties": { "id": 8 }, "geometry": { "type": "Point", "coordinates": [ -1.6, 0.6054 ] } },
-    { "type": "Feature", "properties": { "id": 9 }, "geometry": { "type": "Point", "coordinates": [ -0.6, 0.6054 ] } },
-    { "type": "Feature", "properties": { "id": 10 }, "geometry": { "type": "Point", "coordinates": [ 0.6, 0.6054 ] } },
-    { "type": "Feature", "properties": { "id": 11 }, "geometry": { "type": "Point", "coordinates": [ 1.6, 0.6054 ] } },
-    { "type": "Feature", "properties": { "id": 12 }, "geometry": { "type": "Point", "coordinates": [ 1.6, -0.5946 ] } },
-    { "type": "Feature", "properties": { "id": 13 }, "geometry": { "type": "Point", "coordinates": [ 2.0, -0.0054 ] } },
-    { "type": "Feature", "properties": { "id": 14 }, "geometry": { "type": "Point", "coordinates": [ 1.6, -1.5946 ] } },
-    { "type": "Feature", "properties": { "id": 15 }, "geometry": { "type": "Point", "coordinates": [ -1.6, 1.6054 ] } },
-    { "type": "Feature", "properties": { "id": 16 }, "geometry": { "type": "Point", "coordinates": [ -0.6, 1.6054 ] } },
-    { "type": "Feature", "properties": { "id": 17 }, "geometry": { "type": "Point", "coordinates": [ 0.6, 1.6054 ] } },
-    { "type": "Feature", "properties": { "id": 18 }, "geometry": { "type": "Point", "coordinates": [ 1.6, 1.6054 ] } },
-    { "type": "Feature", "properties": { "id": 19 }, "geometry": { "type": "Point", "coordinates": [ -2.0, -0.0054 ] } },
-    { "type": "Feature", "properties": { "id": 20 }, "geometry": { "type": "Point", "coordinates": [ 0.0, 2.0054 ] } },
-    { "type": "Feature", "properties": { "id": 21, "startid": 4, "endid": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -1.5946 ], [ -1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 22, "startid": 7, "endid": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.5946 ], [ -1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 23, "startid": 8, "endid": 15 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.6054 ], [ -1.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 24, "startid": 16, "endid": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.6054 ], [ -0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 25, "startid": 9, "endid": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.6054 ], [ -0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 26, "startid": 5, "endid": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.5946 ], [ -0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 27, "startid": 2, "endid": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.5946 ], [ 0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 28, "startid": 6, "endid": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.5946 ], [ 0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 29, "startid": 10, "endid": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.6054 ], [ 0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 30, "startid": 17, "endid": 18 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.6054 ], [ 1.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 31, "startid": 18, "endid": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 1.6054 ], [ 1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 32, "startid": 11, "endid": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.6054 ], [ 1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 33, "startid": 12, "endid": 14 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.5946 ], [ 1.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 34, "startid": 14, "endid": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -1.5946 ], [ 0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 35, "startid": 1, "endid": 4 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.5946 ], [ -1.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 36, "startid": 4, "endid": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -1.5946 ], [ -0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 37, "startid": 16, "endid": 15 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.6054 ], [ -1.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 38, "startid": 15, "endid": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 1.6054 ], [ -0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 39, "startid": 17, "endid": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.6054 ], [ 0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 40, "startid": 10, "endid": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.6054 ], [ 0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 41, "startid": 6, "endid": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.5946 ], [ 0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 42, "startid": 2, "endid": 14 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.5946 ], [ 1.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 43, "startid": 14, "endid": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -1.5946 ], [ 1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 44, "startid": 12, "endid": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.5946 ], [ 1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 45, "startid": 11, "endid": 18 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.6054 ], [ 1.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 46, "startid": 18, "endid": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 1.6054 ], [ 0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 47, "startid": 15, "endid": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 1.6054 ], [ -1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 48, "startid": 8, "endid": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.6054 ], [ -1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 49, "startid": 7, "endid": 4 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.5946 ], [ -1.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 50, "startid": 4, "endid": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -1.5946 ], [ -0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 51, "startid": 1, "endid": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.5946 ], [ -0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 52, "startid": 5, "endid": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.5946 ], [ -0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 53, "startid": 9, "endid": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.6054 ], [ -0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 54, "startid": 16, "endid": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.6054 ], [ 0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 55, "startid": 17, "endid": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.6054 ], [ -0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 56, "startid": 9, "endid": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.6054 ], [ 0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 57, "startid": 10, "endid": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.6054 ], [ -0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 58, "startid": 6, "endid": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.5946 ], [ -0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 59, "startid": 5, "endid": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.5946 ], [ 0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 60, "startid": 1, "endid": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.5946 ], [ 0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 61, "startid": 2, "endid": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.5946 ], [ -0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 62, "startid": 5, "endid": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.5946 ], [ -1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 63, "startid": 7, "endid": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.5946 ], [ -0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 64, "startid": 9, "endid": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.6054 ], [ -1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 65, "startid": 8, "endid": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.6054 ], [ -0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 66, "startid": 10, "endid": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.6054 ], [ 1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 67, "startid": 11, "endid": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.6054 ], [ 0.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 68, "startid": 12, "endid": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.5946 ], [ 0.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 69, "startid": 6, "endid": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.5946 ], [ 1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 70, "startid": 3, "endid": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, -1.9946 ], [ 0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 71, "startid": 3, "endid": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, -1.9946 ], [ -0.6, -1.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 72, "startid": 1, "endid": 3 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.5946 ], [ 0.0, -1.9946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 73, "startid": 2, "endid": 3 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.5946 ], [ 0.0, -1.9946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 74, "startid": 11, "endid": 13 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.6054 ], [ 2.0, -0.0054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 75, "startid": 13, "endid": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 2.0, -0.0054 ], [ 1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 76, "startid": 12, "endid": 13 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.5946 ], [ 2.0, -0.0054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 77, "startid": 13, "endid": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 2.0, -0.0054 ], [ 1.6, 0.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 78, "startid": 16, "endid": 20 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.6054 ], [ 0.0, 2.0054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 79, "startid": 20, "endid": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, 2.0054 ], [ 0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 80, "startid": 17, "endid": 20 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.6054 ], [ 0.0, 2.0054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 81, "startid": 20, "endid": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, 2.0054 ], [ -0.6, 1.6054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 82, "startid": 8, "endid": 19 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.6054 ], [ -2.0, -0.0054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 83, "startid": 19, "endid": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -2.0, -0.0054 ], [ -1.6, -0.5946 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 84, "startid": 7, "endid": 19 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.5946 ], [ -2.0, -0.0054 ] ] ] } },
-    { "type": "Feature", "properties": { "id": 85, "startid": 19, "endid": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -2.0, -0.0054 ], [ -1.6, 0.6054 ] ] ] } }
+    { "type": "Feature", "properties": { "id": 1 }, "geometry": { "type": "Point", "coordinates": [ -0.6, -1.3446 ] } },
+    { "type": "Feature", "properties": { "id": 2 }, "geometry": { "type": "Point", "coordinates": [ 0.6, -1.3446 ] } },
+    { "type": "Feature", "properties": { "id": 3 }, "geometry": { "type": "Point", "coordinates": [ 0.0, -1.7446 ] } },
+    { "type": "Feature", "properties": { "id": 4 }, "geometry": { "type": "Point", "coordinates": [ -1.6, -1.3446 ] } },
+    { "type": "Feature", "properties": { "id": 5 }, "geometry": { "type": "Point", "coordinates": [ -0.6, -0.3446 ] } },
+    { "type": "Feature", "properties": { "id": 6 }, "geometry": { "type": "Point", "coordinates": [ 0.6, -0.3446 ] } },
+    { "type": "Feature", "properties": { "id": 7 }, "geometry": { "type": "Point", "coordinates": [ -1.6, -0.3446 ] } },
+    { "type": "Feature", "properties": { "id": 8 }, "geometry": { "type": "Point", "coordinates": [ -1.6, 0.8554 ] } },
+    { "type": "Feature", "properties": { "id": 9 }, "geometry": { "type": "Point", "coordinates": [ -0.6, 0.8554 ] } },
+    { "type": "Feature", "properties": { "id": 10 }, "geometry": { "type": "Point", "coordinates": [ 0.6, 0.8554 ] } },
+    { "type": "Feature", "properties": { "id": 11 }, "geometry": { "type": "Point", "coordinates": [ 1.6, 0.8554 ] } },
+    { "type": "Feature", "properties": { "id": 12 }, "geometry": { "type": "Point", "coordinates": [ 1.6, -0.3446 ] } },
+    { "type": "Feature", "properties": { "id": 13 }, "geometry": { "type": "Point", "coordinates": [ 2.0, 0.2554 ] } },
+    { "type": "Feature", "properties": { "id": 14 }, "geometry": { "type": "Point", "coordinates": [ 1.6, -1.3446 ] } },
+    { "type": "Feature", "properties": { "id": 15 }, "geometry": { "type": "Point", "coordinates": [ -1.6, 1.8554 ] } },
+    { "type": "Feature", "properties": { "id": 16 }, "geometry": { "type": "Point", "coordinates": [ -0.6, 1.8554 ] } },
+    { "type": "Feature", "properties": { "id": 17 }, "geometry": { "type": "Point", "coordinates": [ 0.6, 1.8554 ] } },
+    { "type": "Feature", "properties": { "id": 18 }, "geometry": { "type": "Point", "coordinates": [ 1.6, 1.8554 ] } },
+    { "type": "Feature", "properties": { "id": 19 }, "geometry": { "type": "Point", "coordinates": [ -2.0, 0.2554 ] } },
+    { "type": "Feature", "properties": { "id": 20 }, "geometry": { "type": "Point", "coordinates": [ 0.0, 2.2554 ] } },
+    { "type": "Feature", "properties": { "edge_id": 21, "start_node": 4, "end_node": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -1.3446 ], [ -1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 22, "start_node": 7, "end_node": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.3446 ], [ -1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 23, "start_node": 8, "end_node": 15 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.8554 ], [ -1.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 24, "start_node": 16, "end_node": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.8554 ], [ -0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 25, "start_node": 9, "end_node": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.8554 ], [ -0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 26, "start_node": 5, "end_node": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.3446 ], [ -0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 27, "start_node": 2, "end_node": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.3446 ], [ 0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 28, "start_node": 6, "end_node": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.3446 ], [ 0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 29, "start_node": 10, "end_node": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.8554 ], [ 0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 30, "start_node": 17, "end_node": 18 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.8554 ], [ 1.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 31, "start_node": 18, "end_node": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 1.8554 ], [ 1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 32, "start_node": 11, "end_node": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.8554 ], [ 1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 33, "start_node": 12, "end_node": 14 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.3446 ], [ 1.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 34, "start_node": 14, "end_node": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -1.3446 ], [ 0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 35, "start_node": 1, "end_node": 4 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.3446 ], [ -1.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 36, "start_node": 4, "end_node": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -1.3446 ], [ -0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 37, "start_node": 16, "end_node": 15 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.8554 ], [ -1.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 38, "start_node": 15, "end_node": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 1.8554 ], [ -0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 39, "start_node": 17, "end_node": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.8554 ], [ 0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 40, "start_node": 10, "end_node": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.8554 ], [ 0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 41, "start_node": 6, "end_node": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.3446 ], [ 0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 42, "start_node": 2, "end_node": 14 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.3446 ], [ 1.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 43, "start_node": 14, "end_node": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -1.3446 ], [ 1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 44, "start_node": 12, "end_node": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.3446 ], [ 1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 45, "start_node": 11, "end_node": 18 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.8554 ], [ 1.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 46, "start_node": 18, "end_node": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 1.8554 ], [ 0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 47, "start_node": 15, "end_node": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 1.8554 ], [ -1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 48, "start_node": 8, "end_node": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.8554 ], [ -1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 49, "start_node": 7, "end_node": 4 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.3446 ], [ -1.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 50, "start_node": 4, "end_node": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -1.3446 ], [ -0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 51, "start_node": 1, "end_node": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.3446 ], [ -0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 52, "start_node": 5, "end_node": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.3446 ], [ -0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 53, "start_node": 9, "end_node": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.8554 ], [ -0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 54, "start_node": 16, "end_node": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.8554 ], [ 0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 55, "start_node": 17, "end_node": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.8554 ], [ -0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 56, "start_node": 9, "end_node": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.8554 ], [ 0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 57, "start_node": 10, "end_node": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.8554 ], [ -0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 58, "start_node": 6, "end_node": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.3446 ], [ -0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 59, "start_node": 5, "end_node": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.3446 ], [ 0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 60, "start_node": 1, "end_node": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.3446 ], [ 0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 61, "start_node": 2, "end_node": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.3446 ], [ -0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 62, "start_node": 5, "end_node": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -0.3446 ], [ -1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 63, "start_node": 7, "end_node": 5 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.3446 ], [ -0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 64, "start_node": 9, "end_node": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 0.8554 ], [ -1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 65, "start_node": 8, "end_node": 9 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.8554 ], [ -0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 66, "start_node": 10, "end_node": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 0.8554 ], [ 1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 67, "start_node": 11, "end_node": 10 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.8554 ], [ 0.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 68, "start_node": 12, "end_node": 6 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.3446 ], [ 0.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 69, "start_node": 6, "end_node": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -0.3446 ], [ 1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 70, "start_node": 3, "end_node": 2 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, -1.7446 ], [ 0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 71, "start_node": 3, "end_node": 1 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, -1.7446 ], [ -0.6, -1.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 72, "start_node": 1, "end_node": 3 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, -1.3446 ], [ 0.0, -1.7446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 73, "start_node": 2, "end_node": 3 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, -1.3446 ], [ 0.0, -1.7446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 74, "start_node": 11, "end_node": 13 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, 0.8554 ], [ 2.0, 0.2554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 75, "start_node": 13, "end_node": 12 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 2.0, 0.2554 ], [ 1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 76, "start_node": 12, "end_node": 13 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 1.6, -0.3446 ], [ 2.0, 0.2554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 77, "start_node": 13, "end_node": 11 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 2.0, 0.2554 ], [ 1.6, 0.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 78, "start_node": 16, "end_node": 20 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -0.6, 1.8554 ], [ 0.0, 2.2554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 79, "start_node": 20, "end_node": 17 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, 2.2554 ], [ 0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 80, "start_node": 17, "end_node": 20 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.6, 1.8554 ], [ 0.0, 2.2554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 81, "start_node": 20, "end_node": 16 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ 0.0, 2.2554 ], [ -0.6, 1.8554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 82, "start_node": 8, "end_node": 19 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, 0.8554 ], [ -2.0, 0.2554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 83, "start_node": 19, "end_node": 7 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -2.0, 0.2554 ], [ -1.6, -0.3446 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 84, "start_node": 7, "end_node": 19 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -1.6, -0.3446 ], [ -2.0, 0.2554 ] ] ] } },
+    { "type": "Feature", "properties": { "edge_id": 85, "start_node": 19, "end_node": 8 }, "geometry": { "type": "MultiLineString", "coordinates": [ [ [ -2.0, 0.2554 ], [ -1.6, 0.8554 ] ] ] } }
     ]
 }
diff --git a/nav2_route/plugins.xml b/nav2_route/plugins.xml
index fbb0d9941b1..92613b5846f 100644
--- a/nav2_route/plugins.xml
+++ b/nav2_route/plugins.xml
@@ -51,6 +51,7 @@
       <description>Parse the geojson graph file into the graph data type</description>
     </class>
   </library>
+
   <library path="graph_file_savers">
     <class type="nav2_route::GeoJsonGraphFileSaver" base_class_type="nav2_route::GraphFileSaver">
       <description>Save a route graph to a geojson graph file</description>