ROS知识（5）----消息与服务的示例

ROS中已经定义了较多的标准类型的消息，你可以用在这些标准类型的消息上再自定义自己的消息类型。这个在复杂数据传输很有用，例如节点和服务器进行交互时，就可能用到传输多个参数到服务器，并返回相应的结果。为了保证例子的完整，将详述每一步。

基本思路和创建talker和listener的例子类似，步骤如下：

  • 建立工作空间workspace（类似于vs下的解决方案，用来管理很多的项目）；
  • 建立包package（类似于vs下的项目）；
  • 创建msg和srv文件；
  • 编写服务节点和客户节点代码；
  • 利用rosmake进行编译（catkin_make也可以，但稍有不同，请参考另一篇博文的ROS知识(3)）；
  • 利用rosrun运行；

1.1、创建工作空间

在开始具体工作之前，首先创建工作空间，并且为工作空间设置环境变量到~/.bashrc中，如果要查看已有的空间路径，可以用查询命令

$ echo $ROS_PACKAGE_PATH

你将会看到如下的信息：

/home/horsetail/dev/rosbook:/home/horsetail/catkin_ws/src:/opt/ros/jade/share:/opt/ros/jade/stacks

这里的创建空间实际上就是先建立一个文件夹，然后把文件夹的路径设置到环境变量~/.bashrc中。例如我们这里创建目录~/dev/rosbook作为工作空间。

首先执行命令：

$ cd ~
$ mkdir -p dev/rosbook

然后将创建的路径加入到环境变量中，执行如下命令：

$ echo "export ROS_PACKAGE_PATH=~/dev/rosbook:${ROS_PACKAGE_PATH}" >> ~/.bashrc
$ . ~/.bashrc

这样，我们就完成了工作空间的配置，注意：ROS安装的时候，一定要把ROS的环境变量也加到~/.bashrc中。这里还需要把ROS。接下来就是在这个空间下创建包了。

1.2、创建包

可以手动创建包，但是非常的繁琐，为了方便，最好使用roscreate-pkg命令行工具，该命令行的格式如下：

roscreate-pkg [package_name] [depend1] [depend2] [depend3] ...

命令行包含了要创建包的名字，依赖包。

我们的例子中，创建一个叫mypacakge1的 新包，命令如下：

$ cd ~/dev/rosbook
$ roscreate-pkg mypackage1 std_msgs roscpp rospy

过一会弹出如下的信息，表示创建成功：

Created package directory /home/horsetail/dev/rosbook/mypackage1
Created include directory /home/horsetail/dev/rosbook/mypackage1/include/mypackage1
Created cpp source directory /home/horsetail/dev/rosbook/mypackage1/src
Created package file /home/horsetail/dev/rosbook/mypackage1/Makefile
Created package file /home/horsetail/dev/rosbook/mypackage1/manifest.xml
Created package file /home/horsetail/dev/rosbook/mypackage1/CMakeLists.txt
Created package file /home/horsetail/dev/rosbook/mypackage1/mainpage.dox

Please edit mypackage1/manifest.xml and mainpage.dox to finish creating your package

好了这样就完成了包的创建，我们发现在mypackage1的目录下有一个src文件夹，我们接下来就是网这里添加源程序了。

1.3、创建msg和srv文件

首先，在mypackage1功能包下，创建msg文件夹，并在其中创建一个新的文件mypackage_msg1.msg，将在这个文件里自定义消息的类型，在文件中添加以下代码：

int32 A
int32 B
int32 C

现在编辑CMakeList.txt，从#rosbuild_genmsg()这一行中删除#，然后使用rosmake命令编译功能包：

$ rosmake mypackage1

为了检查正确性，使用rosmsg命令:

$ rosmsg show mypackage1/mypackage1_msg1

如果看到的内容和文件一样，说明编译正确。

现在新建一个srv文件，在mypackage1文件夹下建立srv文件夹，并在srv文件夹下新建一个文件mypackage1_srv1.srv，并添加以下代码：

int32 A
int32 B
int32 C
---
int32 sum

编辑CMakeList.txt，从#rosbuild_genmsg()这一行中删除#，然后使用rosmake命令编译功能包，可以通过一下命令验证正确性：

