示例#1
0
		the data published on the given topic.
		To test this run 'roscore' in a terminal, and in a second run 'rosbag play example.bag'.
		Then execute 'python example.py' in a third terminal to run this node.
	"""
    """
		Initialize the ros node and the transformStamped listener. Provide the column ID's where pos and att shall be stored.
	"""
    td3 = TimedData(8)
    rospy.init_node('example', anonymous=True)
    rate = rospy.Rate(100)
    tsl = TransformStampedListener(td3, "/rovio/transform", 1, 4)
    """
		Initialize the plotter as a live plot. Limit the maximal number of displayed points to 300.
	"""
    livePlotter = Plotter(1, [4, 2], 300)
    livePlotter.addDataToSubplot(td3, 1, 1, 'r', 'rx')
    livePlotter.addDataToSubplot(td3, 2, 3, 'g', 'ry')
    livePlotter.addDataToSubplot(td3, 3, 5, 'b', 'rz')
    livePlotter.addDataToSubplot(td3, 4, 2, 'r', 'qw')
    livePlotter.addDataToSubplot(td3, 5, 4, 'g', 'qx')
    livePlotter.addDataToSubplot(td3, 6, 6, 'b', 'qy')
    livePlotter.addDataToSubplot(td3, 7, 8, 'y', 'qz')
    """
		Run the node and refresh the live Plotter.
	"""
    while not rospy.is_shutdown():
        livePlotter.refresh()
        rate.sleep()

raw_input("Press Enter to continue...")