fix dijkstra hypot check bug (#522)

Author: mbosetti

PathPlanning/VoronoiRoadMap/dijkstra_search.py

@@ -136,5 +136,5 @@ def is_same_node_with_xy(node_x, node_y, node_b):
     @staticmethod
     def is_same_node(node_a, node_b):
         dist = np.hypot(node_a.x - node_b.x,
-                        node_b.y - node_b.y)
+                        node_a.y - node_b.y)
         return dist <= 0.1