[fix] Apply multiple fixes in pose graph

Julia Sanchezrequested to merge
fix/FixG2OGraph into master
  • Fix IMU pose graph -> covariance was not rotated
  • Remove unused include in LocalOptimizer (already in CeresCostFunction)
  • Add missing this
  • Move calibration application from g2o to SLAM lib

Merge request reports