Working version of visualizer with laserscanner