g2o/types/slam3d_addons/types_slam3d_addons.cpp