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
