refactoring DistanceHandler and adding testcylinder to rviz