References octomap::ScanGraph::begin(), octomap::ScanGraph::end(), octomath::Pose6D::inv(), octomap::ScanGraph::readBinary(), and octomap::ScanGraph::writeBinary().