diff --git a/jsk_ros_patch/image_view2/image_view2.cpp b/jsk_ros_patch/image_view2/image_view2.cpp index b8bc995df..3d7ee7983 100644 --- a/jsk_ros_patch/image_view2/image_view2.cpp +++ b/jsk_ros_patch/image_view2/image_view2.cpp @@ -1154,6 +1154,11 @@ namespace image_view2{ if (msg->encoding.find("bayer") != std::string::npos) { original_image_ = cv::Mat(msg->height, msg->width, CV_8UC1, const_cast(&msg->data[0]), msg->step); + } else if (msg->encoding == sensor_msgs::image_encodings::TYPE_16UC1) { + cv::Mat input_image = cv_bridge::toCvCopy(msg)->image; + double min, max; + cv::minMaxIdx(input_image, &min, &max); + cv::convertScaleAbs(input_image, original_image_, 255 / max); } else { try { original_image_ = cv_bridge::toCvCopy(msg, sensor_msgs::image_encodings::BGR8)->image;