请用c++写一段ros程序，gazebo仿真环境下有一个深度相机，要求读取深度相机的深度图像和rgb图像，两者的话题名分别为/camera3/depth/image_raw和/camera3/rgb/image_raw，读取到的深度图存入/home/hudi/my_pic/town2/depth/video1，rgb图片存入/home/hudi/my_pic/town2/rgb/video1路径。

好的，以下是C++编写的ROS程序，用于读取深度相机的深度图像和RGB图像，并将它们存储到指定的文件路径中。

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

void depthCallback(const sensor_msgs::ImageConstPtr& msg)
{
    // Convert ROS image message to OpenCV Mat
    cv_bridge::CvImagePtr cv_ptr;
    try
    {
        cv_ptr = cv_bridge::toCvCopy(msg, sensor_msgs::image_encodings::TYPE_32FC1);
    }
    catch (cv_bridge::Exception& e)
    {
        ROS_ERROR("cv_bridge exception: %s", e.what());
        return;
    }

    // Save depth image to file
    cv::Mat depth_image = cv_ptr->image;
    cv::imwrite("/home/hudi/my_pic/town2/depth/video1", depth_image);
}

void rgbCallback(const sensor_msgs::ImageConstPtr& msg)
{
    // Convert ROS image message to OpenCV Mat
    cv_bridge::CvImagePtr cv_ptr;
    try
    {
        cv_ptr = cv_bridge::toCvCopy(msg, sensor_msgs::image_encodings::BGR8);
    }
    catch (cv_bridge::Exception& e)
    {
        ROS_ERROR("cv_bridge exception: %s", e.what());
        return;
    }

    // Save RGB image to file
    cv::Mat rgb_image = cv_ptr->image;
    cv::imwrite("/home/hudi/my_pic/town2/rgb/video1", rgb_image);
}

int main(int argc, char** argv)
{
    ros::init(argc, argv, "camera_subscriber");

    ros::NodeHandle nh;

    // Subscribe to depth and RGB image topics
    ros::Subscriber depth_sub = nh.subscribe("/camera3/depth/image_raw", 1, depthCallback);
    ros::Subscriber rgb_sub = nh.subscribe("/camera3/rgb/image_raw", 1, rgbCallback);

    ros::spin();

    return 0;
}

这段程序首先包含了必要的ROS和OpenCV头文件。然后定义了两个回调函数depthCallback和rgbCallback，分别用于处理深度图像和RGB图像。

在每个回调函数中，首先将ROS图像消息转换为OpenCV图像格式。然后将深度图像和RGB图像保存到指定的文件路径中。

最后，程序在主函数中订阅/camera3/depth/image_raw和/camera3/rgb/image_raw两个话题，等待接收图像消息，并调用相应的回调函数来处理它们。

请注意，这段程序假设深度图像是32位浮点型，RGB图像是BGR8格式。如果你的相机数据类型不同，请相应地更改代码。