def arm_to_elbow_up_pre_grasp_goal_cb(userdata, old_goal): #arm_goal = get_arm_goal(get_pose_intermediate_position(), frame_id="/base_link") print "Preparing MoveArmGoal() to move the arm to a safe travel position" arm_goal = get_arm_goal_for_arm_elbow_back() return arm_goal
def arm_goal_cb(userdata, old_goal): print "Preparing MoveArmGoal() to move the arm to a safe travel position" arm_goal = get_arm_goal_for_arm_elbow_back() return arm_goal
def arm_goal_cb(userdata, old_goal): #arm_goal = get_arm_goal(get_pose_intermediate_position(), frame_id="/base_link") arm_goal = get_arm_goal_for_arm_elbow_back() return arm_goal