【ROS学习】（四）ROS消息传递——std_msgs

ROS中，节点之间通过发布话题和订阅话题来通信，在程序中是通过消息发布器和订阅器来实现，数据流通过话题的发布和订阅在节点之间传播，而数据流的数据类型则称为消息，例如ros入门教程中的节点talker和listener之间通过话题”chatter”来传递数据流，而数据流的具体数据类型则是std_msgs/String。参见http://wiki.ros.org/cn/ROS/Tutorials/WritingPublisherSubscriber%28c%2B%2B%29
教程中只介绍了std_msgs/String消息的发布和接收，但我们经常还需要传递其他类型比如整形，字符型等数据，这些类型的如何传递呢？实际上std_msgs中已经包含了所有的基本数据类型，我们可以rosmsg指令对我们不了解的数据类型进行详细的考察。
打开一个新终端，键入

rosmsg -h

可以看到

rosmsg is a command-line tool for displaying information about ROS Message types.

Commands:
    rosmsg show Show message description
    rosmsg list List all messages
    rosmsg md5  Display message md5sum
    rosmsg package  List messages in a package
    rosmsg packages List packages that contain messages

Type rosmsg <command> -h for more detailed usage

使用

rosmsg list

ros会输出工作空间中已经存在的所有类型消息，我们在其中可以找到std_msg包含的所有消息类型

std_msgs/Bool
std_msgs/Byte
std_msgs/ByteMultiArray
std_msgs/Char
std_msgs/ColorRGBA
std_msgs/Duration
std_msgs/Empty
std_msgs/Float32
std_msgs/Float32MultiArray
std_msgs/Float64
std_msgs/Float64MultiArray
std_msgs/Header
std_msgs/Int16
std_msgs/Int16MultiArray
std_msgs/Int32
std_msgs/Int32MultiArray
std_msgs/Int64
std_msgs/Int64MultiArray
std_msgs/Int8
std_msgs/Int8MultiArray
std_msgs/MultiArrayDimension
std_msgs/MultiArrayLayout
std_msgs/String
std_msgs/Time
std_msgs/UInt16
std_msgs/UInt16MultiArray
std_msgs/UInt32
std_msgs/UInt32MultiArray
std_msgs/UInt64
std_msgs/UInt64MultiArray
std_msgs/UInt8
std_msgs/UInt8MultiArray

再用

rosmsg show std_msgs/Int8

可已看到

int8 data

也就是说，std_msgs/Int8实际上是由一个int8 类型的对象data组成，知道这些信息，我们就能够正确的构造消息发布器和订阅了
要发布一个消息，正确的做法应该是
1.包含相应的头文件
2.定义节点句柄和发布器，要指明发布的数据类型，话题和缓存队列大小
3.定义一个相应数据类型的对象并给其成员赋值
4.发布消息
参考下面代码片段

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

ros::NodeHandle nh;
ros::Publisher pub_int8 = nh.advertise<std_msgs::Int8>("int8", 10);
std_msgs::Int8 msg;
msg.data = 1;
pub_int8.publish(msg);

接收程序类似，也有几点需要注意
1.包含相应的头文件
2.定义节点句柄和订阅器，要指明订阅器订阅的话题，缓存队列大小和回调函数名
3.编写回调函数，回调函数的形参数据类型一定要对应正确的数据类型
4.进入循环

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

void int8Callback(const std_msgs::Int8::ConstPtr& msg)
{
  ...
}
//这里也可以不用指针接收，则对发布的消息进行拷贝，如
//void int8Callback(const std_msgs::Int8 msg)

int main(int argc, char **argv)
{
  ros::init(argc, argv, "int8_sub");
  ros::NodeHandle nh;
  ros::Subscriber sub_int8 = nh.subscribe("int8", 10, int8Callback);
  ros::spin();
  return 0;
}

另外，std_msg下还包含了基本数据类型的向量，我们也可以很方便地传递向量，不过除了上面包含的步骤外，向量的赋值要格外注意，应该使用pushback()函数来填充数据。例如一个double类型向量，应该这样发布

    std_msgs::Float64MultiArray val;

    val.data.push_back(1.0);
    val.data.push_back(2.0);
    val.data.push_back(3.0);
    val.data.push_back(4.0);
    val.data.push_back(5.0);
    val.data.push_back(6.0);

    pub_double.publish(val);