Simultaneous calibration, localization, and mapping
G2o: A general framework for graph optimization