Add node valid check to fix AtsushiSakai#271

Author: AtsushiSakai

PathPlanning/RRT/rrt.py

@@ -140,7 +140,7 @@ def draw_graph(self, rnd=None):
         plt.clf()
         # for stopping simulation with the esc key.
         plt.gcf().canvas.mpl_connect('key_release_event',
-                lambda event: [exit(0) if event.key == 'escape' else None])
+                                     lambda event: [exit(0) if event.key == 'escape' else None])
         if rnd is not None:
             plt.plot(rnd.x, rnd.y, "^k")
         for node in self.node_list:
@@ -175,6 +175,10 @@ def get_nearest_node_index(node_list, rnd_node):
 
     @staticmethod
     def check_collision(node, obstacleList):
+
+        if node is None:
+            return False
+
         for (ox, oy, size) in obstacleList:
             dx_list = [ox - x for x in node.path_x]
             dy_list = [oy - y for y in node.path_y]