adding g2o stuff