def __init__(self, name='JoyPose6D', publish_pose=True): RVizViewController.__init__(self, name) self.pre_pose = PoseStamped() self.pre_pose.pose.orientation.w = 1 self.publish_pose = publish_pose if self.publish_pose: self.pose_pub = rospy.Publisher('pose', PoseStamped) self.support_follow_view = True self.frame_id = rospy.get_param('~frame_id', '/map')
def __init__(self, name, args): RVizViewController.__init__(self, name, args) self.pre_pose = PoseStamped() self.pre_pose.pose.orientation.w = 1 self.publish_pose = self.getArg('publish_pose', True) self.frame_id = self.getArg('frame_id', '/map') if self.publish_pose: self.pose_pub = rospy.Publisher(self.getArg('pose', 'pose'), PoseStamped) self.supportFollowView(True) self.puse_sub = rospy.Subscriber('set_pose', PoseStamped, self.setPoseCB) self.frame_id = rospy.get_param('~frame_id', '/map') self.tf_listener = tf.TransformListener()
def __init__(self, name, args): RVizViewController.__init__(self, name, args) self.pre_pose = PoseStamped() self.pre_pose.pose.orientation.w = 1 self.prev_time = rospy.Time.from_sec(time.time()) self.publish_pose = self.getArg('publish_pose', True) self.frame_id = self.getArg('frame_id', '/map') if self.publish_pose: self.pose_pub = rospy.Publisher(self.getArg('pose', 'pose'), PoseStamped) self.supportFollowView(True) self.puse_sub = rospy.Subscriber(self.getArg('set_pose', 'set_pose'), PoseStamped, self.setPoseCB) self.frame_id = rospy.get_param('~frame_id', '/map') self.tf_listener = tf.TransformListener()