$ rossrv show mypackage1/mypackage1_srv1

如果看到的内容和文件一样，说明编译正确。

1.4、编写服务节点和客户节点代码

接下来建立用于验证服务中请求响应的代码，在mypackage1/src下新建文件example_srv_request.cpp，添加如下代码：

#include "ros/ros.h"
#include "mypackage1/mypackage_srv1.h"

bool add(chapter2_tutorials::chapter2_srv1::Request  &req,
         chapter2_tutorials::chapter2_srv1::Response &res)
{
  res.sum = req.A + req.B + req.C;
  ROS_INFO("request: A=%ld, B=%ld C=%ld", (int)req.A, (int)req.B, (int)req.C);
  ROS_INFO("sending back response: [%ld]", (int)res.sum);
  return true;
}

int main(int argc, char **argv)
{
  ros::init(argc, argv, "add_3_ints_server");
  ros::NodeHandle n;

  ros::ServiceServer service = n.advertiseService("add_3_ints", add);
  ROS_INFO("Ready to add 3 ints.");
  ros::spin();

  return 0;
}

在mypackage1/src下新建文件example_srv_respone.cpp，添加如下代码：

#include "ros/ros.h"
#include "mypackage1/mypackage_srv1.h"
#include <cstdlib>

int main(int argc, char **argv)
{
  ros::init(argc, argv, "add_3_ints_client");
  if (argc != 4)
  {
    ROS_INFO("usage: add_3_ints_client A B C ");
    return 1;
  }

  ros::NodeHandle n;
  ros::ServiceClient client = n.serviceClient<chapter2_tutorials::chapter2_srv1>("add_3_ints");
  chapter2_tutorials::chapter2_srv1 srv;
  srv.request.A = atoll(argv[1]);
  srv.request.B = atoll(argv[2]);
  srv.request.C = atoll(argv[3]);
  if (client.call(srv))
  {
    ROS_INFO("Sum: %ld", (long int)srv.response.sum);
  }
  else
  {
    ROS_ERROR("Failed to call service add_two_ints");
    return 1;
  }

  return 0;
}

接下来建立用于验证消息传递的代码，在mypackage1/src下新建文件example_talker_msg.cpp，添加如下代码：

#include "ros/ros.h"
#include "mypackage1/mypackage1_msg1.h"
#include <sstream>

int main(int argc, char **argv)
{
  ros::init(argc, argv, "example_talker_msg");
  ros::NodeHandle n;
  ros::Publisher pub = n.advertise<chapter2_tutorials::chapter2_msg1>("message", 1000);
  ros::Rate loop_rate(10);
  while (ros::ok())
  {
    chapter2_tutorials::chapter2_msg1 msg;
    msg.A = 1;
    msg.B = 2;
    msg.C = 3;
    pub.publish(msg);
    ros::spinOnce();
    loop_rate.sleep();
  }
  return 0;
}

在mypackage1/src下新建文件example_listener_msg.cpp，添加如下代码：

#include "ros/ros.h"
#include "mypackage1/mypackage1_msg1.h"

void messageCallback(const chapter2_tutorials::chapter2_msg1::ConstPtr& msg)
{
  ROS_INFO("I heard: [%d] [%d] [%d]", msg->A, msg->B, msg->C);
}

int main(int argc, char **argv)
{
  ros::init(argc, argv, "example_listener_msg");
  ros::NodeHandle n;
  ros::Subscriber sub = n.subscribe("message", 1000, messageCallback);
  ros::spin();
  return 0;
}

好了，至此完成了服务和消息的测试代码编写。

1.5、利用rosmake进行编译

接下来，要告诉编译器如何去找到这两个文件。你需要打开mypackage1/CMakeLists.txt，在文件的末尾添加两行命令：

rosbuild_add_executable(example_srv_request src/example_srv_request.cpp)
rosbuild_add_executable(example_srv_respone src/example_srv_respone.cpp)
rosbuild_add_executable(example_talker_msg src/example_talker_msg.cpp)
rosbuild_add_executable(example_listener_msg src/example_listener_msg.cpp)

