简单的发布者/订阅者（Python）

最新推荐文章于 2024-09-12 19:02:10 发布

liuzubing

最新推荐文章于 2024-09-12 19:02:10 发布

阅读量3.7k

点赞数 1

分类专栏： ROS

本文链接：https://blog.csdn.net/liuzubing/article/details/78328191

版权

ROS 专栏收录该内容

14 篇文章 4 订阅

订阅专栏

自己在使用ROS的过程中一直使用Python编程语言，因此在此只介绍基于Python的发布者/订阅者代码，有兴趣的可以到官网参考C++的代码。

1、编写代码前的准备工作

在前面已经介绍了如何创建一个ROS空间，以及如何创建自定义的消息和服务，在这里默认你已经掌握了上述内容。假设我已经在自己的用户目录下创建了一个名为ROSworkspace的工作空间，在工作空间的src文件夹下已经创建了一个名为newpackage的软件包（功能包）。在软件包内的msg文件夹下创建了一个名为Str.msg的消息文件，消息文件的内容如下所示：

string str

并且已经将上述所有代码进行了一次编译。

2、主题发布者节点

在～/ROSworkspace/src/newpackage/src目录下（一般一个软件包的节点可执行文件都放在这个目录下），创建一个talker.py文件，文件内的代码如下所示：

#!/usr/bin/env python
#coding:utf-8
# license removed for brevity

import rospy
import time
from newpackage.msg import Str

def talker():
    pub = rospy.Publisher('chatter2',Str,queue_size = 10)#创建一个话题
    rospy.init_node('talker',anonymous = True)#声明一个发布话题的节点
    rate = rospy.Rate(1)#话题发布的频率1Hz
    while not rospy.is_shutdown():
        hello_str = "hello world %s" % time.strftime("%Y-%m-%d %H:%M:%S",time.localtime())
        rospy.loginfo(hello_str)#将数据打印出来
        pub.publish(hello_str)#将数据发送到话题上
        rate.sleep()

if __name__ == '__main__':
    try:
        talker()
    except rospy.ROSInterruptException:
        pass

创建成功后，不要忘记把.py文件变为可执行文件：(这一步非常重要。默认当前在该文件所在路径下，否则应该在文件名前面加上路径)

chmod +x talker.py

使用该指令后可以用ls列出文件，可以发现文件名颜色与之前比发生了变化。

3、主题订阅者节点

在～/ROSworkspace/src/newpackage/src目录下，创建一个listener.py文件，文件内的代码如下所示：

#!/usr/bin/env python
#coding:utf-8
import rospy
from newpackage.msg import Str

def callback(data):
    rospy.loginfo("I heard %s", data.str)#将数据打印在屏幕上，注意data.后面必须是消息中定义的消息名称

def listener():
    rospy.init_node('listener', anonymous=True)#声明一个订阅者节点
    rospy.Subscriber("chatter2", Str, callback)#订阅一个话题，收到话题数据后并做出相应的反应

    # spin() simply keeps python from exiting until this node is stopped
    rospy.spin()

if __name__ == '__main__':
    listener()

创建成功后，不要忘记把.py文件变为可执行文件：