答案：在ros中使用c++通过roscpp库创建发布者和订阅者节点，首先建立工作空间和功能包，编写talker.cpp和listener.cpp实现消息发布与订阅，配置cmakelists.txt后编译运行，确保roscore启动后分别运行节点，即可实现话题通信。
在ROS（机器人操作系统）中使用C++编程，主要是通过ROS提供的客户端库roscpp来实现节点的创建、话题的发布与订阅。下面详细介绍如何用C++在ROS中创建一个简单的发布者和订阅者节点。
创建ROS工作空间和功能包
开始前确保已安装ROS环境。然后创建工作空间和功能包：
- 创建工作空间目录：
mkdir -p ~/catkin_ws/src - 初始化catkin工作空间：
cd ~/catkin_ws && catkin_make - 进入src目录并创建功能包：
cd src && catkin_create_pkg my_robot_node roscpp std_msgs
上面命令创建了一个名为my_robot_node的功能包，依赖roscpp和std_msgs。
编写发布者节点
在功能包内创建一个src/talker.cpp文件：
立即学习“C++免费学习笔记（深入）”；
#include <ros/ros.h>
#include <std_msgs/String.h>
int main(int argc, char **argv) {
ros::init(argc, argv, "talker");
ros::NodeHandle nh;
ros::Publisher pub = nh.advertise<std_msgs::String>("chatter", 10);
ros::Rate loop_rate(10); // 10Hz
int count = 0;
while (ros::ok()) {
std_msgs::String msg;
msg.data = "Hello ROS: " + std::to_string(count);
pub.publish(msg);
ros::spinOnce();
loop_rate.sleep();
++count;
}
return 0;
}
这段代码做了以下几件事：
- 初始化ROS节点，名称为talker
- 创建NodeHandle用于与ROS系统通信
- 定义一个发布者，向话题chatter发布std_msgs/String类型的消息
- 以10Hz频率循环发送递增的消息
编写订阅者节点
创建src/listener.cpp文件：
#include <ros/ros.h>
#include <std_msgs/String.h>
void chatterCallback(const std_msgs::String::ConstPtr& msg) {
ROS_INFO("I heard: %s", msg->data.c_str());
}
int main(int argc, char **argv) {
ros::init(argc, argv, "listener");
ros::NodeHandle nh;
ros::Subscriber sub = nh.subscribe("chatter", 10, chatterCallback);
ros::spin();
return 0;
}
说明：
- 创建名为listener的节点
- 订阅chatter话题，回调函数为chatterCallback
- 每当收到消息，自动调用回调函数打印内容
- ros::spin()保持节点运行并监听回调
配置CMakeLists.txt
进入功能包根目录，编辑CMakeLists.txt，在末尾添加：
add_executable(talker src/talker.cpp)
add_executable(listener src/listener.cpp)
target_link_libraries(talker ${catkin_LIBRARIES})
target_link_libraries(listener ${catkin_LIBRARIES})
add_dependencies(talker ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})
add_dependencies(listener ${${PROJECT_NAME}_EXPORTED_TARGETS} ${catkin_EXPORTED_TARGETS})
确保可执行文件能正确编译和链接ROS库。
编译与运行
回到工作空间根目录并编译：
cd ~/catkin_ws catkin_make
启动ROS核心：
roscore
打开新终端，运行发布者：
source devel/setup.bash rosrun my_robot_node talker
再打开一个终端，运行订阅者：
rosrun my_robot_node listener
你将看到订阅者终端不断输出“Hello ROS: X”的消息。
基本上就这些。掌握节点初始化、发布与订阅的模式后，就可以扩展到传感器数据处理、控制指令发送等更复杂的场景。关键理解NodeHandle、Publisher/Subscriber机制以及回调模型。不复杂但容易忽略细节，比如忘记ros::spinOnce()或ros::spin()会导致程序无法响应消息。
