C++怎么在ROS中编程_C++机器人操作系统中创建节点、发布与订阅话题_技术教程

答案：在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文件：

#include 
#include 

int main(int argc, char **argv) {
    ros::init(argc, argv, "talker");
    ros::NodeHandle nh;
    ros::Publisher pub = nh.advertise("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 
#include 

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()会导致程序无法响应消息。