modify end node's state (AtsushiSakai#656)

Author: XwLu

PathPlanning/DStar/dstar.py

@@ -160,7 +160,7 @@ def run(self, start, end):
         rx = []
         ry = []
 
-        self.open_list.add(end)
+        self.insert(end, 0.0)
 
         while True:
             self.process_state()