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_travelling_position() return arm_goal
def arm_to_fallback_pose_goal_cb(userdata, old_goal): print "Setting arm pose in a non dangerous pose" arm_goal = get_arm_goal_for_arm_travelling_position() global OUTPUT OUTPUT = ARM_TO_FALLBACK_POSE_FAILED return arm_goal
def arm_goal_cb(userdata, old_goal): arm_goal = get_arm_goal_for_arm_travelling_position() return arm_goal
def arm_goal_cb(userdata, old_goal): print "Setting arm pose in a non dangerous pose" arm_goal = get_arm_goal_for_arm_travelling_position() return arm_goal