hofee/nbv_sim
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Log motion plan failures

Browse Source
This commit is contained in:
Michel Breyer 2021-11-09 23:00:59 +01:00
parent 4d5bb8c52c
commit 533e6db06d
1 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/active_grasp/controller.py
View File

@ -152,6 +152,8 @@ class GraspController:
rospy.sleep(1.0) # Wait to see whether the object slides out of the hand rospy.sleep(1.0) # Wait to see whether the object slides out of the hand
success = self.gripper.read() > 0.002 success = self.gripper.read() > 0.002
return "succeeded" if success else "failed" return "succeeded" if success else "failed"
else:
return "no_motion_plan_found"
def create_collision_scene(self): def create_collision_scene(self):
# Segment support surface # Segment support surface