目录
1、概念
2、将ROS图像转化为OpenCV图像
3、将OpenCV图像转化为ROS图像消息
4、例子
1、概念
ROS的 sensor_msgs/Image消息格式本身就是为了传递图像,但是因为因为不能直接传递给Opencv所以ROS提供了CvBridge来进行之间的转化。
本文章将教您学会如何编写节点,使用CvBridge将ROS转化为OpenCV格式,还将学会如何将Opencv图像转化为ROS格式发布。
2、将ROS图像转化为OpenCV图像
CvBridge定义了一个专门的CvImage类型,其中就包含了一个Opencv图像。CvImage包含的信息与 sensor_msgs/Image 包含的信息完全相同,CvImage类格式为:
namespace cv_bridge {
class CvImage
{
public:
std_msgs::Header header;//时间戳
std::string encoding;//图像的格式
cv::Mat image;//图像数据
};
typedef boost::shared_ptr<CvImage> CvImagePtr;
typedef boost::shared_ptr<CvImage const> CvImageConstPtr;
}
在ROS中我们有两个方式将sensor_msgs/Image转化为CvImage :
1、我们想修改数据,必须要复制消息
2、我们不想修改数据,我们可以安全的分享ROS消息数据,而不是复制
ROS提供以下转化为CvImage的函数:
// Case 1: Always copy, returning a mutable CvImage
CvImagePtr toCvCopy(const sensor_msgs::ImageConstPtr& source,
const std::string& encoding = std::string());
CvImagePtr toCvCopy(const sensor_msgs::Image& source,
const std::string& encoding = std::string());
// Case 2: Share if possible, returning a const CvImage
CvImageConstPtr toCvShare(const sensor_msgs::ImageConstPtr& source,
const std::string& encoding = std::string());
CvImageConstPtr toCvShare(const sensor_msgs::Image& source,
const boost::shared_ptr<void const>& tracked_object,
const std::string& encoding = std::string());
可以看出两种函数输入都是消息指针(订阅者的回调函数的参数),另一个参数为可选的编码参数。
1、toCvCopy返回的是ROS消息创建图像数据的副本,可以自由修改的 CvImagePtr。
2、toCvShare返回的是一个不可修改的CvImageConstPtr
图像编码的方式可以是以下几种:
- 8UC[1-4]
- 8SC[1-4]
- 16UC[1-4]
- 16SC[1-4]
- 32SC[1-4]
- 32FC[1-4]
- 64FC[1-4]
对于常用的编码方式给出几个例子:
mono8: CV_8UC1, 灰度图像
mono16: CV_16UC1, 16-bit 灰度图像
bgr8: CV_8UC3, 蓝绿红顺序彩色图像
rgb8: CV_8UC3, 红绿蓝顺序彩色图像
bgra8: CV_8UC4, alpha 通道的BGR彩色图像
rgba8: CV_8UC4, alpha 通道的RGB彩色图像
注:mono8和bgr8是OpenCV最期望最常用的图像编码
3、将OpenCV图像转化为ROS图像消息
要将CvImage转化为ROS图像消息,使用toImageMsg()成员函数:
class CvImage
{
sensor_msgs::ImagePtr toImageMsg() const;
//重载的函数
void toImageMsg(sensor_msgs::Image& ros_image) const;
};
ROS为我们提供了两个重载,我们可以使用对象直接调用。
4、例子
本实例第一个为官网例子,另一个笔者有时间加入一个使用自己摄像头的例子。
官网给出的例子是在图像转化为cv::Mat类型,并且在图像上绘制一个圆圈给OpenCV显示图像,并且还给ros重新发布图像。在你创建功能包依赖时需要加上(catkin_create_pkg)添加依赖:
sensor_msgs cv_bridge roscpp std_msgs image_transport
头文件:
#include <ros/ros.h>
#include <image_transport/image_transport.h>
#include <cv_bridge/cv_bridge.h>
#include <sensor_msgs/image_encodings.h>
#include <opencv2/imgproc/imgproc.hpp>
#include <opencv2/highgui/highgui.hpp>
image_transport允许订阅压缩图像流。imgproc和hihgui为图像处理和gui也可以直接使用#include <opencv/opencv.hpp>包含所有opencv头文件。cv_bridge为本章的主题需要包含。接下来看定义的类和主函数。
static const std::string OPENCV_WINDOW = "Image window";
class ImageConverter
{
ros::NodeHandle nh_;
image_transport::ImageTransport it_;
image_transport::Subscriber image_sub_;
image_transport::Publisher image_pub_;
public:
ImageConverter()
: it_(nh_)
{
// Subscrive to input video feed and publish output video feed
image_sub_ = it_.subscribe("/camera/image_raw", 1,
&ImageConverter::imageCb, this);//订阅到图像则调用回调函数
image_pub_ = it_.advertise("/image_converter/output_video", 1);发布话题
cv::namedWindow(OPENCV_WINDOW);//设置窗口名
}
~ImageConverter()
{
cv::destroyWindow(OPENCV_WINDOW);
}
void imageCb(const sensor_msgs::ImageConstPtr& msg)
{
cv_bridge::CvImagePtr cv_ptr;//接受到ros图像的对象
try
{
cv_ptr = cv_bridge::toCvCopy(msg, sensor_msgs::image_encodings::BGR8);
}
catch (cv_bridge::Exception& e)
{
ROS_ERROR("cv_bridge exception: %s", e.what());
return;
}
// Draw an example circle on the video stream
//cv_ptr->image就是传递一个Mat类当opencv使用就可以了
if (cv_ptr->image.rows > 60 && cv_ptr->image.cols > 60)
cv::circle(cv_ptr->image, cv::Point(50, 50), 10, CV_RGB(255,0,0));
// Update GUI Window
cv::imshow(OPENCV_WINDOW, cv_ptr->image);
cv::waitKey(3);
// Output modified video stream
image_pub_.publish(cv_ptr->toImageMsg());
}
};
int main(int argc, char** argv)
{
ros::init(argc, argv, "image_converter");
ImageConverter ic;
ros::spin();
return 0;
}
5 自己的Mat类转为ros图像
这里官方的cvImage是通过msg进行初始化的,那我一开始将就只有Mat类的图像如何操作。笔者想定义一个cvImage然后用cv_ptr->image=Mat就不可以了吗?
v_bridge::CvImagePtr ptr;
ptr.image=image.clone();
很遗憾这样是不行的,因为这个对象调用的初始构造函数。通过阅读官方源码,可以看出cvImage的构造方式:
CvImage() {}
/**
* \brief Constructor.
*/
CvImage(
const std_msgs::msg::Header & header, const std::string & encoding,
const cv::Mat & image = cv::Mat())
: header(header), encoding(encoding), image(image)
{
}
如果我们单纯之创建一个cvImage对象不正确的完成它的初始化就无法正常使用这个对象。正确的方式:文章来源:https://www.toymoban.com/news/detail-620202.html
sensor_msgs::ImagePtr msg = cv_bridge::CvImage(std_msgs::Header(), "mono8", Right_raw).toImageMsg();
ok,这样就可以正常发布我们的图像了。 文章来源地址https://www.toymoban.com/news/detail-620202.html
到了这里,关于CvBridge在ROS图像和OpenCV图像之间进行转化的文章就介绍完了。如果您还想了解更多内容,请在右上角搜索TOY模板网以前的文章或继续浏览下面的相关文章,希望大家以后多多支持TOY模板网!