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指令对我们不了解的数据类型进行详细的考察。
打开一个新终端，键入

1
rosmsg -h

可以看到

1
2
3
4
5
6
7
8
9
10
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

使用

1
rosmsg list

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

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
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

再用

1
rosmsg show std_msgs/Int8

可已看到

1
int8 data

也就是说，std_msgs/Int8实际上是由一个int8 类型的对象data组成，知道这些信息，我们就能够正确的构造消息发布器和订阅了

发布接收消息参考示例

要发布一个消息，正确的做法应该是
1.包含相应的头文件
2.定义节点句柄和发布器，要指明发布的数据类型，话题和缓存队列大小
3.定义一个相应数据类型的对象并给其成员赋值
4.发布消息
参考下面代码片段

1
2
3
4
5
6
7
8
#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.进入循环

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
#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类型向量，应该这样发布

1
2
3
4
5
6
7
8
9
10
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);