ros_tutorials
  • 简介
  • 1 安装并配置ROS环境
    • 1.1 安装ROS
    • 1.2 管理环境变量
    • 1.3 创建ROS工作空间
  • 2 ROS文件系统介绍
    • 2.1 快速了解文件系统概念
    • 2.2 文件系统工具
    • 2.3 回顾
  • 3 创建ROS程序包(Packages)
    • 3.1 catkin程序包由什么组成?
    • 3.2 在catkin工作空间中的程序包
    • 3.3 创建一个catkin程序包
    • 3.4 编译程序包
    • 3.5 程序包依赖关系
    • 3.6 自定义你的程序包
  • 4 编译ROS程序包(packages)
    • 4.1 使用 catkin_make
    • 4.2 编译你的程序包Package
  • 5 理解ROS节点(nodes)
    • 5.1 图(Graph)概念
    • 5.2 节点(Nodes)
    • 5.3 客户端库(Client Libraries)
    • 5.4 roscore
    • 5.5 使用rosnode
    • 5.6 使用rosrun
    • 5.7 回顾
  • 6 理解ROS话题(topics)
    • 6.1 开始
    • 6.2 ros topics
    • 6.3 ROS Messages
    • 6.4 继续学习 rostopic
    • 6.5 使用 rqt_plot
  • 7 理解ROS服务和参数
    • 7.1 ROS Services
    • 7.2 使用rosservice
    • 7.3 使用 rosparam
  • 8 使用 rqt_console 和 roslaunch
    • 8.1 预先安装rqt和turtlesim程序包
    • 8.2 使用rqt_console和rqt_logger_level
  • 9 使用rosed编辑ROS中的文件
    • 9.1 使用 rosed
    • 9.2 使用Tab键补全文件名
    • 9.3编辑器
  • 10 创建ROS消息和ROS服务
    • 10.1 消息(msg)和服务(srv)介绍
    • 10.2 使用 msg
    • 10.3 使用 srv
    • 10.4 msg和srv都需要的步骤
    • 10.5 获得帮助
    • 10.6 回顾
  • 11 编写简单的Publisher和Subscriber(C++)
    • 11.1 编写Publisher Node
    • 11.2 编写Subscriber Node
    • 11.3 编译nodes
  • 12 编写简单的Publisher和Subscriber(Python)
    • 12.1 编写Publisher Node
    • 12.2 编写Subscriber Node
    • 12.3 编译nodes
  • 13 测试消息Publisher和Subscriber
    • 13.1 启动发布器(Publisher)
    • 13.2 启动订阅器(Subscriber)
  • 14 编写简单的Service和Client (C++)
    • 14.1 编写Service节点
    • 14.2 编写Client节点
    • 14.3 编译nodes
  • 15 编写简单的Service和Client (Python)
    • 15.1 编写Service Node
    • 15.2 编写Client节点
    • 15.3 编译nodes
    • 15.4 试试看
  • 16 测试简单的Service和Client
    • 16.1 运行Service
    • 16.2 运行Client
    • 16.3 关于Service和Client节点的更多例子
  • 17 录制与回放数据
    • 17.1 录制数据(通过创建一个bag文件)
    • 17.2 检查并回放bag文件
    • 17.3 录制数据子集
    • 17.4 rosbag record/play 命令的局限性
  • 18 roswtf入门
    • 18.1 安装检查
    • 18.2 运行时检查(在有ROS节点运行时)
    • 18.3 错误报告
  • 19 探索ROS维基
    • 19.1 基础
    • 19.2 高级
  • 20 接下来做什么
    • 20.1 使用模拟器
    • 20.2 使用 RViz
    • 20.3 理解 TF
    • 20.4 更进一步
Powered by GitBook
On this page
  • 11.1.1 源代码
  • 11.1.2 代码说明
  1. 11 编写简单的Publisher和Subscriber(C++)

11.1 编写Publisher Node

节点(Node) 是指 ROS 网络中可执行文件。接下来,我们将会创建一个发布器节点("talker"),它将不断的在 ROS 网络中广播消息。

切换到之前创建的 beginner_tutorials package 路径下:

$ roscd beginner_tutorials

11.1.1 源代码

在 beginner_tutorials package 路径下创建一个src文件夹:

$ mkdir -p ~/catkin_ws/src/beginner_tutorials/src

这个文件夹将会用来放置 beginner_tutorials package 的所有源代码。 在 beginner_tutorials package 里创建 src/talker.cpp 文件,并将如下代码粘贴到文件内:

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

#include <sstream>

/**
 * This tutorial demonstrates simple sending of messages over the ROS system.
 */
