if a robot is marked as not a part of a grid, skip it

guided_mrmp/conflict_resolvers/subproblems/subproblem_og.py

@@ -137,6 +137,8 @@ class Subproblem:
         # any robot whose current and next node are in the subproblem are considered 
         # involved in the subproblem
         for r in self.all_robots:
+            if r.outside_grid:
+                continue
             pos_curr = r.current_position 
             pos_next = r.goal
             x = pos_curr[0]