Update OctomapInterface.cc