diff --git a/src/BasicPathFinding.cs b/src/BasicPathFinding.cs
index 72ff8ac..bf35ea9 100644
--- a/src/BasicPathFinding.cs
+++ b/src/BasicPathFinding.cs
@@ -122,10 +122,11 @@ namespace OpenSim.Modules.PathFinding
 
         #region Script Funktions
 
-        private void createPathFindingScene(UUID script, UUID requestID, bool terrain)
+        private void createPathFindingScene(UUID script, UUID requestID, bool terrain, Vector3 start, Vector3 target)
         {
             PathFinder _worker = new PathFinder(requestID, m_scene);
             _worker.preparePathFindingScene(terrain);
+            _worker.setPositions(new Vector2(start.X, start.Y), new Vector2(target.X, target.Y));
 
             m_scriptModule.DispatchReply(script, 0, "", requestID.ToString());
         }
@@ -140,7 +141,7 @@ namespace OpenSim.Modules.PathFinding
                 useTerrain = true;
 
             SceneObjectGroup _host = m_scene.GetSceneObjectGroup(hostID);
-            (new Thread(delegate () { createPathFindingScene(scriptID, requestKey, useTerrain); })).Start();
+            (new Thread(delegate () { createPathFindingScene(scriptID, requestKey, useTerrain, start, target); })).Start();
 
             return requestKey.ToString();
         }
diff --git a/src/PathFinder.cs b/src/PathFinder.cs
index 7fd59d8..9768b4e 100644
--- a/src/PathFinder.cs
+++ b/src/PathFinder.cs
@@ -29,6 +29,12 @@ namespace OpenSim.Modules.PathFinding
         public void preparePathFindingScene(bool terrain)
         {
             convertRegionToBitmap(terrain);
+        }
+
+        public void setPositions(Vector2 start, Vector2 target)
+        {
+            m_bitmap.SetPixel((int)start.X, (int)start.Y, Color.Green);
+            m_bitmap.SetPixel((int)target.X, (int)target.Y, Color.Red);
             saveDebugImageToDisc();
         }