seneka_octomap_creator: include service for writing octomap to file
seneka_octomap_creator: fix bug when saving empty octomap, some debug output