ROS编写第一个订阅器

在上一篇文章中,我们实现了第一个ROS程序—发布器(publisher),然而在上一篇文章的最后我们也注意到,尽管我们的程序非常小,但占据的CPU资源却非常多。

这是因为在发布器的while循环里没有执行必要的sleep操作,使得发布器一直以最高速率运行,长时间占用CPU。

本篇文章分为以下两部分:

  1. 在发布器中加入sleep调用使发布器的频率稳定在1Hz
  2. 实现一个订阅器(Subscriber)

1. 发布器加入sleep

事实上,我们所需要做的只有两行工作,首先创建一个ros::Rate对象,然后在while循环里调用该对象的.sleep()函数即可。

修改后完整的代码如下:

#include <ros/ros.h>
#include <std_msgs/Float64.h>

int main(int argc, char **argv) {
    ros::init(argc, argv, "minimal_publisher"); // 初始化节点名
    ros::NodeHandle n; //
    
    // ++++
    ros::Rate s_timer(1.0); // 参数1.0代表发布频率即1.0Hz
    // ++++
    
    ros::Publisher my_publisher_object = n.advertise<std_msgs::Float64>("topic1", 1); // 创建一个发布器,调用advertise通知ROS Master话题名称以及话题类型
    //"topic1" 是话题名
    // 参数 "1" 是queue_size,表示缓冲区大小
    
    std_msgs::Float64 input_float; // 创建一个发布器将要使用的消息变量
    // 该消息定义在: /opt/ros/indigo/share/std_msgs
    // 在ROS中发布的消息都应该提前定义,以便订阅者接收到消息后该如何解读
    // Float64消息的定义如下,其中包含一个数据字段data:
    // float64 data
    
    input_float.data = 0.0; // 设置数据字段
    
    
    // 程序所要做的工作将在下面的循环里完成
    while (ros::ok()) 
    {
        // 该循环没有sleep,因此将一直处于运行状态,不断消耗CPU资源
        input_float.data = input_float.data + 0.001; //每循环一次+0.01
        my_publisher_object.publish(input_float); // 发布消息到对应的话题
        // ++++
        s_timer.sleep(); // 在这里调用sleep函数可以让程序在这里
        // 停止一段时间以便达到要求的发布频率
        // ++++
    }
}

将修改后的发布器重新进行编译,然后按照和上篇文章一样依次运行:

roscore

再打开一个终端,运行

rosrun my_minimal_node my_minimal_publisher # 启动发布器

检查发布频率,运行

rostopic hz /topic1

可以看到此时发布器的发布频率已经基本稳定在1Hz了。然后检查系统监视器的状态:

也同样可以看到此时CPU的占用率已经降下来了。

2. 实现一个订阅器

首先将我们提前修改好的订阅器代码复制到src目录下,代码如下:

#include<ros/ros.h> 
#include<std_msgs/Float64.h> 
void myCallback(const std_msgs::Float64& message_holder) 
{ 
  // 打印出我们接收到的值
  ROS_INFO("received value is: %f",message_holder.data); 
} 

int main(int argc, char **argv) 
{ 
  ros::init(argc,argv,"minimal_subscriber"); //初始化节点
  // 节点名定义为 minimal_subscriber
  ros::NodeHandle n; // 节点句柄,用来创建订阅器
  // 订阅话题'topic1'
  // subscribe中的mycallback是回调函数,每当有新数据到来时,该函数
  // 便会被调用
  // 实际的工作是在回调函数中完成的
  
  ros::Subscriber my_subscriber_object=
      n.subscribe("topic1",1,myCallback); 

  ros::spin(); // 类似于 `while(1)`语句,但是当有新消息到来时,会调用回调函数

  return 0; 
} 

然后和上篇文章一样,为了编译我们刚写的订阅器,我们还需要修改CMakeLists.txt文件,以便让编译器知道应该编译我们新增的文件。类比上篇文章的发布器,我们在CMakeLists.txt文件中加入如下两行:

add_executable(my_minimal_subscriber src/minimal_subscriber .cpp) # 第一个参数是生成后的可执行文件名 第二个参数
# 是源文件路径名
target_link_libraries(my_minimal_subscriber  ${catkin_LIBRARIES}) # 链接库

打开终端,导航到工作区目录下~/catkin_ws,然后执行命令

catkin_make

等待编译完成后,依次执行命令(这些命令都是在不同的终端下输入)

roscore
rosrun my_minimal_node my_minimal_publisher
rosrun my_minimal_node my_minimal_subscriber

然后在订阅器的终端下就可以看出输出

运行命令rosnode list检查节点

最后,可以运行命令

rqt_graph

来显示一个图形化的节点-话题连接图:

由上面的直观展示可以看出,消息由发布器流出到话题topic1然后再流向订阅器。

视频

ROS编写第一个订阅器程序

以上所有过程我录制了一个视频,在浏览文章过程中如果遇到问题,您可以查看视频来看看我是怎么做的。

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

推荐阅读更多精彩内容