service 通讯与自定义 srv 类型

引言

ROS node 之间的通讯形式主要包括两种:topic 和 service。

通过 topic 通讯时,不同的 node 可以向同一个 topic 上发送、接收数据,发送数据的 node 不知道数据是从哪个 node 发送过来的,同样地,发送数据的 node 也不知道是哪个 node 接收了数据。因此,每个 node 都是相对独立的,只需要负责自己的功能实现以及外部接口,不需要关心其他 node 的行为。这是一种开放式的收、发数据的方式,也是 node 之间通讯的主要形式,有利于构造分布式大系统。

service 则是一种请求+反馈的通信机制。消息的传输只涉及两个 node:发送请求的一方称为 client,提供服务的一方叫做 server。在通过 service 形式进行通讯时,client 首先向 server 请求服务, 收到消息之后 server 运行事先设置好的服务功能,并返回消息给 client。service 通讯一般用在事件触发情景中,例如满足某个条件就令 node 开启某项功能,并希望确认功能确实顺利开启。

本文通过实例介绍如何创建 srv 文件,这个很像 msg 文件,只不过格式中包括 request 和 response 两部分内容。然后介绍如何通过 roscpp 和 rospy 构造 client 和 server 节点。

具体的,我们希望创建一个 server 节点,可以接受外界请求,请求内容包括 name 和 age,然后 server 提供的服务就是显示问候信息。

创建 Greeting.srv

我们知道 node 通过 topic 进行通讯时需要借助 msg 作为数据传输的载体,同样的,service 通讯时也需要借助某种数据载体,这里就是 srv 。ROS 自带了很多 srv 类型,基本可以满足常见的 service 通讯需求。不过,这里为了比较全面地介绍 service 通讯过程,我们自己创建一个 srv,并在 service 通讯中使用它。

首先创建一个 srv 名为 Greeting.srv。一般将自定义的 msg 文件存放在 <package>/msg 文件夹中,srv 文件存放在 <package>/srv 文件夹中。这里我们利用之前创建的一个 package,名字是 agitr。在 agitr/srv 中创建Greeting.srv文件,内容如下:

string name    
int32 age   
---
string feedback

其中,短线上边是 request 内容,就是 client 传递给 server 的消息,下边是 response 内容,就是 server 反馈给 client 的消息。

创建完 srv 文件之后,需要进行编译。实际上,编译 srv 与编译 msg 时的设置几乎是完全相同的,原本修改 msg 的地方,现在就修改 srv。

CmakeLists.txt 文件中修改如下

find_package(catkin REQUIRED COMPONENTS message_generation)

add_service_files(FILES Greeting.srv)

package.xml 中的修改

  <build_depend>message_generation</build_depend>
  <exec_depend>message_runtime</exec_depend>

修改完成后回到工作空间,进行编译。编译成功后就可以像 ROS 自带的 srv 类型一样使用了。

利用 roscpp 编写 server node

在 agitr/src 目录下创建 c++ 源文件 server.cpp,内容如下:

#include <ros/ros.h>
#include <agitr/Greeting.h>
bool handle_function(agitr::Greeting::Request &req, agitr::Greeting::Response &res){ 
    ROS_INFO("Request from %s with age %d", req.name.c_str(), req.age);
    res.feedback = "Hi" + req.name + ". I’m server!";
    return true;
}
int main(int argc, char** argv){
    ros::init(argc,argv, "greetings_server");
    ros::NodeHandle nh; 
    ros::ServiceServer service = nh.advertiseService("greetings", handle_function);
    ros::spin();
    return 0;
}

在以上代码中,服务的处理操作都在 handle_function() 中,它的输入参数就是 Greeting.srv 中的RequestResponse 两部分。通常在处理函数中,我们对 Request 部分的数据进行相应的服务操作,然后将结果写入到 Response 中。处理函数返回值是 bool 类型,表征服务是否成功执行。

编写完 c++ 源文件之后还要对 CmakeLists.txt 文件和 package.xml 文件做相应修改,然后编译。

下面介绍如何用 rospy 实现上述同样的 server node.

利用 rospy 编写 server node

将创建的 python 文件存放在路径为 agitr/scripts 目录下,命名为 server.py,内容如下:

#!/usr/bin/env  python
#coding=utf-8
import rospy
from agitr.srv import *
def server_srv():
# 初始化节点,命名为"greetings_server"
    rospy.init_node("greetings_server")
    #定义service的server端,service名称为"greetings",service类型为Greeting
    #收到的request请求信息将作为参数传递给handle_function进行处理
    s = rospy.Service("greetings", Greeting, handle_function)
    rospy.loginfo("Ready to handle the request:")
    rospy.spin()
def handle_function(req):
    rospy.loginfo( 'Request from %s with age %d', req.name,,req.age)
    return GreetingResponse("Hi  %s. I' server!"%req.name)
if __name__=="__main__":
     server_srv()

这里 server 端的处理函数有区别: C++ 的handle_function() 传入的参数是整个 srv 对象的 requestresponse 两部分,返回值是 bool 型,显示这次服务是否成功的处理,即:

bool    handle_function(agitr::Greeting::Request    &req,agitr::Greeting::Response &res){
...
    return true;
}

而 Python 的 handle_function() 传入的只有 request,返回值是 response,即:

def handle_function(req):
    ...
return GreetingResponse("Hi %s. I'am server!"%req.name)

利用 rospy 编写 client node

将创建的文件存放在 agitr/scripts 目录下,命名为 client.py,内容如下:

#!/usr/bin/env  python
#coding:utf-8
import rospy
from agitr.srv import *
def client_srv():
    rospy.init_node('greetings_client')
    #   等待有可用的服务"greetings"
    rospy.wait_for_service("greetings")
    try:
 # 定义service客户端,service 名称为 “greetings”,service 类型为 Greeting
        greetings_client = rospy.ServiceProxy("greetings",Greeting)
 # 向server端发送请求,发送的request内容为 name 和 age,其值分别为 "HAN", 20
 # 此处发送的 request 内容与 srv 文件中定义的 request 部分的属性是一致的
        #resp = greetings_client("HAN",20)
        resp = greetings_client.call("HAN",20)
        rospy.loginfo("Message From server:%s"%resp.feedback)
    except rospy.ServiceException, e:
        rospy.logwarn("Service call failed: %s"%e)

if __name__=="__main__": 
     client_srv()

以上代码中 greetings_client.call("HAN",20) 等同于 greetings_client("HAN",20)

至此就创建了 server.pyclient.py 两个 python 文件,python 文件不需要编译,但是要将它们设置为可执行文件,操作如下:

chmod +x server.py
chmod +x client.py

最后测试一下效果,启动 server 和 client 两个 ROS node,显示结果如下:


2019-03-23 22-03-33屏幕截图.png

Written by SH
Revised by QP

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 214,504评论 6 496
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 91,434评论 3 389
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 160,089评论 0 349
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 57,378评论 1 288
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 66,472评论 6 386
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 50,506评论 1 292
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 39,519评论 3 413
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 38,292评论 0 270
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 44,738评论 1 307
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,022评论 2 329
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,194评论 1 342
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 34,873评论 5 338
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 40,536评论 3 322
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,162评论 0 21
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,413评论 1 268
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 47,075评论 2 365
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,080评论 2 352

推荐阅读更多精彩内容