### Python实现ROS服务的步骤和代码示例 在ROS（Robot Operating System）中，服务（Service）是一种请求-响应机制，允许一个节点向另一个节点发送请求并等待响应。使用Python编写ROS服务涉及两个主要部分：服务端（Server）和客户端（Client）。服务端负责提供服务并处理请求，而客户端负责发送请求并接收响应。 #### 实现步骤 1. **定义服务接口** 在ROS中，服务接口通过`.srv`文件定义。该文件描述了服务的请求和响应数据结构。例如，创建一个名为`AddTwoInts.srv`的服务接口，其内容如下： ``` int64 a int64 b --- int64 sum ``` 2. **创建功能包** 在ROS工作空间中创建一个功能包，用于存放服务相关的代码和配置文件。假设功能包名称为`my_service_pkg`，可以通过以下命令创建： ```bash cd ~/catkin_ws/src catkin_create_pkg my_service_pkg rospy ``` 3. **编写服务端代码** 在功能包中创建一个Python脚本（如`server_node.py`），实现服务端逻辑。以下是一个简单的示例代码： ```python #!/usr/bin/env python3 import rospy from my_service_pkg.srv import AddTwoInts, AddTwoIntsResponse def add_two_ints_callback(req): rospy.loginfo(f"Received request: {req.a} + {req.b}") return AddTwoIntsResponse(req.a + req.b) def add_two_ints_server(): rospy.init_node('add_two_ints_server') rospy.loginfo("Service is ready.") service = rospy.Service('add_two_ints', AddTwoInts, add_two_ints_callback) rospy.spin() if __name__ == '__main__': add_two_ints_server() ``` 4. **编写客户端代码** 在功能包中创建另一个Python脚本（如`client_node.py`），实现客户端逻辑。以下是一个简单的示例代码： ```python #!/usr/bin/env python3 import sys import rospy from my_service_pkg.srv import AddTwoInts def add_two_ints_client(a, b): rospy.wait_for_service('add_two_ints') try: add_two_ints = rospy.ServiceProxy('add_two_ints', AddTwoInts) response = add_two_ints(a, b) rospy.loginfo(f"Sum: {response.sum}") return response.sum except rospy.ServiceException as e: rospy.logerr(f"Service call failed: {e}") if __name__ == '__main__': if len(sys.argv) == 3: a = int(sys.argv[1]) b = int(sys.argv[2]) else: rospy.logwarn("Usage: add_two_ints_client.py [a] [b]") sys.exit(1) add_two_ints_client(a, b) ``` 5. **配置CMakeLists.txt** 在功能包的`CMakeLists.txt`文件中添加对Python脚本的安装规则，确保脚本具有可执行权限： ```cmake install(PROGRAMS scripts/server_node.py scripts/client_node.py DESTINATION ${CATKIN_PACKAGE_BIN_DESTINATION} ) ``` 6. **编译功能包** 返回工作空间根目录并编译功能包： ```bash cd ~/catkin_ws catkin_make source devel/setup.bash ``` 7. **运行服务端和客户端** 打开两个终端窗口，分别运行服务端和客户端。在第一个终端中启动服务端： ```bash rosrun my_service_pkg server_node.py ``` 在第二个终端中启动客户端并传递参数： ```bash rosrun my_service_pkg client_node.py 3 5 ``` 客户端将发送请求并输出结果，例如： ``` [INFO] [1698765432.123456]: Sum: 8 ``` 通过上述步骤，可以在ROS中使用Python实现服务端和客户端的通信机制。这种机制适用于需要同步响应的场景，例如机器人控制系统中的任务调度和状态查询。