target_pose = PoseStamped() target_pose.header.frame_id = reference_frame target_pose.header.stamp = rospy.Time.now() target_pose.pose.position.x = 0.212510618427 target_pose.pose.position.y = -0.362638154236 target_pose.pose.position.z = 1.67720236082 target_pose.pose.orientation.x = 0.50406464...
right_arm.shift_pose_target(1, 0.2, r_end_effector_link) right_arm.go() rospy.loginfo("shift right end effector link---2"); rospy.sleep(1) left_arm.shift_pose_target(1, -0.05, l_end_effector_link) left_arm.go() rospy.loginfo("shift left end effector link---1"); rospy.sleep...