本文为原创博客，转载请注明出处：https://blog.csdn.net/q_z_r_s

开源地址：点击该链接

参考自:http://wiki.ros.org/ROS/Tutorials
【Beginner Level】ROS入门教程(一)
【Beginner Level】ROS入门教程(二)
【Beginner Level】ROS入门教程(三)
【Beginner Level】ROS入门教程(四)
【Beginner Level】ROS入门教程(五)

【Beginner Level】ROS入门教程(三)
11 简单的Publisher和Subscriber
本节设计如何使用C++写一个publisher和subscriber

11.1 写Publisher Nodes
Node是ROS的术语, 表示连接到ROS network的可执行程序. 接下来创建一个publisher("talker")节点, 此节点将持续的广播消息.

#进入beginner_tutorials package目录中
roscd beginner_tutorials
#创建src目录, 此目录存放所有的源代码
mkdir -p src

//talker.cpp
#include "ros/ros.h"
#include "std_msgs/String.h"
#include <sstream>
//此程序演示简单的ROS系统消息发送
int main(int argc, char **argv)
{
  //使用ROS系统任何部分之前, 必须先调用ros::init()
  //ros::init接收argc和argv参数, 这样它就可以从命令行接收任何ROS参数了; 第三个参数是`节点的名字`
  ros::init(argc, argv, "talker");
  //NodeHandle是与ROS系统通信的主要访问点. 第一个被构造的NodeHandle将完全初始化此节点
  //最后一个被析构的NodeHandle将关闭此节点
  ros::NodeHandle n;
  //advertise()函数告诉ROS你要如何在给定的topic名上发布, 这会引发对ROS master node的调用
  //master node管理谁在publishing和谁在subscribing, 调用advertise()之后, master node
  //将通知subscribe此topic name的节点, 然后它们将进行一对一的协商(negotiate).
  //advertise()返回一个Publisher对象, 可以通过调用publish()在此topic上publish messages
  //一旦所有被返回的Publisher对象被销毁, 此topic将自动unadvertised
  //advertise()的第二个参数为用来发布消息的message queue的大小, 如果messages发布的比
  //能发送的快, 此参数就表示缓存多少信息后开始舍弃多余的信息
  ros::Publisher chatter_pub = n.advertise<std_msgs::String>("chatter", 1000);
  //printf/cout的替代
  ros::Rate loop_rate(10);
  int count = 0;
  while (ros::ok())
  {
    //message对象, 用数据填充它, 然后发布  
    std_msgs::String msg;
    std::stringstream ss;
    ss << "hello world " << count;
    msg.data = ss.str();
    ROS_INFO("%s", msg.data.c_str());
    //publish()发送messages, 参数为message对象. 参数类型必须与模板函数advertise<>()的
     //一致模板参数
    chatter_pub.publish(msg);
    ros::spinOnce();
    loop_rate.sleep();
    ++count;
  }
  return 0;
}

11.2 写Subscriber Node

//listener.cpp
#include "ros/ros.h"
#include "std_msgs/String.h"
//此示例展示接收message
void chatterCallback(const std_msgs::String::ConstPtr& msg)
{
  ROS_INFO("I heard: [%s]", msg->data.c_str());
}

int main(int argc, char **argv)
{
  //同上
  ros::init(argc, argv, "listener");
  //同上
  ros::NodeHandle n;
  //前两个参数类似Publisher, 最后一个参数表示, 收到message后, 被调用的函数
  ros::Subscriber sub = n.subscribe("chatter", 1000, chatterCallback);
  //ros::spin()进入循环, 调用回调函数. 它在遇到 Ctrl-C 或 master 关闭此节点时退出.  
  ros::spin();

  return 0;
}

11.3 编写CMakeLists.txt

cmake_minimum_required(VERSION 2.8.3)
project(beginner_tutorials)

## Find catkin and any catkin packages
find_package(catkin REQUIRED COMPONENTS roscpp rospy std_msgs genmsg)

## Declare ROS messages and services
add_message_files(FILES Num.msg)
add_service_files(FILES AddTwoInts.srv)

## Generate added messages and services
generate_messages(DEPENDENCIES std_msgs)

## Declare a catkin package
catkin_package()

## Build talker and listener
include_directories(include ${catkin_INCLUDE_DIRS})

add_executable(talker src/talker.cpp)
target_link_libraries(talker ${catkin_LIBRARIES})
add_dependencies(talker beginner_tutorials_generate_messages_cpp)

add_executable(listener src/listener.cpp)
target_link_libraries(listener ${catkin_LIBRARIES})
add_dependencies(listener beginner_tutorials_generate_messages_cpp)

talker和listener默认生成在~/catkin_ws/devel/lib/<package name>路径下.

13 测试Publisher和Subscriber
运行Publisher: rosrun beginner_tutorials talker

运行Subscriber: rosrun beginner_tutorials listener