ROS2下Rviz显示orbbec相机depth深度图

ROS2下Rviz显示orbbec相机depth深度图

视频讲解

ROS2下Rviz显示orbbec相机depth深度图

在《ROS2下编写orbbec相机C++ package并Rviz显示》的基础上,继续添加depth图像的获取及显示

复制代码
rgb_publisher_ = this->create_publisher<sensor_msgs::msg::Image>("rgb_image", 10);
depth_publisher_ = this->create_publisher<sensor_msgs::msg::Image>("depth_image", 10);

rclcpp::Publisher<sensor_msgs::msg::Image>::SharedPtr rgb_publisher_;
rclcpp::Publisher<sensor_msgs::msg::Image>::SharedPtr depth_publisher_;

将原来的publisher变量变成rgb,并增加depth发布者,同时将深度图像的消息名称命名为depth_image

复制代码
void timer_callback()
{
    //CV_8UC3 8位无符号3通道图像
    cv::Mat rgb_image = cam_.getImg();
    sensor_msgs::msg::Image::SharedPtr rgb_msg = cv_bridge::CvImage(std_msgs::msg::Header(), "bgr8", rgb_image).toImageMsg();
    rgb_publisher_->publish(*rgb_msg);
    //CV_16UC1 16位无符号单通道图像
    cv::Mat depth_image = cam_.getDepth();
    sensor_msgs::msg::Image::SharedPtr depth_msg = cv_bridge::CvImage(std_msgs::msg::Header(), "mono16", depth_image).toImageMsg();
    depth_publisher_->publish(*depth_msg);
    // RCLCPP_INFO(this->get_logger(), "Publishing image");
}

只需要修改time_callback函数即可,增加cam_.getDetph();图像的类型为16位单通道无符号,所以要将cv_brige的格式改成mono16,不然会出现格式转换有问题的现象

复制代码
sudo su
colcon build --packages-select orbbec_cam_pkg
source install/setup.bash 
ros2 run orbbec_cam_pkg image_publisher  

切换到sudo,编译,运行,另起一个窗口启动Rviz2

再添加一个Image,Topic选择/depth_image,如果图像不显示,则将三个policy全选System Default即可

相关推荐
晨曦丿19 分钟前
双11服务器
linux·服务器·网络
李迟1 小时前
在Linux服务器上使用kvm创建虚拟机
java·linux·服务器
A_New_World1 小时前
Linux性能分析工具
linux
鹏大师运维1 小时前
在银河麒麟V10 SP1上手动安装与配置高版本Docker的完整指南
linux·运维·docker·容器·麒麟·统信uos·中科方德
QMCY_jason1 小时前
linux 内存占用排查 vm.nr_hugepages
linux·运维·服务器
cui_win1 小时前
【基础】Golang语言开发环境搭建(Linux主机)
linux·golang·运维开发
ZPC82102 小时前
ubuntu 6.8.0 安装xenomai3.3
linux·运维·ubuntu
一梦浮华3 小时前
自学嵌入式 day30 IPC:进程间通信
linux·运维·服务器
CH_Qing3 小时前
【udev】关于/dev 设备节点的生成 &udev
linux·前端·网络
电脑能手3 小时前
遇到该问题:kex_exchange_identification: read: Connection reset`的解决办法
linux·ubuntu·ssh