ROS2多线程 MultiThreadedExecutor

最新推荐文章于 2025-03-16 21:46:08 发布

Jiqiang_z

最新推荐文章于 2025-03-16 21:46:08 发布

阅读量1.4k

点赞数 4

分类专栏： ROS 文章标签：机器人 c++ 算法

本文链接：https://blog.csdn.net/jjjqqq123321/article/details/136379795

版权

ROS 专栏收录该内容

12 篇文章

订阅专栏

博客围绕ROS节点多线程运行展开。指出当ROS节点含多个回调函数时，默认创建的回调函数互斥，一次只能执行一个。还提及在一个main中创建两个节点并运行的情景，以及多线程运行多个节点和处理回调函数的情况。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

参考文章：

ROS2探索（二）executor_rclcpp::executors::multithreadedexecutor-CSDN博客

情景：

当一个ROS节点中含有多个回调函数时，默认创建的回调函数时互斥的，也就是说一次只能执行一个，无法同时运行。
当一个main中需要创建两个节点，并运行时。

多线程运行多个节点：

int main(int argc, char * argv[])
{
  rclcpp::init(argc, argv);
  rclcpp::executors::MultiThreadedExecutor executor;
  auto pubnode = std::make_shared<PublisherNode>();
  auto subnode = std::make_shared<DualThreadedNode>();
  executor.add_node(pubnode);
  executor.add_node(subnode);
  executor.spin();
  rclcpp::shutdown();
  return 0;
}

多线程处理回调函数：

    rclcpp::CallbackGroup::SharedPtr callback_group_subscriber_;

    rclcpp::Subscription<sensor_msgs::msg::Imu>::SharedPtr imu_sub_;
    rclcpp::Subscription<sensor_msgs::msg::PointCloud2>::SharedPtr point_cloud_sub_;
    
    // 创建回调组。
    //Reentrant表示可以同时处理多个回调函数,MutuallyExclusive表示此组的回调函数是互斥的。
    callback_group_subscriber_ =             create_callback_group(rclcpp::CallbackGroupType::Reentrant);
    auto sub_opt = rclcpp::SubscriptionOptions();
    sub_opt.callback_group = callback_group_subscriber_;
    
    // 订阅IMU消息
    imu_sub_ = create_subscription<sensor_msgs::msg::Imu>(
            params_.imuTopic, 2000, std::bind(&OnlineMapping::imuCallback, this,     std::placeholders::_1), sub_opt);
    
    // 订阅lidar消息
    point_cloud_sub_ = create_subscription<sensor_msgs::msg::PointCloud2>(
            params_.pointCloudTopic, 1, std::bind(&OnlineMapping::pointCloud2Callback, this, std::placeholders::_1), sub_opt);