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即可

相关推荐
时间的拾荒人8 小时前
Linux 系统命令与网络、磁盘、日志监控(下篇):性能原理与优化
linux·运维·网络
金色熊族8 小时前
qt5.15.9编译qt-creator7.0.2源码
linux·qt
Rabitebla8 小时前
【Linux】文件篇(五):手撕简易 FILE——模拟实现 C 标准 I/O 缓冲机制
linux·服务器·c语言·笔记·学习·ubuntu
蜗牛一步步往上爬9 小时前
第十章 使用编辑器
linux
无足鸟ICT13 小时前
【RHCA+】swap和物理内存
linux
硅谷秋水16 小时前
面向精确到达任务的机器人-对齐3D高斯溅射方法——基于腕部-相机VLA策略
数码相机·机器学习·计算机视觉·3d·机器人
Huangjin007_18 小时前
【Linux 系统篇(四十一)】线程(二):线程的优缺点、资源共享与上下文切换
linux·运维·服务器
嵌入式 Linux手记19 小时前
嵌入式面试都考的置位清位:位运算四件套
linux·c语言·驱动开发·面试·职场和发展·嵌入式
Rabitebla19 小时前
【Linux】文件篇(六):Shell 实战——从系统调用到命令行重定向
linux·服务器·c++·笔记·学习
dingdingfish20 小时前
TLPI 第57章 读书笔记:Sockets: UNIX Domain
linux·socket·domain·sendto·recvfrom·tlpi·socketpair