diff --git a/src/modelec_strat/src/pathfinding.cpp b/src/modelec_strat/src/pathfinding.cpp
index 9179dd1..90842a6 100644
--- a/src/modelec_strat/src/pathfinding.cpp
+++ b/src/modelec_strat/src/pathfinding.cpp
@@ -540,6 +540,11 @@ namespace Modelec
             waypoints.back().is_end = true;
         }
 
+        for (auto & wp : waypoints)
+        {
+            wp.x += 1;
+        }
+
         return {FREE, waypoints};
     }