added color octomap saving
Merge branch 'octomap' of https://github.com/ccny-ros-pkg/ccny_rgbd_tools
cleaned up octomap and pcd saving, renamed services