Voxblox-based Pose graph optimization - View it on GitHub