Sparsify pose graph to speed the optimization process - View it on GitHub