ros同一个节点中使用多线程处理话题的接收和发送的C++程序

以下是一个使用多线程处理ROS话题接收和发送的C程序示例：

#include <ros/ros.h>
#include <std_msgs/String.h>
#include <pthread.h>

void *receive_thread(void *arg);
void *send_thread(void *arg);

std_msgs::String msg;
ros::Publisher pub;
ros::Subscriber sub;

int main(int argc, char **argv) {
    ros::init(argc, argv, "multithread_node");
    ros::NodeHandle nh;

    pub = nh.advertise<std_msgs::String>("topic_out", 10);
    sub = nh.subscribe("topic_in", 10, receive_callback);

    pthread_t threads[2];
    pthread_create(&threads[0], NULL, receive_thread, NULL);
    pthread_create(&threads[1], NULL, send_thread, NULL);

    ros::spin();

    return 0;
}

void *receive_thread(void *arg) {
    ros::Rate rate(10); // 10Hz
    while (ros::ok()) {
        ros::spinOnce();
        rate.sleep();
    }
    pthread_exit(NULL);
}

void *send_thread(void *arg) {
    ros::Rate rate(10); // 10Hz
    while (ros::ok()) {
        pub.publish(msg);
        rate.sleep();
    }
    pthread_exit(NULL);
}

void receive_callback(const std_msgs::String::ConstPtr& received_msg) {
    // process received message
    msg = *received_msg;
}

该程序创建两个线程，一个用于接收话题，另一个用于发送话题。每个线程都在一个循环中运行，以便在ROS节点的主线程中使用`ros::spinOnce()`处理话题接收。线程使用`pthread_create()`函数创建，使用`pthread_exit()`函数退出。

在`main()`函数中，程序首先初始化ROS节点，并创建一个发布者和一个订阅者。然后，程序创建两个线程，并使用`ros::spin()`函数等待ROS节点退出。

在`receive_thread()`函数中，程序使用`ros::Rate`对象控制线程的频率。在每个循环周期内，程序使用`ros::spinOnce()`函数处理话题接收，然后使用`rate.sleep()`函数使线程休眠以避免过多占用CPU资源。

在`send_thread()`函数中，程序也使用`ros::Rate`对象控制线程的频率。在每个循环周期内，程序使用发布者发布消息，然后使用`rate.sleep()`函数使线程休眠以避免过多占用CPU资源。

在`receive_callback()`函数中，程序处理接收到的消息，并将其存储在消息变量`msg`中以备发送。

请注意，由于ROS节点的主线程使用`ros::spin()`函数等待退出，因此必须使用`pthread_exit()`函数退出线程，否则程序将无法正常退出。