first draft of octomap_vis_tester. NOT TESTED