00001 # Copyright (c) 2009, Willow Garage, Inc. 00002 # All rights reserved. 00003 # 00004 # Redistribution and use in source and binary forms, with or without 00005 # modification, are permitted provided that the following conditions are met: 00006 # 00007 # * Redistributions of source code must retain the above copyright 00008 # notice, this list of conditions and the following disclaimer. 00009 # * Redistributions in binary form must reproduce the above copyright 00010 # notice, this list of conditions and the following disclaimer in the 00011 # documentation and/or other materials provided with the distribution. 00012 # * Neither the name of the Willow Garage, Inc. nor the names of its 00013 # contributors may be used to endorse or promote products derived from 00014 # this software without specific prior written permission. 00015 # 00016 # THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 00017 # AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00018 # IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00019 # ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE 00020 # LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 00021 # CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 00022 # SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 00023 # INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 00024 # CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 00025 # ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00026 # POSSIBILITY OF SUCH DAMAGE. 00027 00028 # Author: Alexander Sorokin. 00029 # Based on C++ goal_id_generator.h/cpp 00030 00031 import rospy 00032 00033 import actionlib 00034 import actionlib_msgs.msg 00035 from actionlib import goal_id_generator 00036 00037 00038 class StatusTracker: 00039 """ 00040 * @class StatusTracker 00041 * @brief A class for storing the status of each goal the action server 00042 * is currently working on 00043 """ 00044 00045 def __init__(self, goal_id=None, status=None, goal=None): 00046 """ 00047 @brief create status tracker. Either pass goal_id and status OR goal 00048 """ 00049 self.goal = None ; 00050 self.handle_tracker = None; 00051 self.status = actionlib_msgs.msg.GoalStatus(); 00052 00053 self.handle_destruction_time = rospy.Time(); 00054 00055 self.id_generator = goal_id_generator.GoalIDGenerator(); 00056 00057 if goal_id: 00058 #set the goal id and status appropriately 00059 self.status.goal_id = goal_id; 00060 self.status.status = status; 00061 else: 00062 self.goal = goal 00063 self.status.goal_id = goal.goal_id; 00064 00065 #initialize the status of the goal to pending 00066 self.status.status = actionlib_msgs.msg.GoalStatus.PENDING; 00067 00068 #if the goal id is zero, then we need to make up an id for the goal 00069 if self.status.goal_id.id == "": 00070 self.status.goal_id = self.id_generator.generate_ID(); 00071 00072 #if the timestamp of the goal is zero, then we'll set it to now() 00073 if self.status.goal_id.stamp == rospy.Time(): 00074 self.status.goal_id.stamp = rospy.Time.now();