Fully tested the visualizer with rosbag data