Merge branch '1-publisher-for-visual-odometry' of...

Merge branch '1-publisher-for-visual-odometry' of https://gitlab.iri.upc.edu/mobile_robotics/wolf_projects/wolf_ros/wolf_ros_vision into 1-publisher-for-visual-odometry

src/publisher_vision.cpp

@@ -175,7 +175,7 @@ void PublisherVisionDebug::publishDerived()
         cv::cvtColor(cap_img->getImage(), cv_img_debug_preprocess, cv::COLOR_GRAY2BGR);
 
         cv::cvtColor(cap_img->getImage(), cv_img_debug, cv::COLOR_GRAY2BGR);
-        cv::cvtColor(cap_img_origin->getImage(), cv_img_debug, cv::COLOR_GRAY2BGR);
+//        cv::cvtColor(cap_img_origin->getImage(), cv_img_debug, cv::COLOR_GRAY2BGR);
 
         // Draw all tracks
         showTracks(cv_img_debug, track_matrix, cap_img);