cotesys_ros_grasping: test_move_arm_to

Go to the documentation of this file.
00001 #! /usr/bin/env python
00002 
00003 import roslib; roslib.load_manifest('cotesys_ros_grasping')
00004 import rospy
00005 
00006 import actionlib
00007 from cotesys_ros_grasping.msg import MoveArmToPositionGoal, MoveArmToPositionAction
00008 
00009 if __name__ == '__main__':
00010 
00011       rospy.init_node('test_move_arm_to_position')
00012       
00013       move_to_pos_client = actionlib.SimpleActionClient('move_arm_to_position', MoveArmToPositionAction)
00014       move_to_pos_client.wait_for_server()
00015       
00016       goal = MoveArmToPositionGoal()
00017       goal.arm_name = "right_arm"
00018       goal.point.x = .7
00019       goal.point.y = -.4
00020       goal.point.z = .8
00021 
00022       move_to_pos_client.send_goal(goal)
00023       print 'sent goal'
00024       move_to_pos_client.wait_for_result()