def place_cb(self, goal):
		"""
		:type goal: PickUpPoseGoal
		"""
		error_code = self.place_object(goal.object_pose)
		p_res = PickUpPoseResult()
		p_res.error_code = error_code
		if error_code != 1:
			self.place_as.set_aborted(p_res)
		else:
			self.place_as.set_succeeded(p_res)
Exemplo n.º 2
0
 def place_cb(self, goal):
     """
     :type goal: PickUpPoseGoal
     """
     error_code = self.place_object(goal.object_pose, goal.object_to_pick,
                                    goal.pick_scene)  #goal naming is wrong
     p_res = PickUpPoseResult()
     p_res.error_code = error_code
     if error_code != 1:
         self.place_as.set_aborted(p_res)
     else:
         self.place_as.set_succeeded(p_res)
Exemplo n.º 3
0
 def pick_cb(self, goal):
     """
     :type goal: PickUpPoseGoal
     """
     print "entered pick cb"
     error_code = self.grasp_object(goal.object_to_pick, goal.pick_scene)
     p_res = PickUpPoseResult()
     p_res.error_code = error_code
     if error_code != 1:
         self.pick_as.set_aborted(p_res)
     else:
         self.pick_as.set_succeeded(p_res)