双目相机发布并显示ROS图像话题topic

最新推荐文章于 2024-08-01 16:37:42 发布
最新推荐文章于 2024-08-01 16:37:42 发布
阅读量2.2k 收藏 14
点赞数 4
分类专栏： SLAM 文章标签： ros图像消息 rosopencv VINS 图像话题 ros图像topic
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_37918890/article/details/95316748
版权

双目相机发布ROS图像消息代码

概要

提供双目相机发布ROS话题代码 by十里桃园
发布的话题为：/shilitaoyuan_left 、 /shilitaoyuan_right
发布代码提供两份：一为相机只有一个ID，二是两个独立的相机有两个相机ID。
并提供接受显示图像信息的ros代码
可被应用于VINS双目等开源软件

双ID双目相机消息发布代码

#include <ros/ros.h>
#include <image_transport/image_transport.h>
#include <opencv2/highgui/highgui.hpp>
#include <cv_bridge/cv_bridge.h>
#include <sstream>
#include <iostream>
using namespace cv;
int main(int argc, char** argv) {


    ros::init(argc, argv, "image_publisher");
    //ros::Time time_0= ros::Time::now (); 
    ros::NodeHandle nh;
    image_transport::ImageTransport it(nh);
  //  image_transport::Publisher pub = it.advertise("/leftImage", 1);
    //image_transport::Publisher pub1 = it.advertise("/rightImage", 1);
    image_transport::Publisher pub = it.advertise("shilitaoyuan_/left", 1);
    image_transport::Publisher pub1 = it.advertise("shilitaoyuan_/right", 1);
    image_transport::Publisher pub0 = it.advertise("shilitaoyuan_/full", 1);
    cv::VideoCapture cap1(0);
    cap1.set(CV_CAP_PROP_FRAME_WIDTH,640);

    cap1.set(CV_CAP_PROP_FRAME_HEIGHT,480);
    cap1.set(CV_CAP_PROP_FPS, 30);
    cv::VideoCapture cap2(1);
    cap2.set(CV_CAP_PROP_FRAME_WIDTH,640);

    cap2.set(CV_CAP_PROP_FRAME_HEIGHT,480);
    cap2.set(CV_CAP_PROP_FPS, 30);
   // cv::VideoCapture cap1(0);
    if (!cap1.isOpened()) {
    ROS_INFO("cannot open video device0\n");
    return 1;
    }
	
if (!cap2.isOpened()) {
    ROS_INFO("cannot open video device0\n");
    return 1;
    }

   // if (!cap1.isOpened()) {
   // ROS_INFO("cannot open video device1\n");
   // return 1;
  //  }

    
 
    sensor_msgs::ImagePtr msg;
    sensor_msgs::ImagePtr msg1;
    sensor_msgs::ImagePtr msg0;
    ros::Rate loop_rate(10);//hz
    cv::Mat frameR;
    cv::Mat frameL;
    //cv::Mat frame;
   // cv::Mat frameG;
    //cap >>  frame;   
    while (nh.ok()) {
	cap2 >> frameR;
	ros::Time time_R= ros::Time::now ();  
        cap1 >> frameL;
	ros::Time time_L= ros::Time::now ();  
	//cvtColor(frame,frameG, COLOR_BGR2GRAY);
	//std::cout << "frame "<<"frame.cols: "<<frame.cols <<"; frame.rows: "<<frame.rows<<std::endl;
	//frameR = frame(Rect(0,0,640,480));
   	//frameL = frame(Rect(640,0,640,480));
       // imshow("frameR",frameR);
	//imshow("frameL",frameL);
	//waitKey(1);
	//imwrite("/home/mars/dual_camera_clibration/right.bmp",frameR);
	//imwrite("/home/mars/dual_camera_clibration/left.bmp",frameL);
        std::cout << "frameR "<<"frameR.cols: "<<frameR.cols <<"; frameR.rows: "<<frameR.rows<<std::endl;
	std::cout << "frameL "<<"frameL.cols: "<<frameL.cols <<"; frameL.rows: "<<frameL.rows<<std::endl;
        if (!frameR.empty()) {  
            msg = cv_bridge::CvImage(std_msgs::Header(), "bgr8", frameR).toImageMsg();  
	    msg->header.stamp = time_R;  
            pub.publish(msg);  
        }
	if (!frameL.empty()) {  
            msg1 = cv_bridge::CvImage(std_msgs::Header(), "bgr8", frameL).toImageMsg(); 
	    msg1->header.stamp = time_L;
            pub1.publish(msg1);  
        }
	//if (!frame.empty()) {  
        //    msg0 = cv_bridge::CvImage(std_msgs::Header(), "bgr8", frame).toImageMsg(); 
	//    msg0->header.stamp = time_;
        //    pub0.publish(msg0);   
       // }
            ROS_INFO("Publishing shilitaoyuan_/right shilitaoyuan_/left shilitaoyuan_/full ROS topic MSG!! ");
        ros::spinOnce();  
        loop_rate.sleep();//与ros::Rate loop_rate相对应
    }
}

