Change drawing order: 1 wolf tracks, 2 preprocessor tracks, 3 projected landmarks

src/publisher_vision.cpp

@@ -180,17 +180,20 @@ void PublisherVisionDebug::publishDerived()
 
         // Draw all tracks
         showTracks(cv_img_debug, track_matrix, cap_img);
-        showLandmarks(cv_img_debug, track_matrix, cap_img);
 
+        // Draw preprocessor tracks
         if (tracks_preprocess_.show_ && tracks_preprocess_.show_on_diff_topic_)
         {
-          showTracksPreprocess(cv_img_debug_preprocess, cap_img_origin, cap_img);
+            showTracksPreprocess(cv_img_debug_preprocess, cap_img_origin, cap_img);
         }
         else if (tracks_preprocess_.show_ && !(tracks_preprocess_.show_on_diff_topic_))
         {
-          showTracksPreprocess(cv_img_debug, cap_img_origin, cap_img);
+            showTracksPreprocess(cv_img_debug, cap_img_origin, cap_img);
         }
 
+        // Draw all landmarks
+        showLandmarks(cv_img_debug, track_matrix, cap_img);
+
 
         // Convert to image msg
         cv_bridge::CvImagePtr cv_msg = boost::make_shared<cv_bridge::CvImage>();