CopterExpress/clover
1
0
Fork 0
mirror of https://github.com/CopterExpress/clover.git synced 2026-06-03 08:29:32 +00:00
Code Issues Packages Projects Releases Wiki Activity

aruco_map: fix drawing map image

Browse Source
This commit is contained in:
Oleg Kalachev
2019-03-02 23:40:10 +03:00
parent a9e1015bad
commit 2b82516a97
3 changed files with 12 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

13
aruco_pose/src/aruco_map.cpp
View File

@@ -399,12 +399,19 @@ publish_debug:
void publishMapImage()
{
cv::Size size(image_width_, image_height_);
cv::Mat image;
cv_bridge::CvImage msg;
drawPlanarBoard(board_, cv::Size(image_width_, image_height_), image, image_margin_, 1);
cv::cvtColor(image, image, CV_GRAY2BGR);
msg.encoding = sensor_msgs::image_encodings::BGR8;
if (!board_->ids.empty()) {
_drawPlanarBoard(board_, size, image, image_margin_, 1);
} else {
// empty map
image.create(size, CV_8UC1);
image.setTo(cv::Scalar::all(255));
}
msg.encoding = sensor_msgs::image_encodings::MONO8;
msg.image = image;
img_pub_.publish(msg.toImageMsg());
}