单ID双目相机消息发布代码

#include <ros/ros.h>
#include <image_transport/image_transport.h>
#include <opencv2/highgui/highgui.hpp>
#include <cv_bridge/cv_bridge.h>
#include <sstream>
#include <iostream>
using namespace cv;
int main(int argc, char** argv) {


    ros::init(argc, argv, "image_publisher");
    //ros::Time time_0= ros::Time::now (); 
    ros::NodeHandle nh;
    image_transport::ImageTransport it(nh);
  //  image_transport::Publisher pub = it.advertise("/leftImage", 1);
    //image_transport::Publisher pub1 = it.advertise("/rightImage", 1);
    image_transport::Publisher pub = it.advertise("shilitaoyuan_/left", 1);
    image_transport::Publisher pub1 = it.advertise("shilitaoyuan_/right", 1);
    image_transport::Publisher pub0 = it.advertise("shilitaoyuan_/full", 1);
    cv::VideoCapture cap(0);
    cap.set(CV_CAP_PROP_FRAME_WIDTH,1280);

    cap.set(CV_CAP_PROP_FRAME_HEIGHT,480);
    cap.set(CV_CAP_PROP_FPS, 30);
   // cv::VideoCapture cap1(0);
    if (!cap.isOpened()) {
    ROS_INFO("cannot open video device0\n");
    return 1;
    }
	

   // if (!cap1.isOpened()) {
   // ROS_INFO("cannot open video device1\n");
   // return 1;
  //  }

    
 
    sensor_msgs::ImagePtr msg;
    sensor_msgs::ImagePtr msg1;
    sensor_msgs::ImagePtr msg0;
    ros::Rate loop_rate(30);//hz
    cv::Mat frameR;
    cv::Mat frameL;
    cv::Mat frame;
    cv::Mat frameG;
    //cap >>  frame;   
    while (nh.ok()) {
	cap >> frame;
	ros::Time time_= ros::Time::now ();  
	//cvtColor(frame,frameG, COLOR_BGR2GRAY);
	std::cout << "frame "<<"frame.cols: "<<frame.cols <<"; frame.rows: "<<frame.rows<<std::endl;
	frameR = frame(Rect(0,0,640,480));
   	frameL = frame(Rect(640,0,640,480));
        //imshow("frameR",frameR);
	//imshow("frameL",frameL);
	//waitKey();
	//imwrite("/home/mars/dual_camera_clibration/right.bmp",frameR);
	//imwrite("/home/mars/dual_camera_clibration/left.bmp",frameL);
        std::cout << "frameR "<<"frameR.cols: "<<frameR.cols <<"; frameR.rows: "<<frameR.rows<<std::endl;
	std::cout << "frameL "<<"frameL.cols: "<<frameL.cols <<"; frameL.rows: "<<frameL.rows<<std::endl;
        if (!frameR.empty()) {  
            msg = cv_bridge::CvImage(std_msgs::Header(), "bgr8", frameR).toImageMsg();  
	    msg->header.stamp = time_;  
            pub.publish(msg);  
        }
	if (!frameL.empty()) {  
            msg1 = cv_bridge::CvImage(std_msgs::Header(), "bgr8", frameL).toImageMsg(); 
	    msg1->header.stamp = time_;
            pub1.publish(msg1);  
        }
	if (!frame.empty()) {  
            msg0 = cv_bridge::CvImage(std_msgs::Header(), "bgr8", frame).toImageMsg(); 
	    msg0->header.stamp = time_;
            pub0.publish(msg0);   
        }
            ROS_INFO("Publishing shilitaoyuan_/right shilitaoyuan_/left shilitaoyuan_/full ROS topic MSG!! ");
        ros::spinOnce();  
        loop_rate.sleep();//与ros::Rate loop_rate相对应
    }
}

接受ros消息并显示图像信息的ros代码

#include <ros/ros.h>
#include <image_transport/image_transport.h>
#include <opencv2/highgui/highgui.hpp>
#include <cv_bridge/cv_bridge.h>

void imageCallback(const sensor_msgs::ImageConstPtr& msg)
{
  try
  {
    cv::imshow("shilitaoyuan_right", cv_bridge::toCvShare(msg, "bgr8")->image);
     cv::waitKey(1);
  }
  catch (cv_bridge::Exception& e)
  {
    ROS_ERROR("Could not convert from '%s' to 'bgr8'.", msg->encoding.c_str());
  }
}

