Skip to content

Commit

Permalink
add loginfo about object being removed from pose selector upon succes…
Browse files Browse the repository at this point in the history
…sfull picking
  • Loading branch information
oscar-lima committed Apr 8, 2024
1 parent a1f3ecf commit f628097
Showing 1 changed file with 3 additions and 0 deletions.
3 changes: 3 additions & 0 deletions src/grasplan/pick.py
Original file line number Diff line number Diff line change
Expand Up @@ -381,6 +381,9 @@ def pick_object(self, object_name_as_string, support_surface_name, grasp_type, i
# handle moveit pick result
if result == MoveItErrorCodes.SUCCESS:
# remove picked object pose from pose selector
rospy.loginfo(
'removing picked object from pose selector due to succesfull execution (as reported by moveit)'
)
self.pose_selector_delete_srv(class_id=object_to_pick.obj_class, instance_id=object_to_pick.id)
rospy.loginfo(f'Successfully picked object : {object_to_pick.get_object_class_and_id_as_string()}')
# clear possible grasps shown as mesh in rviz
Expand Down

0 comments on commit f628097

Please sign in to comment.