00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
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
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)