ROS实现话题的发布与订阅


系统版本(架构): Debian 9(aarch64)
ROS版本: ROS Melodic Morenia
Python版本: 2.7.13和3.5.3
gcc 版本: 9.3.0
catkin-tools: 0.6.1
Cmake版本: 3.24.3

1 创建ROS工作空间

$ mkdir -p exp_ws/src
$ cd /exp_ws
$ catkin_make

这里的exp_ws是工作空间的名字,可自定义。

2 添加环境变量

echo "source /mnt/sd/exp_ws/devel/setup.bash" >> ~/.bashrc
source ~/.bashrc

这里注意把你的工作空间中devel目录下的setup.bash的路径搞清楚,改成你自己的路径。

3 安装ROS功能包

cd /src
catkin_create_pkg pub_sub_eg roscpp std_msgs

在这里插入图片描述
其中,pub_sub_eg是包名。

4 创建发布节点pub_eg.cpp

cd /mnt/sd/exp_ws/src/pub_sub_eg/src
vim pub_eg.cpp

为了防止出现粘贴格式错乱,在执行vim pub_eg.cpp后,输入:set paste,使vim编辑器进入粘贴模式,然后粘贴。

在这里插入图片描述
然后将下面的代码复制到pub_eg.cpp里面。

//pub_eg.cpp
#include "ros/ros.h"
#include "std_msgs/String.h"

#include <sstream>


int main(int argc, char **argv)
{
	//ROS初始化 pub_node是节点的名字
    ros::init(argc, argv, "pub_node");

    ros::NodeHandle n;

    ros::Publisher chatter_pub = n.advertise<std_msgs::String>("chatter", 1000);

    ros::Rate loop_rate(10);

    int count = 0;
    while (ros::ok())
    {
        std_msgs::String msg;

        std::stringstream ss;
        ss << "All Right" << count;
        msg.data = ss.str();

        ROS_INFO("%s", msg.data.c_str());
        chatter_pub.publish(msg);

        ros::spinOnce();

        loop_rate.sleep();
        ++count;
    }

    return 0;
}

5 创建订阅节点sub_eg.cpp

cd /mnt/sd/exp_ws/src/pub_sub_eg/src
vim sub_eg.cpp

然后将下面的代码复制到sub_eg.cpp里面。

//sub_eg.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初始化 sub_node是节点的名字
    ros::init(argc, argv, "sub_node");

    ros::NodeHandle n;
    ros::Subscriber sub = n.subscribe("chatter", 1000, chatterCallback);

    ros::spin();

    return 0;
}

将下述内容添加到/exp_ws/src/pub_sub_eg/CMakeLists.txt文件的末尾

find_package(catkin REQUIRED COMPONENTS
  roscpp
  rospy
  sensor_msgs
  geometry_msgs
  tf
)
include_directories(include ${catkin_INCLUDE_DIRS} ${PCL_INCLUDE_DIRS})
add_executable(pub_node /mnt/sd/exp_ws/src/pub_sub_eg/src/pub_eg.cpp)
target_link_libraries(pub_node ${catkin_LIBRARIES})
add_executable(sub_node /mnt/sd/exp_ws/src/pub_sub_eg/src/sub_eg.cpp)
target_link_libraries(sub_node ${catkin_LIBRARIES})

6 编译工作空间,生成节点

cd /mnt/sd/exp_ws
catkin_make

在这里插入图片描述
编译成功后,会生成两个可执行文件pub_nodesub_node

7 运行示例

1、新建一个终端,执行下述命令,启动ros master

source /mnt/sd/exp_ws/devel/setup.bash
roscore

在这里插入图片描述
2、新建一个终端,执行下述命令,启动发布节点

source /mnt/sd/exp_ws/devel/setup.bash
rosrun pub_sub_eg pub_node

在这里插入图片描述
3、新建一个终端,执行下述命令,启动订阅节点

source /mnt/sd/exp_ws/devel/setup.bash
rosrun pub_sub_eg sub_node

在这里插入图片描述
4、新建一个终端,执行命令rqt_graph,展示节点关系
在这里插入图片描述

8 工作空间结构展示及ROS实现话题的发布与订阅的步骤

在这里插入图片描述
在这里插入图片描述
上面两张图均来源于第9章节中的[2]中。

9 参考资料

1.《ROS基本操作(一):发布与订阅》
https://blog.csdn.net/qq_39916709/article/details/120428809
2.《ROS 发布及订阅消息》
https://blog.csdn.net/weixin_39652282/article/details/103425406?ops_request_misc=&request_id=&biz_id=102&utm_term=ROS%E7%9A%84%E5%8F%91%E5%B8%83%E4%B8%8E%E8%AE%A2%E9%98%85&utm_medium=distribute.pc_search_result.none-task-blog-2allsobaiduweb~default-5-103425406.142v67control,201v3add_ask,213v2t3_esquery_v3&spm=1018.2226.3001.4187
3.《ROS学习(四)发布者与订阅者》
https://blog.csdn.net/m0_56451176/article/details/126183151

ROS中,话题是一种消息传输机制,用于在不同节点之间传递数据。话题发布者会向话题发送消息,而订阅者则会接收并处理这些消息。 下面是一个简单的例子,演示如何在ROS实现话题发布订阅: 1. 创建一个ROS包和一个节点: ``` $ mkdir my_package $ cd my_package $ catkin_create_pkg my_node rospy $ cd my_node/src $ touch publisher.py subscriber.py $ chmod +x publisher.py subscriber.py ``` 2. 在 `publisher.py` 文件中编写发布者节点的代码: ```python #!/usr/bin/env python import rospy from std_msgs.msg import String def talker(): pub = rospy.Publisher('my_topic', String, queue_size=10) rospy.init_node('publisher', anonymous=True) rate = rospy.Rate(10) # 10hz while not rospy.is_shutdown(): hello_str = "Hello ROS %s" % rospy.get_time() rospy.loginfo(hello_str) pub.publish(hello_str) rate.sleep() if __name__ == '__main__': try: talker() except rospy.ROSInterruptException: pass ``` 上述代码创建了一个名为 `my_topic` 的话题,并向该话题发布了一个字符串消息。 3. 在 `subscriber.py` 文件中编写订阅者节点的代码: ```python #!/usr/bin/env python import rospy from std_msgs.msg import String def callback(data): rospy.loginfo(rospy.get_caller_id() + "I heard %s", data.data) def listener(): rospy.init_node('subscriber', anonymous=True) rospy.Subscriber("my_topic", String, callback) rospy.spin() if __name__ == '__main__': listener() ``` 上述代码创建了一个名为 `my_topic` 的话题,并订阅话题的消息。每当收到消息时,回调函数 `callback` 就会被调用。 4. 运行节点: 在新终端中打开ROS环境 ``` $ roscore ``` 在 `publisher.py` 的终端中运行发布者节点: ``` $ rosrun my_node publisher.py ``` 在 `subscriber.py` 的终端中运行订阅者节点: ``` $ rosrun my_node subscriber.py ``` 这样,你就成功地实现ROS中的话题发布订阅机制。你可以在其他节点中也使用相同的话题来进行通信。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值