clean up TabletopOctomapServer.cpp