fix(image_projection_based_fusion): fix bug (autowarefoundation#6411)

Signed-off-by: kminoda <[email protected]>
Interplai · Jun 3, 2024 · e26824b · e26824b
1 parent 8872d68
commit e26824b
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/perception/image_projection_based_fusion/src/fusion_node.cpp b/perception/image_projection_based_fusion/src/fusion_node.cpp
@@ -167,7 +167,6 @@ void FusionNode<Msg, Obj, Msg2D>::subCallback(const typename Msg::ConstSharedPtr
     timer_->cancel();
     postprocess(*(cached_msg_.second));
     publish(*(cached_msg_.second));
-    cached_msg_.second = nullptr;
     std::fill(is_fused_.begin(), is_fused_.end(), false);
 
     // add processing time for debug
@@ -187,6 +186,8 @@ void FusionNode<Msg, Obj, Msg2D>::subCallback(const typename Msg::ConstSharedPtr
         "debug/pipeline_latency_ms", pipeline_latency_ms);
       processing_time_ms = 0;
     }
+
+    cached_msg_.second = nullptr;
   }
 
   std::lock_guard<std::mutex> lock(mutex_cached_msgs_);