def move_ideal_position_for_grasp_request_cb(userdata, request): req = FinalApproachPoseRequest() req.pose = userdata.pose_for_goal_for_final_approach global OUTPUT OUTPUT = MOVE_IDEAL_POSITION_FOR_GRASP_FAILED return req
def loc_request_cb(userdata, request): req = FinalApproachPoseRequest() req.pose = userdata.pose_for_goal_for_final_approach return req