ROS下订阅topic，显示并保存Kinect(Xtion pro live )深度摄像机的RGB图像

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
#include <ros/ros.h>
#include <image_transport/image_transport.h>
#include <opencv2/highgui/highgui.hpp>
#include <cv_bridge/cv_bridge.h>
#include <iostream>

using std::cout;
using std::endl;
using std::stringstream;
using std::string;

unsigned int fileNum = 1;
bool saveCloud(false);

void imageCallback(const sensor_msgs::ImageConstPtr& msg)
{
  cv::imshow("Show RgbImage", cv_bridge::toCvShare(msg,"rgb8")->image);
  char key;
  key=cvWaitKey(33);
  if(key==32)           //the Ascii of "Space key" is 32 
  saveCloud = true;
  if(saveCloud)
  {
    stringstream stream;
    stringstream stream1;
    stream <<"Goal RgbImage" << fileNum<<".jpg";
    stream1 <<"/home/lijunliang/qt_catkin_ws/src/GetRgbImage/" << fileNum <<".jpg";
    string filename = stream.str();
    string filename1 = stream1.str();
    cv::imwrite(filename1,cv_bridge::toCvShare(msg)->image);
    saveCloud = false;
    fileNum++;
    cout << filename << " had Saved."<< endl;
  }
}

int main(int argc, char **argv)
{
  ros::init(argc, argv, "Image_listener");
  ros::NodeHandle nh;
  cv::namedWindow("Show RgbImage");
  cv::startWindowThread();
  image_transport::ImageTransport it(nh);
  image_transport::Subscriber sub = it.subscribe("/camera/rgb/image_raw", 1, imageCallback);
  ros::spin();
  cv::destroyWindow("Show RgbImage");
}

1
2
3
 stream1 <<"/home/lijunliang/qt_catkin_ws/src/GetRgbImage/" << fileNum <<".jpg";