void imageCallback1(const sensor_msgs::ImageConstPtr& msg)
{
  try
  {
    cv::imshow("shilitaoyuan_left", cv_bridge::toCvShare(msg, "bgr8")->image);
     cv::waitKey(1);
  }
  catch (cv_bridge::Exception& e)
  {
    ROS_ERROR("Could not convert from '%s' to 'bgr8'.", msg->encoding.c_str());
  }
}

void imageCallback0(const sensor_msgs::ImageConstPtr& msg)
{
  try
  {
    cv::imshow("shilitaoyuan_full", cv_bridge::toCvShare(msg, "bgr8")->image);
     cv::waitKey(1);
  }
  catch (cv_bridge::Exception& e)
  {
    ROS_ERROR("Could not convert from '%s' to 'bgr8'.", msg->encoding.c_str());
  }
}


int main(int argc, char **argv)
{
  ros::init(argc, argv, "image_listener");
  ros::NodeHandle nh;
  cv::namedWindow("right");
  cv::namedWindow("left");
  cv::startWindowThread();
  image_transport::ImageTransport it(nh);
 // image_transport::Subscriber sub = it.subscribe("shilitaoyuan_/rightImage", 1, imageCallback);
  image_transport::Subscriber sub = it.subscribe("shilitaoyuan_/right", 1, imageCallback);
  image_transport::ImageTransport it1(nh);
  image_transport::Subscriber sub1 = it.subscribe("shilitaoyuan_/left", 1, imageCallback1);
  image_transport::ImageTransport it0(nh);
  image_transport::Subscriber sub0 = it.subscribe("shilitaoyuan_/full", 1, imageCallback0);
 // image_transport::Subscriber sub1 = it.subscribe("shilitaoyuan_/leftImage", 1, imageCallback1);
  ros::spin();
  cv::destroyWindow("shilitaoyuan_right");
  cv::destroyWindow("shilitaoyuan_left");
}
十里桃园
关注
  • 4
    点赞
  • 踩
  • 14
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
专栏目录
ORB-SLAM2算法6之D435i双目IR相机运行ROS版ORB-SLAM2并发布位姿pose的rostopic
重点记录机器人和自动驾驶相关领域的技术，尤其是计算机视觉，视觉SLAM等，不仅有前言文献或必备算法的学习，也会有实际应用的点滴经验
08-03 1713
实际ROS视觉SLAM工程落地时，一般搭配传感器实时发出位姿pose的rostopic，本篇就以D435i相机的双目IR相机作为输入，运行ROS版ORB-SLAM2，最后发出pose的rostopic。
Ubuntu ROS上同时使用两个D435i相机并发布话题
AnChenliang_1002的博客
09-19 3273
Ubuntu ROS上同时使用两个D435i相机 最近由于科研的需要，需要在Ubuntu 16.04（ROS）同时使用两个D435i相机，现在我把两个D435i相机都竭尽Ubuntu系统里（均使用USB3.0接口），但是直接在终端上运行打开相机的指令： roslaunch realsense2_camera rs_rgbd.launch 默认只会使用两个中的一个。在ROS中发布的话题也只有一个相机的话题信息，如下： 同时使用两个D435i相机并发布各自对应的话题： 第一步： 查看两个相机各自的seria
Ros视觉-Kinect V1（XBOX 360）显示图像
zbr794866300的博客
08-27 1332
本实验在Ubuntu16.04的环境下，采用两个包分别通过Kinect相机显示RGB图像和深度图像，本文主要叙述一下Ubuntu16.04的系统下使用Kinect相机的过程 1.Ros软件包的安装 两种方式均可： （1）使用openni_launch sudo apt-get install ros-kinetic-openni-camera ros-kinetic-openni-lau...
在ROS中使用opencv-查看图片
相信科技的力量
09-13 3372
参考http://www.cnblogs.com/steven-blog/archive/2013/05/12/3074518.html 吐槽一下，好多步骤，- -，打开一张图片都这么繁琐，好气啊，不过学生时代玩一玩无所谓，开心就好，熟悉一下ROS这个工具 运行效果： 1、创建工作空间 $ mkdir -p ros_opencv/src $ cd ros_opencv/src ...
ROS 2 中（单/双目）USB相机驱动安装
最新发布
知识的汲取和传授都应该是快乐的
08-01 606
通过源码安装usb相机驱动
ROS使用python发布Image topic
Lucky-ing的博客
04-15 9868
ROS下使用python发布Image消息 博主去官网看了很久，都没有python端发布Image的例子。特地来补充一下。 首先Image类型是源自于sensor_msgs.msg里面的。其类型包括以下几个成员。 （摘自于ros官网） 首先我们要先初始化header，因为Image不需要fix_frame等东西的定义，所以发布的时候只需要给一个时间戳就可以了。 接下来就是我们的图片的...
Ros发布图像消息
河马的BLOG
03-28 8483
ros的图像消息的格式为 sensor_msgs::ImagePtr 一般发送图像消息都是通过opencv来进行转换，ros提供了一个类cv_bridge来负责ros图像消息和opencv图像消息的转换 在OpenCV中，图像是以Mat矩阵的形式存储的，这与ROS定义的图像消息的格式有一定的区别，所以需要利用cv_bridge将这两种不相同的格式联系起来，如下图所示。 转换后的图像消息格式为 sensor_msgs::ImagePtr opencv和cv_bridge转换的核心代码 cv::Mat i
ros发布图像集
zxnzjccmily的博客
04-08 640
以ros话题发布图像集
ros怎么发布彩色点云的同时能发布双目相机的image话题
08-09
5. 在主循环中，接收双目相机发布的图像数据，并将其转换为PointCloud2类型的消息，并发布到PointCloud2的话题上。 6. 同时，也将原始的双目相机图像数据发布到特定的Image话题上。 7. 在另外一个节点中订阅Point...
python双目标定_ROS下单目和双目相机的标定
weixin_39836751的博客
12-05 667
参考：http://wiki.ros.org/camera_calibrationROS下相机标定标定方法：可以通过matlab，OpenCV，ROS三种方式进行相机标定。ROS提供了camera_calibration Package：image_pipeline，通过这个Package可以使用棋盘标定板对单目和双目相机进行标定。另外推荐一个标定工具Kalibr：Kalibr，可以实现Multi...
Gazebo中加入一个双目相机及相机参数设置
weixin_41425527的博客
03-15 4925
ROS版本： ROS Kinetic 操作系统：Ubuntu16.04 LTS kinect 为了在gazebo中观察并利用利用视觉进行小球的定位并与ros通信，我们需要一个深度相机，这时可以直接使用kinect并加入插件与ros通信,gazebo官方也为我们提供了这个方法 http://gazebosim.org/tutorials/?tut=ros_depth_camera 直接将Kinect...
ROS中建立三个节点，每个节点都具有发布和订阅图像消息的功能
04-14
在ROS（机器人操作系统）中建立三个节点，每个节点都可以订阅和发布图像消息
ROS:二维坐标映射到三维坐标上(彩色与深度图像匹配)（基于深度相机D415）
07-31
对应博文：https://blog.csdn.net/qq_23670601/article/details/97970892 - 最近在用D435做物体识别抓取的时候发现二维坐标到三维坐标没有一个直接能用的从二维像素点坐标转换到三维坐标的ROS节点，自己之前写过的kinect V2的坐标映射的通用性太差，所以这次写了一个节点，利用深度相机ROS节点发布的深度与彩色对齐的图像话题和图像信息内外参话题，将二维坐标映射到三维坐标系。 - 我挂上来的这个节点是将鼠标指向的二维坐标转换到三维坐标系下，并发布话题可视化到了rviz中，因为我自己的物体识别发布的像素坐标话题是一个自己写的消息文件，这次就不放出来了，需要用的把我这里的鼠标反馈的坐标改成你自己的坐标就行了。
ROS发布图片ros::Publisher和image_transport::Publisher
qq_35547879的博客
02-06 830
需要跨终端传输，用image_transport::Publisher，会压缩，方便传输。不需要时，直接ros::Publisher，节省cpu资源。
ROS——发布图像节点并用opencv图像处理节点消息
Leeniux
07-19 1951
打开roscore，分别建立终端，调用listener和talker。
ros-双目图像数据发布
qq_43049432的博客
12-09 816
ros实时获取双目相机图像数据并发布
ROS：两个节点分别实现图像的发布与订阅功能，以及在其中一个节点实现图像的预处理
Skyblueee_的博客
09-18 1515
在ROS中，两个节点分别实现图像的发布与功能，以及在其中一个节点实现图像预处理。
如何使用ros命令行显示图片
weixin_30539835的博客
07-13 745
rosrun image_view image_view image:=[TOPIC] 注意：每次只能显示一个UI。不能在一条命令中订阅多个节点。 转载于:https://www.cnblogs.com/williamc17/p/9303783.html
【ROS】ros抽取图像帧
穿着帆布鞋也能走猫步
01-09 2190
个人认为最简便的办法. 用ros工具从bag文件中提取图片 1)首先需要安装一些图片处理依赖的包: mjpeg, ffmpeg $ sudo apt-get install mjepgtools $ sudo apt-get install ffmpeg 2)新建文件夹用于储存提取后的图片，并执行： rosrun image_view extract_images _sec_per_frame:...
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值