new stuff, g2o solver