ROS2 C++实现发布者与订阅者通信基础教程

1. ROS2基础通信：C++实现发布者与订阅者

在机器人开发中，节点间的通信是核心基础。今天我将分享如何在ROS2环境下用C++实现最基本的发布-订阅模型。这个"说话者-听者"系统虽然简单，但包含了ROS2通信的所有关键要素。

1.1 环境准备与项目创建

首先确保已安装ROS2 Jazzy版本（其他版本需相应调整命令）。我习惯在工作空间src目录下操作，这样可以保持项目结构清晰：

bash复制mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src

创建CMake包时，我推荐添加license信息，这对后续开源很重要：

bash复制ros2 pkg create --build-type ament_cmake --license Apache-2.0 cpp_pubsub

注意：包名不要用大写字母和下划线，ROS2包命名规范建议全小写

进入包目录后，你会看到自动生成的CMakeLists.txt和package.xml。我习惯先完善package.xml的元信息：

xml复制<description>Minimal publisher/subscriber demo using rclcpp</description>
<maintainer email="your@email.com">Your Name</maintainer>
<license>Apache-2.0</license>

2. 发布者节点实现

2.1 编写发布者代码

在src目录下创建publisher_member_function.cpp：

cpp复制#include <chrono>
#include <memory>
#include <string>

#include "rclcpp/rclcpp.hpp"
#include "std_msgs/msg/string.hpp"

using namespace std::chrono_literals;

class MinimalPublisher : public rclcpp::Node {
public:
  MinimalPublisher() : Node("minimal_publisher"), count_(0) {
    publisher_ = this->create_publisher<std_msgs::msg::String>("topic", 10);
    timer_ = this->create_wall_timer(
      500ms, std::bind(&MinimalPublisher::timer_callback, this));
  }

private:
  void timer_callback() {
    auto message = std_msgs::msg::String();
    message.data = "Hello ROS2! " + std::to_string(count_++);
    RCLCPP_INFO(this->get_logger(), "Publishing: '%s'", message.data.c_str());
    publisher_->publish(message);
  }
  
  rclcpp::TimerBase::SharedPtr timer_;
  rclcpp::Publisher<std_msgs::msg::String>::SharedPtr publisher_;
  size_t count_;
};

int main(int argc, char * argv[]) {
  rclcpp::init(argc, argv);
  rclcpp::spin(std::make_shared<MinimalPublisher>());
  rclcpp::shutdown();
  return 0;
}

2.2 代码解析

1. 节点初始化：继承rclcpp::Node创建自定义节点类
2. 发布者创建：指定消息类型(std_msgs/String)和主题名(topic)
3. 定时器回调：每500ms触发一次消息发布
4. 消息发布：使用RCLCPP_INFO宏输出日志

经验：比起lambda表达式，成员函数方式更易维护，适合复杂项目

2.3 配置构建系统

在CMakeLists.txt中添加：

cmake复制find_package(rclcpp REQUIRED)
find_package(std_msgs REQUIRED)

add_executable(talker src/publisher_member_function.cpp)
ament_target_dependencies(talker rclcpp std_msgs)

install(TARGETS talker DESTINATION lib/${PROJECT_NAME})

3. 订阅者节点实现

3.1 编写订阅者代码

创建subscriber_member_function.cpp：

cpp复制#include <memory>

#include "rclcpp/rclcpp.hpp"
#include "std_msgs/msg/string.hpp"

class MinimalSubscriber : public rclcpp::Node {
public:
  MinimalSubscriber() : Node("minimal_subscriber") {
    subscription_ = this->create_subscription<std_msgs::msg::String>(
      "topic", 10, std::bind(&MinimalSubscriber::topic_callback, this, std::placeholders::_1));
  }

private:
  void topic_callback(const std_msgs::msg::String::SharedPtr msg) const {
    RCLCPP_INFO(this->get_logger(), "Received: '%s'", msg->data.c_str());
  }
  
  rclcpp::Subscription<std_msgs::msg::String>::SharedPtr subscription_;
};

int main(int argc char * argv[]) {
  rclcpp::init(argc, argv);
  rclcpp::spin(std::make_shared<MinimalSubscriber>());
  rclcpp::shutdown();
  return 0;
}

3.2 关键点说明

1. 订阅者创建：与发布者使用相同的消息类型和主题名
2. 回调函数：收到消息时自动触发
3. 队列长度：10表示保留最近10条未处理消息

注意：主题名必须完全匹配，包括大小写

3.3 完善CMake配置

在CMakeLists.txt中追加：

cmake复制add_executable(listener src/subscriber_member_function.cpp)
ament_target_dependencies(listener rclcpp std_msgs)

install(TARGETS talker listener DESTINATION lib/${PROJECT_NAME})

4. 构建与测试

4.1 构建项目

bash复制cd ~/ros2_ws
colcon build --packages-select cpp_pubsub

4.2 运行节点

开启第一个终端运行发布者：

bash复制source install/setup.bash
ros2 run cpp_pubsub talker

开启第二个终端运行订阅者：

bash复制source install/setup.bash
ros2 run cpp_pubsub listener

4.3 验证通信

你应该看到类似输出：

发布者终端：

code复制[INFO] [minimal_publisher]: Publishing: 'Hello ROS2! 0'
[INFO] [minimal_publisher]: Publishing: 'Hello ROS2! 1'

订阅者终端：

code复制[INFO] [minimal_subscriber]: Received: 'Hello ROS2! 0'
[INFO] [minimal_subscriber]: Received: 'Hello ROS2! 1'

5. 进阶技巧与问题排查

5.1 常见问题

1. 消息不接收：

   • 检查主题名是否一致
   • 确认消息类型匹配
   • 查看节点是否正常运行(ros2 node list)

2. 编译错误：

   • 确保所有依赖已声明
   • 检查C++标准设置(建议C++14/17)

3. 性能问题：

   • 调整队列长度
   • 考虑使用零拷贝方式

5.2 调试技巧

1. 查看主题列表：

bash复制ros2 topic list

2. 查看主题内容：

bash复制ros2 topic echo /topic

3. 查看节点信息：

bash复制ros2 node info /minimal_publisher

5.3 扩展建议

1. 自定义消息类型
2. 添加服务质量(QoS)配置
3. 实现节点参数化

在实际机器人项目中，我通常会在此基础上添加异常处理、日志分级和性能监控。这个基础通信模型虽然简单，但经过适当扩展完全可以满足复杂系统的通信需求。