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

LitchiCheng

ROS2下Rviz显示orbbec相机depth深度图 [复制链接]

 

邀请：@chenzhufly   @tagetage   @littleshrimp   @wsdymg   参与回复

 

 

 

视频讲解

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

 

 

 

 

查看精华帖全部内容，请登录或者注册

Jacktang

将原来的publisher变量变成rgb，只需要修改time_callback函数即可

LitchiCheng

Jacktang 发表于 2025-2-18 07:47 将原来的publisher变量变成rgb，只需要修改time_callback函数即可

对的

freebsder

相机多少钱？爱好者能不能有这个财力玩玩？

LitchiCheng

freebsder 发表于 2025-2-21 16:05 相机多少钱？爱好者能不能有这个财力玩玩？

咸鱼应该几百米