* Add tools to convert isometries to ros messages
* Refact gps callback
* Refact optimize graph command
* Output optimized trajectory
* Remove doubled g2o file
* Remove experimental params
* Add interface to calibrate GPS/Lidar
* Broadcast gps offset
* The Calibration path are not outputed anymore, g2o file can be used to visualize results