$search
00001 #! /usr/bin/env python 00002 # Copyright (c) 2009, Willow Garage, Inc. 00003 # All rights reserved. 00004 # 00005 # Redistribution and use in source and binary forms, with or without 00006 # modification, are permitted provided that the following conditions are met: 00007 # 00008 # * Redistributions of source code must retain the above copyright 00009 # notice, this list of conditions and the following disclaimer. 00010 # * Redistributions in binary form must reproduce the above copyright 00011 # notice, this list of conditions and the following disclaimer in the 00012 # documentation and/or other materials provided with the distribution. 00013 # * Neither the name of the Willow Garage, Inc. nor the names of its 00014 # contributors may be used to endorse or promote products derived from 00015 # this software without specific prior written permission. 00016 # 00017 # THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 00018 # AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00019 # IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00020 # ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 00021 # LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 00022 # CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 00023 # SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 00024 # INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 00025 # CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 00026 # ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00027 # POSSIBILITY OF SUCH DAMAGE. 00028 PKG='actionlib' 00029 import roslib; roslib.load_manifest(PKG) 00030 00031 00032 import sys 00033 import unittest 00034 import rospy 00035 from actionlib_msgs.msg import * 00036 from actionlib import SimpleActionClient 00037 from actionlib import ActionClient 00038 from actionlib.msg import TestAction, TestGoal 00039 00040 class TestRefSimpleActionServer(unittest.TestCase): 00041 00042 def test_one(self): 00043 client = SimpleActionClient('reference_simple_action', TestAction) 00044 self.assert_(client.wait_for_server(rospy.Duration(2.0)), 00045 'Could not connect to the action server') 00046 00047 goal = TestGoal(1) 00048 client.send_goal(goal) 00049 self.assert_(client.wait_for_result(rospy.Duration(2.0)), 00050 "Goal didn't finish") 00051 self.assertEqual(GoalStatus.SUCCEEDED, client.get_state()) 00052 00053 goal = TestGoal(2) 00054 client.send_goal(goal) 00055 self.assert_(client.wait_for_result(rospy.Duration(10.0)), 00056 "Goal didn't finish") 00057 self.assertEqual(GoalStatus.ABORTED, client.get_state()) 00058 00059 goal = TestGoal(3) 00060 client.send_goal(goal) 00061 self.assert_(client.wait_for_result(rospy.Duration(10.0)), 00062 "Goal didn't finish") 00063 00064 #The simple server can't reject goals 00065 self.assertEqual(GoalStatus.ABORTED, client.get_state()) 00066 00067 00068 goal = TestGoal(9) 00069 saved_feedback={}; 00070 def on_feedback(fb): 00071 rospy.loginfo("Got feedback") 00072 saved_feedback[0]=fb 00073 00074 client.send_goal(goal,feedback_cb=on_feedback) 00075 self.assert_(client.wait_for_result(rospy.Duration(10.0)), 00076 "Goal didn't finish") 00077 self.assertEqual(GoalStatus.SUCCEEDED, client.get_state()) 00078 00079 self.assertEqual(saved_feedback[0].feedback,9) 00080 00081 00082 00083 00084 if __name__ == '__main__': 00085 import rostest 00086 rospy.init_node('test_ref_simple_action_server') 00087 rostest.rosrun('actionlib', 'test_simple_action_client_python', TestRefSimpleActionServer)