01-ROS入门-10 Python写ROS 订阅与发布程序

(注意 python中首行必须是 #!/usr/bin/env python 否则import失败)

1. 编写talker代码

vim ..../src/talker.py

#!/usr/bin/env python
# license removed for brevity
import rospy
from std_msgs.msg import String

def talker():
    pub = rospy.Publisher('chatter', String, queue_size=10)
    #调用publisher函数 创建发布节点 ,定义数据类型,
    #queue_size参数是当其接受者接受不够快造成信号堵塞中队列信息的数量限制
    
    rospy.init_node('talker', anonymous=True)
    #启动节点同时为节点命名, 若anoymous为真则节点会自动补充名字,实际名字以talker_322345等表示
    #若为假,则系统不会补充名字,采用用户命名。但是一次只能有一个同名节点,若后面有一个相同listener
    #名字的节点则后面的节点启动会注销前面的相同节点名。
    
    rate = rospy.Rate(10) # 10hz
    #延时的时间变量赋值,通过rate.sleep()实现延时
    
    while not rospy.is_shutdown():
    # 判定开始方式,循环发送,以服务程序跳出为终止点 一般ctrl+c也可
    
        hello_str = "hello world %s" % rospy.get_time()
        # 数据变量的内容 rospy.get_time() 是指ros系统时间,精确到0.01s 
        # 也可以使用 import time  time.strftime('%Y%m%d%H%M%S')
        
        rospy.loginfo(hello_str)
        #在运行的terminal界面info 出信息,可不加,可随意改
        
        pub.publish(hello_str)
        #发布数据 必须发布
        
        rate.sleep()
        #ros中的延时表示,也可用系统的延时 import time  time.sleep(1) 
        #ros系统中的延时应该比ubuntu自带好好,尽量用ros的
if __name__ == '__main__':
    try:
        talker()
    except rospy.ROSInterruptException:
        pass

2. 编写listener代码

vim ..../src/listener.py

#!/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)
    #回调函数 收到的参数.data是通信的数据 默认通过这样的 def callback(data) 取出data.data数据
    
def listener():

    # In ROS, nodes are uniquely named. If two nodes with the same
    # node are launched, the previous one is kicked off. The
    # anonymous=True flag means that rospy will choose a unique
    # name for our 'listener' node so that multiple listeners can
    # run simultaneously.
    rospy.init_node('listener', anonymous=True)
    
    #启动节点同时为节点命名, 若anoymous为真则节点会自动补充名字,实际名字以 listener_322345等表示
    #若为假,则系统不会补充名字,采用用户命名。但是一次只能有一个同名节点,若后面有一个相同listener
    #名字的节点则后面的节点启动会注销前面的相同节点名。
    
    rospy.Subscriber("chatter", String, callback)
    
    #启动订阅,订阅主题,及标准字符串格式,同时调用回调函数,当有数据时调用函数,取出数据
    
    # spin() simply keeps python from exiting until this node is stopped
    
    #循环程序
    rospy.spin()

if __name__ == '__main__':
    listener()
#函数不被用作模块调用

3. 添加权限

chmod +x ..../src/talker.py |chmod +x .../src/listener.py

4. 编译

catkin_make

5. 运行talker

rosrun exam talker.py

6. 运行listener

rosrun exam listener.py

注释:最简单的订阅与发布程序:

  • 订阅

      #!/usr/bin/env python
      import rospy
      from std_msgs.msg import String
      rospy.init_node('talker',anonymous=0)
      pub=rospy.Publiser('chatter',String)
      rate=rospy.Rate(1)
      while not rospy.is_shutdown():
          rospy.loginfo('telll myself')
          pub.publish('hello')
          rate.sleep()
    
  • 发布
    #!/usr/bin/env python
    import rospy
    from std_msgs.msg import String
    rospy.init_node('listener',anonymous=0)
    lis=rospy.Subscriber('chatter',String,callback)
    rospy.spin()
    def callback(data):
    rospy.loginfo(data.data)

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 212,029评论 6 492
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 90,395评论 3 385
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 157,570评论 0 348
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 56,535评论 1 284
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 65,650评论 6 386
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 49,850评论 1 290
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 39,006评论 3 408
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 37,747评论 0 268
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 44,207评论 1 303
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 36,536评论 2 327
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 38,683评论 1 341
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 34,342评论 4 330
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 39,964评论 3 315
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 30,772评论 0 21
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,004评论 1 266
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 46,401评论 2 360
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 43,566评论 2 349

推荐阅读更多精彩内容