【ROS】如何让ROS中节点实现数据交换Ⅱ --服务通信

Halo，这里是Ppeua。平时主要更新C语言，C++，数据结构算法…感兴趣就关注我吧！你定不会失望。
本章将介绍如何通过服务通信的方式实现节点数据交换以及ROS相关指令

0.服务通信概念

在ros中,一个节点想要获取某种服务(例如:一个节点想要获取此时的相机数据，节点就需要向相机发送一个请求，而相机接收到请求后可以根据消息类型将数据类型返回)，这就是基本的服务通信使用场景。

以请求响应的方式实现不同节点间的数据交互

我们现阶段也不需要了解具体这代表什么意思，只需要知道:

client客户端/server服务端先后在rosmaster中注册本身信息,然后通过相同话题匹配.

1. server 与 client 的启动无先后顺序要求
2. server 与 client 都可以有多个
3. server 与 client 连接后不再需要rosmaster,也就是说仅在尝试连接的时候需要rosmaster

1.自定义srv消息

srv消息是服务端与客户端之间通信的一个数据载体,可用数据类型与std_msgs里的数据类型一致,但需要自己定义.

步骤大概为以下几步：

1. 根据需要定义srv格式消息
2. 修改配置文件
3. 编译生成中间文件并引用

1.1定义srv格式消息

这是一个自己定义的srv的消息格式
因为要实现的是两个数相加，所以这样定义。

其中—上方为client客户端发送的消息格式，下方为服务端响应的消息格式。

# 客户端请求
int32 num1
int32 num2
---
# 服务端响应
int32 ans

1.2修改配置文件

1. 和定义msg类似，也要先修改功能包目录下的package.xml,
   
   其中54行的message_generation是编译时的消息软件包
   而59行message_runtime是运行时的消息软件包
2. 在CMakeList中找到这些地方并修改

    # 1.编译时的依赖包
    find_package(catkin REQUIRED COMPONENTS
    rospy
    std_msgs
    message_generation
    )
    # 2.加入自己定义的srv文件名字
    add_service_files(
    FILES
    Addints.srv 
    )
    # 3.编译包时的消息依赖
    generate_messages(
    DEPENDENCIES
    std_msgs
    )
    # 4.加入message_runtime,但官网没有这一步似乎也可以.
    catkin_package(**chmod +x py文件**
    CATKIN_DEPENDS rospy std_msgs message_runtime
    )
   

3. 编译一下,可以在这个路径中找到刚刚编译完的中间件
   之后调用的方法如下：

   # 
   from packagename.srv import * 
   

   至于为什么要import * 我们可以先来看看编译完产生的文件是什么样的：

其产生了一个srv的中间件，出现了三个类，我们之后这三个类都需要使用到，所以一般都是直接import*

2.自定义srv服务通信客户端python实现：

先来分析下作为一个客户端我们需要做什么事：

1. 初始化ros节点
2. 创建请求对象，设置通信话题
3. 请求响应，获得响应结果

import rospy

import lesson3_srv.srv import *

rospy.init_node("sum_client")

client=rospy.ServiceProxy("sum2",Addints)

if(len(sys.argv)!=3):

    rospy.logerr("参数不对")

    sys.exit(1)

num=int(sys.argv[1])

num2=int(sys.argv[2])

response=client.call(num,num2)

rospy.loginfo("%d",response.ans)

这里先导入了rospy的包以及消息类型，初始化了节点信息与话题。

创建了请求服务的对象，serviceprovy（话题，srv消息）

对传入的参数进行了一个处理
clint.call返回类型为自定义消息类型的格式，call（srv中的参数）

最后处理返回的消息

这就是客户端实现，当然还有一些优化内容，等服务端实现完在提

3.自定义srv服务通信服务端python实现：

先来分析下作为一个服务端我们需要做什么事：

1. 初始化节点
2. 设置订阅话题
3. 设置处理消息的回调函数

import rospy

from lesson3_srv.srv import *

def doNum(request):

    num1=request.num1

    num2=request.num2

    sum=num1+num2

    response=AddintsResponse()

    response.ans=sum

    rospy.loginfo("%d %d %d",request.num1,request.num2,response.ans)

    return response

rospy.init_node("sum")

server=rospy.Service("sum2",Addints,doNum)

rospy.spin()

这里先导包

然后通过service(话题名称，srv消息类型，回调函数)创建服务对象

刚刚客户端传入的数据，会作为回调函数的参数

先将其取出，之后通过AddintsResponse的方法创建一个返回对象，改变ans后返回此时的返回值是给了客户端

4.优化客户端

这里的客户端有个很小的问题，仅能在服务器启动后进行通信，若服务器没有启动，而先启动了客户端就会出错，ros官方提供了两个解决方法，二者选其一即可

# rospy.wait_for_service(话题名称)
# client.wait_for_service()

所以改进的客户端代码如下：

import rospy

import sys

from lesson3_srv.srv import *

rospy.init_node("sum_client")

client=rospy.ServiceProxy("sum2",Addints)

if(len(sys.argv)!=3):

    rospy.logerr("参数不对")

    sys.exit(1)

num=int(sys.argv[1])

num2=int(sys.argv[2])

#client.wait_for_service()

rospy.wait_for_service("sum2")

response=client.call(num,num2)

rospy.loginfo("%d",response.ans)

5.启动运行

1. 先添加可执行权限 chmod +x py文件
2. 之后配置一下CMakeList.txt

    catkin_install_python(
        PROGRAMS
    scripts/demo01_server.py
    scripts/demo01_client.py
    DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
    )
   

3.  rosrun lesson3_srv demo01_client.py
    rosrun lesson3_srv demo01_server.py
   

运行效果：传入2 3 返回值为 5

至此服务通信内容结束