From 0d92abca1ea7075290300be9f2d0b21a1dd86fe3 Mon Sep 17 00:00:00 2001 From: Fernando Herrero Cotarelo <fherrero@iri.upc.edu> Date: Tue, 7 Jun 2016 14:47:16 +0000 Subject: [PATCH] iri_image_local_binarization: publish image with input image header/stamp --- src/image_local_binarization_alg_node.cpp | 6 +++++- 1 file changed, 5 insertions(+), 1 deletion(-) diff --git a/src/image_local_binarization_alg_node.cpp b/src/image_local_binarization_alg_node.cpp index 72607ac..25451c7 100644 --- a/src/image_local_binarization_alg_node.cpp +++ b/src/image_local_binarization_alg_node.cpp @@ -47,10 +47,14 @@ void ImageLocalBinarizationAlgNode::mainNodeThread(void) /* [subscriber callbacks] */ void ImageLocalBinarizationAlgNode::image_in_callback(const sensor_msgs::Image::ConstPtr& msg, const sensor_msgs::CameraInfoConstPtr& info) { + sensor_msgs::ImagePtr my_img; + try{ this->image_ = cv_bridge::toCvCopy(msg, "mono8"); this->alg_.localThreshold(this->image_->image, this->image_->image, this->k_,(this->window_size_ % 2 == 0 ? this->window_size_ + 1: this->window_size_)); - this->image_out_publisher_.publish(this->image_->toImageMsg(),info); + my_img = this->image_->toImageMsg(); + my_img->header.stamp = msg->header.stamp; + this->image_out_publisher_.publish(my_img,info); }catch(cv_bridge::Exception& e){ ROS_ERROR("cv_bridge exception: %s", e.what()); } -- GitLab