Clone of G2O (https://github.com/RainerKuemmerle/g2o)