diff --git a/Sampling_based_Planning/rrt_2D/rrt_connect.py b/Sampling_based_Planning/rrt_2D/rrt_connect.py index ffeaee7..0eb8720 100644 --- a/Sampling_based_Planning/rrt_2D/rrt_connect.py +++ b/Sampling_based_Planning/rrt_2D/rrt_connect.py @@ -54,7 +54,7 @@ class RrtConnect: node_near_prim = self.nearest_neighbor(self.V2, node_new) node_new_prim = self.new_state(node_near_prim, node_new) - if node_new_prim and not self.utils.is_collision(node_new_prim, node_new_prim): + if node_new_prim and not self.utils.is_collision(node_new_prim, node_near_prim): self.V2.append(node_new_prim) while True: