refactor TabletopOctomapServer.cpp