diff --git a/components/NavigationComponent.cs b/components/NavigationComponent.cs
index f029a1a..add6a67 100644
--- a/components/NavigationComponent.cs
+++ b/components/NavigationComponent.cs
@@ -160,6 +160,7 @@ public class NavigationComponent : Spatial
         
         // Perform smoothing
         _planningPathSmoothedWorldNavigationPoints = SmoothPath(body, _planningPathWorldNavigationPoints);
+        _planningPathSmoothedWorldNavigationPoints[0] = new NavigationPoint(fromPositionWorld);
     }
 
     public void FindPath(KinematicBody body, Vector3 fromPositionWorld, NavigationPoint navigationPoint)