添加后的文件结构是这样的：

cmake_minimum_required(VERSION 2.4.6)
include($ENV{ROS_ROOT}/core/rosbuild/rosbuild.cmake)

# Set the build type.  Options are:
#  Coverage       : w/ debug symbols, w/o optimization, w/ code-coverage
#  Debug          : w/ debug symbols, w/o optimization
#  Release        : w/o debug symbols, w/ optimization
#  RelWithDebInfo : w/ debug symbols, w/ optimization
#  MinSizeRel     : w/o debug symbols, w/ optimization, stripped binaries
#set(ROS_BUILD_TYPE RelWithDebInfo)

rosbuild_init()

#set the default path for built executables to the "bin" directory
set(EXECUTABLE_OUTPUT_PATH ${PROJECT_SOURCE_DIR}/bin)
#set the default path for built libraries to the "lib" directory
set(LIBRARY_OUTPUT_PATH ${PROJECT_SOURCE_DIR}/lib)

#uncomment if you have defined messages
rosbuild_genmsg()
#uncomment if you have defined services
rosbuild_gensrv()

#common commands for building c++ executables and libraries

rosbuild_add_executable(example_srv_request src/example_srv_request.cpp)
rosbuild_add_executable(example_srv_respone src/example_srv_respone.cpp)
rosbuild_add_executable(example_talker_msg src/example_talker_msg.cpp)
rosbuild_add_executable(example_listener_msg src/example_listener_msg.cpp)

这样用rosmake命令来编译这个mypackage1包了。执行下面的命令：

$ rosmake mypackage1

输出下面的信息：

[email protected]:~$ roscore
... logging to /home/horsetail/.ros/log/6eae5b9c-628d-11e5-8bd7-3859f9722953/roslaunch-horsetail-book-6447.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://horsetail-book:44362/
ros_comm version 1.11.13

SUMMARY
========

PARAMETERS
 * /rosdistro: jade
 * /rosversion: 1.11.13

NODES

auto-starting new master
process[master]: started with pid [6459]
ROS_MASTER_URI=http://horsetail-book:11311/
...(内容太长了，省去)
[ rosmake ] Results:
[ rosmake ] Built 26 packages with 0 failures.
[ rosmake ] Summary output to directory
[ rosmake ] /home/horsetail/.ros/rosmake/rosmake_output-20150924-164014

哇，编译通过，大家注意到实际上也是用catkin进行编译的，额。我们来运行一下吧。

1.4、运行

首先打开一个新的终端，启动初始化ROS，执行命令：

$ roscore

先验证一下服务请求和相应的功能，需要在不同窗口分别执行以下命令：

rosrun mypackage1 example_talker_msg
rosrun mypackage1 example_listener_msg

可以看到请求listener的窗口，显示如下信息：

[ INFO] [1443154332.742277621]: I heard:[1][2][3]
[ INFO] [1443164722.557755739]: I heard:[1][2][3]
[ INFO] [1443164744.557858055]: I heard:[1][2][3]

好了至此完成了服务srv和消息msg的验证。

1.5、源码

最后，附上源码：mypackage1.tar.gz（这个是ROS机器人程序设计中第二章的例子，里面包含了消息和服务等例子）

参考资料

[1]. Aaron Martinez Enrique Fern andez, ROS机器人程序设计[B], P14-42, 2014.

时间： 2024-10-07 19:19:10

ROS知识（5）----消息与服务的示例的相关文章

ros wiki翻译之创建消息和服务

