00001 #! /usr/bin/env python 00002 # 00003 # Copyright (c) 2010, Willow Garage, Inc. 00004 # All rights reserved. 00005 # 00006 # Redistribution and use in source and binary forms, with or without 00007 # modification, are permitted provided that the following conditions are met: 00008 # 00009 # * Redistributions of source code must retain the above copyright 00010 # notice, this list of conditions and the following disclaimer. 00011 # * Redistributions in binary form must reproduce the above copyright 00012 # notice, this list of conditions and the following disclaimer in the 00013 # documentation and/or other materials provided with the distribution. 00014 # * Neither the name of the Willow Garage, Inc. nor the names of its 00015 # contributors may be used to endorse or promote products derived from 00016 # this software without specific prior written permission. 00017 # 00018 # THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 00019 # AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00020 # IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00021 # ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 00022 # LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 00023 # CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 00024 # SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 00025 # INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 00026 # CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 00027 # ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00028 # POSSIBILITY OF SUCH DAMAGE. 00029 00030 ##\author Kevin Watts 00031 ##\brief Raises torso for PR2 burn in test 00032 00033 HEIGHT = 0.30 # in meters 00034 00035 PKG = 'life_test' 00036 import roslib; roslib.load_manifest(PKG) 00037 import rospy 00038 import actionlib 00039 import random 00040 import copy 00041 00042 from pr2_controllers_msgs.msg import SingleJointPositionAction, SingleJointPositionGoal 00043 00044 00045 00046 if __name__ == '__main__': 00047 rospy.init_node('torso_lifter_client') 00048 client = actionlib.SimpleActionClient('torso_controller/position_joint_action', 00049 SingleJointPositionAction) 00050 rospy.loginfo('Waiting for torso action client') 00051 client.wait_for_server() 00052 00053 goal = SingleJointPositionGoal() 00054 goal.position = 0.25 00055 00056 client.send_goal(goal) 00057 00058 # Wait for result, or wait 10 seconds to allow full travel 00059 client.wait_for_result(rospy.Duration.from_sec(10)) 00060 00061 rospy.spin() 00062 00063