Open gripper after each run

scripts/hw_node.py

@@ -40,11 +40,10 @@ class HwNode:
         return SeedResponse()
 
     def reset(self, req):
-        self.gripper.move(0.04)
-
         # Move to the initial configuration
         self.switch_to_joint_trajectory_controller()
         self.moveit.goto(self.scene_config["q0"])
+        self.gripper.move(0.04)
 
         # Construct bounding box
         bbox_min = self.T_base_roi.apply(self.scene_config["target"]["min"])

src/active_grasp/controller.py

@@ -87,6 +87,7 @@ class GraspController:
                 res = self.execute_grasp(grasp)
         else:
             res = "aborted"
+        self.gripper.move(0.04)
         return self.collect_info(res)
 
     def reset(self):