std_marker_demo.py

Go to the documentation of this file.

#!/usr/bin/python

import rospy
from easy_markers.generator import MarkerGenerator
from visualization_msgs.msg import Marker


if __name__ == '__main__':
    rospy.init_node('some_markers')
    pub = rospy.Publisher('/visualization_marker', Marker, queue_size=1)
    gen = MarkerGenerator()
    gen.ns = '/awesome_markers'
    gen.type = Marker.SPHERE_LIST
    gen.scale = [.3] * 3
    gen.frame_id = 'map'

    while not rospy.is_shutdown():
        gen.counter = 0
        t = rospy.get_time()

        gen.color = [1, 0, 0, 1]
        m = gen.marker(points=[(0, i, (i + t) % 5.0) for i in range(10)])
        pub.publish(m)
        rospy.sleep(0.1)
        gen.color = [0, 1, 0, 1]
        m = gen.marker(points=[(0, i, (i - t) % 5.0) for i in range(10)])
        pub.publish(m)
        rospy.sleep(0.1)