描述:本教程介绍如何创建和构建msg和srv文件以及rosmsg,rossrv和roscp命令行工具. 1 msg和srv简介 msg:msg文件是描述ROS消息字段的简单文本文件.它们用于为不同语言(c++或者python等)的消息生成源代码. srv:srv文件用来描述服务.它由两部分组成:请求(request)和响应(response). msg文件存储在包的msg目录中,而srv文件存储在srv目录中. msg只是简单的文本文件,每行有一个字段类型和字段名称.您可以使用的字段类型有(如同

ROS知识（2）-理解ROS系统结构

ROS系统的架构主要被设计和划分成三部分,没一部分都代表一个层级的概念: 文件系统级(FileSystem Level) 计算图级(Computaion Graph Levell) 开源社区级(Community Level) 第一级是文件系统级.你将会使用这一组概念来理解ROS的内部构成,文件夹结构,以及工作所需要的核心文件. 第二级是计算图级,体现的是进程和系统之间的通信.你将会看到ROS各个概念和功能,包括建立系统,处理各类进程,与多台计算机通信等. 第三级是开源社区级.这个层级是非常重要

2.OpenStack-安装消息队列服务

安装消息队列服务(安装在控制器上) yum install rabbitmq-server -y systemctl start mariadb.service 配置消息队列服务 systemctl enable rabbitmq-server.service systemctl restart rabbitmq-server.service 修改密码 rabbitmqctl change_password guest Abcd1234 Creating user "openstack"

C#中使用消息队列服务

C#中使用Windows消息队列服务 http://www.cnblogs.com/xinhaijulan/archive/2010/08/22/1805768.html http://h2appy.blog.51cto.com/609721/184323 http://www.cnblogs.com/isdavid/archive/2012/08/16/2642867.html http://www.cnblogs.com/beniao/archive/2008/06/26/1229934.h

浅析腾讯云分布式高可靠消息队列服务CMQ架构

在分布式大行其道的今天,我们在系统内部.平台之间广泛运用消息中间件进行数据交换及解耦.CMQ是腾讯云内部自研基于的高可靠.强一致.可扩展分布式消息队列,在腾讯内部包括微信手机QQ业务红包.腾讯话费充值.广告订单等都有广泛使用.目前已上线腾讯云对外开放,本文对腾讯云CMQ核心技术原理进行分享介绍. CMQ消息队列主要适用于金融.交易.订单等对可靠性.可用性有较高要求的业务场景. 以腾讯充值系统为例,该充值系统通过CMQ 对交易模块.发货部分.结算系统进行异步解耦.削峰填谷,一方面大大降低了模块间耦

NoSQL初探之人人都爱Redis：（3）使用Redis作为消息队列服务场景应用案例

一.消息队列场景简介 “消息”是在两台计算机间传送的数据单位.消息可以非常简单,例如只包含文本字符串:也可以更复杂,可能包含嵌入对象.消息被发送到队列中,“消息队列”是在消息的传输过程中保存消息的容器. 在目前广泛的Web应用中,都会出现一种场景:在某一个时刻,网站会迎来一个用户请求的高峰期(比如:淘宝的双十一购物狂欢节,12306的春运抢票节等),一般的设计中,用户的请求都会被直接写入数据库或文件中,在高并发的情形下会对数据库服务器或文件服务器造成巨大的压力,同时呢,也使响应延迟加剧.这也说明

[Python]webservice学习(2) --自己写soap消息请求服务

上文中webservice学习(1) ,使用soaplib建立了一个超简单的webservice服务,也是用suds调用成功了,那如果想使用http包自己组成一个soap消息来调用接口怎么办呢? 这个时候我们就想到使用wsdl这个文件了,我看了些wsdl的文档,也参照这其他人使用java,php等语言实现的soap消息调用的格式来写,但是怎么调试都没成功.. 就是说他总是会返回500或者是405各种错误,就是下面代码中的old_soap_body 变量中的消息格式. #coding: utf-8

[email&#160;protected] $location.path(&#39;/login&#39;)-$location服务用法示例

$httpProvider interceptor .factory('auth403', ['$rootScope', '$q', '$location', function auth403($rootScope, $q, $location) { return { request: function (config) { console.log(config); var start = new Date(); return config; }, response: function (res

简单消息队列服务 HTTPSQS

HTTPSQS(HTTP?Simple?Queue?Service)是一款基于 HTTP GET/POST 协议的轻量级开源简单消息队列服务,使用 Tokyo Cabinet 的 B+Tree Key/Value 数据库来做数据的持久化存储. 队列(Queue)又称先进先出表(First In First Out),即先进入队列的元素,先从队列中取出.加入元素的一头叫"队头",取出元素的一头叫"队尾".利用消息队列可以很好地异步处理数据传送和存储,当你频繁地向数据库