Merge branch 'master' of ssh://github.com/soraxas/sbp-env

sbp_env/planners/birrtPlanner.py

@@ -80,7 +80,7 @@ def run_once(self):
                     other_poses = self.poses
                     other_nodes = self.nodes
                 distances = np.linalg.norm(
-                    other_poses[: len(self.nodes)] - newpos, axis=1
+                    other_poses[: len(other_nodes)] - newpos, axis=1
                 )
                 if min(distances) < self.args.epsilon:
                     idx = np.argmin(distances)