ros学习15--Writing Service Client(python) （编写简单的服务和客户端（Python））

本文系统配置ubuntu20.04+ros1，是初学者按照ros官网初级教程学习记录，仅作个人学习记录，如有问题可联系本文作者。

附上ros1官网学习教程链接Documentation - ROS Wikihttps://wiki.ros.org/ros2官网学习教程链接Project Governance — ROS 2 Documentation: Rolling documentationhttps://docs.ros.org/en/rolling/The-ROS2-Project/Governance.html

一、编写服务节点

这里，我们将创建简单的服务（Service）节点add_two_ints_server，该节点将接收两个整数，并返回它们的和。

将当前目录切换到之前的教程中创建的beginner_tutorials包中：

输入

$ cd ~/catkin_ws
$ source devel/setup.bash
$ roscd beginner_tutorials

请确保你已经按照之前教程中的指示创建了本教程中需要的服务AddTwoInts.srv。（确保在页面顶部选对了所使用的构建工具）

1.1代码

在beginner_tutorials包中创建scripts/add_two_ints_server.py文件并粘贴以下内容进去：

输入

$ cd scripts

$  gedit add_two_ints_server.py
 

切换行号显示

#!/usr/bin/env python

from __future__ import print_function

from beginner_tutorials.srv import AddTwoInts,AddTwoIntsResponse
import rospy

def handle_add_two_ints(req):
    print("Returning [%s + %s = %s]"%(req.a, req.b, (req.a + req.b)))
    return AddTwoIntsResponse(req.a + req.b)

def add_two_ints_server():
    rospy.init_node('add_two_ints_server')
    s = rospy.Service('add_two_ints', AddTwoInts, handle_add_two_ints)
    print("Ready to add two ints.")
    rospy.spin()

if __name__ == "__main__":
    add_two_ints_server()

别忘了给节点执行权限：

• chmod +x scripts/add_two_ints_server.py

然后将以下内容添加到CMakeLists.txt文件。这样可以确保正确安装Python脚本，并使用合适的Python解释器。

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

以上内容直接粘贴到文件末尾。

1.2解释

现在，让我们把代码分解。

使用rospy编写服务的难度非常小。我们使用init_node()声明我们的节点，然后再声明我们的服务：

切换行号显示

  12     s = rospy.Service('add_two_ints', AddTwoInts, handle_add_two_ints)

这声明了一个名为add_two_ints的新服务，其服务类型为AddTwoInts。所有的请求（request）都传递给了handle_add_two_ints函数。handle_add_two_ints被AddTwoIntsRequest的实例调用，返回AddTwoIntsResponse实例。

就像订阅者中的例子一样，rospy.spin()可以防止代码在服务关闭之前退出。

二、编写客户端节点

2.1代码

在beginner_tutorials包中创建scripts/add_two_ints_client.py文件并粘贴以下内容进去：

输入

$ cd scripts

$  gedit add_two_ints_client.py

切换行号显示

#!/usr/bin/env python

from __future__ import print_function

import sys
import rospy
from beginner_tutorials.srv import *

def add_two_ints_client(x, y):
    rospy.wait_for_service('add_two_ints')
    try:
        add_two_ints = rospy.ServiceProxy('add_two_ints', AddTwoInts)
        resp1 = add_two_ints(x, y)
        return resp1.sum
    except rospy.ServiceException as e:
        print("Service call failed: %s"%e)

def usage():
    return "%s [x y]"%sys.argv[0]

if __name__ == "__main__":
    if len(sys.argv) == 3:
        x = int(sys.argv[1])
        y = int(sys.argv[2])
    else:
        print(usage())
        sys.exit(1)
    print("Requesting %s+%s"%(x, y))
    print("%s + %s = %s"%(x, y, add_two_ints_client(x, y)))

别忘了给节点执行权限：

$ chmod +x scripts/add_two_ints_client.py

(貌似没有影响，在前面的教程中没有使用但是结果正常，本文作者暂不使用）

然后，在你的CMakeLists.txt中编辑catkin_install_python()调用，就像这样：

catkin_install_python(PROGRAMS scripts/add_two_ints_server.py scripts/add_two_ints_client.py
  DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION}
)

以上内容直接粘贴到文件末尾。

 

2.2解释

现在，让我们把代码分解。

客户端（用来调用服务）的代码也很简单。对于客户端来说不需要调用init_node()。我们首先调用：

切换行号显示

  10     rospy.wait_for_service('add_two_ints')

这是一种很方便的方法，可以让在add_two_ints服务可用之前一直阻塞。

切换行号显示

  12         add_two_ints = rospy.ServiceProxy('add_two_ints', AddTwoInts)

这里我们为服务的调用创建了一个句柄（handle）。

切换行号显示

  13         resp1 = add_two_ints(x, y)
  14         return resp1.sum

然后我们可以使用这个句柄，就像普通的函数一样调用它。

因为我们已经将服务的类型声明为AddTwoInts，它会为你生成AddTwoIntsRequest对象 (you're free to pass in your own instead)。如果调用失败，rospy.ServiceException将会抛出，所以你应该弄一个合适的try/except部分。

2.3构建节点

我们使用CMake作为构建系统。是的，即使是Python节点也必须使用它。这是为了确保能为创建的消息和服务自动生成Python代码。

切换当前目录到你的catkin工作空间，然后运行catkin_make：

# 在你的catkin工作空间中
$ cd ~/catkin_ws
$ catkin_make

 

现在你已经编写了一个简单的服务和客户端。