loop_fusion 0.0.0 loop_fusion package tony-ws TODO catkin camera_models camera_models