ROS images和OpenCV images之间的转化

出处：http://www.cnblogs.com/steven-blog/

操作环境
　　OS：Ubuntu 12.04
　　ROS Version：groovy

操作步骤
1：利用catkin新建一个workspace叫ros_opencv,并进行初始化

1 $ mkdir -p ros_opencv/src
2 $ cd ros_opencv/src
3 $ catkin_init_workspace

2：进入src目录，新建一个package叫opencv_test

1 $ catkin_create_pkg opencv_test sensor_msgs opencv2 cv_bridge roscpp std_msgs image_transport

3：修改opencv_test目录下CMakeLists.txt文件，代码如下

1 cmake_minimum_required(VERSION 2.8.3)
2 project(opencv_test)
3
4 ## Find catkin macros and libraries
5
6 find_package(catkin  REQUIRED COMPONENTS cv_bridge image_transport  roscpp sensor_msgs std_msgs)
7 find_package(OpenCV REQUIRED)
8
9 ## Declare a catkin package
10 catkin_package()
11
12 ## Include directories,
13 ## Add target and link libraries
14
15 include_directories(include ${OpenCV_INCLUDE_DIRS})
16 include_directories(include ${catkin_INCLUDE_DIRS})
17
18 add_executable(opencv_test_node src/opencv_test_node.cpp)
19 target_link_libraries(opencv_test_node ${catkin_LIBRARIES} ${OpenCV_LIBRARIES})
20 add_dependencies(opencv_test_node opencv_test_gencpp)

4:在src下添加源代码

1 #include <ros/ros.h>
2 #include <stdio.h>
3 #include <image_transport/image_transport.h>
4 #include <cv_bridge/cv_bridge.h>
5 #include <sensor_msgs/image_encodings.h>
6 #include <opencv2/imgproc/imgproc.hpp>
7 #include <opencv2/highgui/highgui.hpp>
8
9 static const char WINDOW[] = "Image window";
10 static void help()
11 {
12     printf("\nThis program demonstrates converting OpenCV Image to ROS Image messages  \n"
13         );
14
15 }
16
17 int main(int argc, char** argv)
18 {
19   help();
20   ros::init(argc, argv, "image_converter");
21
22   //Reading an image from the file
23   cv::Mat cv_image = cv::imread(image directory);
24   if(cv_image.empty() )
25     {
26         ROS_ERROR("Read the picture failed!");
27         return -1;
28     }
29
30   //Convert OpenCV image to ROS message
31   ros::NodeHandle node;
32   image_transport::ImageTransport transport(node);
33   image_transport::Publisher image_pub;
34   image_pub=transport.advertise("OutImage", 1);
35   ros::Time time=ros::Time::now();
36
37   cv_bridge::CvImage cvi;
38   cvi.header.stamp = time;
39   cvi.header.frame_id = "image";
40   cvi.encoding = "bgr8";
41   cvi.image = cv_image;
42
43   sensor_msgs::Image im;
44   cvi.toImageMsg(im);
45   image_pub.publish(im);
46   ROS_INFO("Converted Successfully!");
47
48   //Show the image
49   cv::namedWindow(WINDOW);
50   cv::imshow(WINDOW,cv_image);
51   cv::waitKey(0);
52
53   ros::spin();
54   return 0;
55 }

5：在ros_opencv目录下进行 catkin_make

1 $ catkin_make

6：运行

1 $ roscore
2 #open a new terminal
3 $ source devel/setup.bash
4 $ rosrun opencv_test opencv_test_node

注意的地方

因为最新推出的ros版本中默认使用的是catkin（一种类似与cmake的工程构建工具，不过仍然兼容原来的构建方式rosbuild），因此在参考相关的学习资料时要特别注意两者的区别，比如说像指令和CMakeLists.txt中的代码等;
运行时，在输入rosrun之前，要先 source devel/setup.bash，不然会出现无法找到package之类的错误;

参考资料

《Converting between ROS images and OpenCV images (C++)》
《ROS tutorial》

《How to make ROS and Opencv
work together》