int main(int argc, char **argv)
{
  /**
   * The ros::init() function needs to see argc and argv so that it can perform
   * any ROS arguments and name remapping that were provided at the command line. For programmatic
   * remappings you can use a different version of init() which takes remappings
   * directly, but for most command-line programs, passing argc and argv is the easiest
   * way to do it.  The third argument to init() is the name of the node.
   *
   * You must call one of the versions of ros::init() before using any other
   * part of the ROS system.
   */
  ros::init(argc, argv, "talker");

  /**
   * NodeHandle is the main access point to communications with the ROS system.
   * The first NodeHandle constructed will fully initialize this node, and the last
   * NodeHandle destructed will close down the node.
   */
  ros::NodeHandle n;

  /**
   * The advertise() function is how you tell ROS that you want to
   * publish on a given topic name. This invokes a call to the ROS
   * master node, which keeps a registry of who is publishing and who
   * is subscribing. After this advertise() call is made, the master
   * node will notify anyone who is trying to subscribe to this topic name,
   * and they will in turn negotiate a peer-to-peer connection with this
   * node.  advertise() returns a Publisher object which allows you to
   * publish messages on that topic through a call to publish().  Once
   * all copies of the returned Publisher object are destroyed, the topic
   * will be automatically unadvertised.
   *
   * The second parameter to advertise() is the size of the message queue
   * used for publishing messages.  If messages are published more quickly
   * than we can send them, the number here specifies how many messages to
   * buffer up before throwing some away.
   */
  ros::Publisher chatter_pub = n.advertise<std_msgs::String>("chatter", 1000);

  ros::Rate loop_rate(10);

  /**
   * A count of how many messages we have sent. This is used to create
   * a unique string for each message.
   */
  int count = 0;
  while (ros::ok())
  {
    /**
     * This is a message object. You stuff it with data, and then publish it.
     */
    std_msgs::String msg;

    std::stringstream ss;
    ss << "hello world " << count;
    msg.data = ss.str();

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

    /**
     * The publish() function is how you send messages. The parameter
     * is the message object. The type of this object must agree with the type
     * given as a template parameter to the advertise<>() call, as was done
     * in the constructor above.
     */
    chatter_pub.publish(msg);

    ros::spinOnce();

    loop_rate.sleep();
    ++count;
  }


  return 0;
}

11.1.2 代码说明

现在,我们来分段解释代码。

#include "ros/ros.h"

ros/ros.h 是一个实用的头文件,它引用了 ROS 系统中大部分常用的头文件。

#include "std_msgs/String.h"
ros::init(argc, argv, "talker");

初始化 ROS 。它允许 ROS 通过命令行进行名称重映射——然而这并不是现在讨论的重点。在这里,我们也可以指定节点的名称——运行过程中,节点的名称必须唯一。

ros::NodeHandle n;

为这个进程的节点创建一个句柄。第一个创建的 NodeHandle会为节点进行初始化,最后一个销毁的 NodeHandle 则会释放该节点所占用的所有资源。

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

NodeHandle::advertise()返回一个 ros::Publisher 对象,它有两个作用:.

  1. 它有一个 publish()成员函数可以让你在topic上发布消息;

  2. 如果消息类型不对,它会拒绝发布。

ros::Rate loop_rate(10);

ros::Rate 对象可以允许你指定自循环的频率。它会追踪记录自上一次调用 Rate::sleep() 后时间的流逝,并休眠直到一个频率周期的时间。 在这个例子中,我们让它以 10Hz 的频率运行。

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

roscpp会默认生成一个 SIGINT 句柄,它负责处理 Ctrl-C键盘操作——使得 ros::ok() 返回 false。

如果下列条件之一发生,ros::ok() 返回false:

  • SIGINT 被触发 (Ctrl-C)

  • 被另一同名节点踢出 ROS 网络

  • ros::shutdown() 被程序的另一部分调用

  • 一旦 ros::ok() 返回 false, 所有的 ROS 调用都会失效。

    std_msgs::String msg;    std::stringstream ss;    ss << "hello world " << count;    msg.data = ss.str();
chatter_pub.publish(msg);

这里,我们向所有订阅 chatter 话题的节点发送消息。

ROS_INFO("%s", msg.data.c_str());
ros::spinOnce();

在这个例子中并不是一定要调用 ros::spinOnce(),因为我们不接受回调。然而,如果你的程序里包含其他回调函数,最好在这里加上 ros::spinOnce()这一语句,否则你的回调函数就永远也不会被调用了。

loop_rate.sleep();

这条语句是调用 ros::Rate 对象来休眠一段时间以使得发布频率为 10Hz。

对上边的程序进行一下总结:

  • 初始化 ROS 系统

  • 以每秒 10 次的频率在 chatter 上发布消息

    接下来我们要编写一个节点来接收这个消息。

Previous11 编写简单的Publisher和Subscriber(C++)Next11.2 编写Subscriber Node

Last updated 7 years ago

这引用了 消息, 它存放在 package 里,是由 String.msg 文件自动生成的头文件。需要关于消息的定义,可以参考 页面。

告诉 master 我们将要在 chatter(话题名) 上发布 消息类型的消息。这样 master 就会告诉所有订阅了 chatter 话题的节点,将要有数据发布。第二个参数是发布序列的大小。如果我们发布的消息的频率太高,缓冲区中的消息在大于 1000 个的时候就会开始丢弃先前发布的消息。

节点中的所有 ros:: 都已经被销毁

我们使用一个由 文件产生的『消息自适应』类在 ROS 网络中广播消息。现在我们使用标准的String消息,它只有一个数据成员"data"。当然,你也可以发布更复杂的消息类型。

ROS_INFO和其他类似的函数可以用来代替 printf/cout 等函数。具体可以参考 ,以获得更多信息。

在 ROS 网络内广播我们将要在 chatter 话题上发布 类型的消息

std_msgs/String
std_msgs
msg
std_msgs/String
NodeHandles
msg file
rosconsole documentation
std_msgs/String