experimenting with a visualizer
added a cylinder isch
started to make a publish function for robot
refactoring DistanceHandler and adding testcylinder to rviz
Lots of nice refactoring
Removed lots of comments
Added a published line