turtle_tf2_message_broadcaster.py
Go to the documentation of this file.
00001 #!/usr/bin/env python
00002 # Software License Agreement (BSD License)
00003 #
00004 # Copyright (c) 2008, Willow Garage, Inc.
00005 # All rights reserved.
00006 #
00007 # Redistribution and use in source and binary forms, with or without
00008 # modification, are permitted provided that the following conditions
00009 # are met:
00010 #
00011 #  * Redistributions of source code must retain the above copyright
00012 #    notice, this list of conditions and the following disclaimer.
00013 #  * Redistributions in binary form must reproduce the above
00014 #    copyright notice, this list of conditions and the following
00015 #    disclaimer in the documentation and/or other materials provided
00016 #    with the distribution.
00017 #  * Neither the name of the Willow Garage nor the names of its
00018 #    contributors may be used to endorse or promote products derived
00019 #    from this software without specific prior written permission.
00020 #
00021 # THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
00022 # "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
00023 # LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
00024 # FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
00025 # COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
00026 # INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
00027 # BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
00028 # LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
00029 # CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
00030 # LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
00031 # ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
00032 # POSSIBILITY OF SUCH DAMAGE.
00033 #!/usr/bin/env python
00034 
00035 import roslib
00036 roslib.load_manifest('turtle_tf2')
00037 import rospy
00038 
00039 import turtlesim.msg
00040 import geometry_msgs.msg
00041 import turtlesim.srv
00042 from geometry_msgs.msg import PointStamped, Point
00043 from std_msgs.msg import Header
00044 
00045 
00046 class PointPublisher:
00047     def handle_turtle_pose(self, msg, turtlename):
00048         self.pub.publish(PointStamped(Header(0, rospy.rostime.get_rostime(), "/world"), Point(msg.x, msg.y, 0)))
00049 
00050     def __init__(self):
00051         self.turtlename = "turtle3"  # rospy.get_param('~turtle')
00052         self.sub = rospy.Subscriber('/%s/pose' % self.turtlename,
00053                                     turtlesim.msg.Pose,
00054                                     self.handle_turtle_pose,
00055                                     self.turtlename)
00056         self.pub = rospy.Publisher('turtle_point_stamped', PointStamped, queue_size=1)
00057 
00058 if __name__ == '__main__':
00059     rospy.init_node('tf2_turtle_stamped_msg_publisher')
00060     rospy.wait_for_service('spawn')
00061     spawner = rospy.ServiceProxy('spawn', turtlesim.srv.Spawn)
00062     spawner(4, 2, 0, 'turtle3')
00063 
00064     pp = PointPublisher()
00065 
00066     pub = rospy.Publisher("turtle3/cmd_vel", geometry_msgs.msg.Twist, queue_size=1)
00067     while not rospy.is_shutdown():
00068         msg = geometry_msgs.msg.Twist()
00069         msg.linear.x = 1
00070         msg.angular.z = 1
00071         pub.publish(msg)
00072         rospy.sleep(rospy.Duration(0.1))


turtle_tf2
Author(s): Denis Štogl
autogenerated on Thu Jun 6 2019 17:37:27