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
예제 #2
0
 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