ROS2服务机制详解：从原理到实践-代码聚汇网

ROS2服务机制详解：从原理到实践

抹茶柚子冰

1. ROS2服务机制的本质理解

在机器人操作系统ROS2的架构中，服务（Service）是一种比话题（Topic）更结构化的通信机制。不同于话题的持续单向数据流，服务采用经典的请求-响应模式，这种同步交互方式特别适合需要确认执行结果的场景。想象一下机器人的抓取动作：当控制节点发出"抓取杯子"的指令后，必须等待执行节点返回"抓取完成"或"抓取失败"的明确响应，才能决定后续动作——这正是服务的典型应用场景。

服务接口通过.srv文件定义，其结构分为请求和响应两部分，用三个横线---分隔。例如一个加法服务的定义可能如下：

code复制int64 a
int64 b
---
int64 sum

这种强类型接口确保了通信双方对数据格式的严格约定。在底层实现上，ROS2服务基于DDS的RTPS协议，默认采用XML-RPC通信（也可以通过rmw层配置为其他协议），其生命周期包括服务端注册、客户端发现、建立连接、请求处理四个阶段。当服务端节点启动时，会向ROS2中间件注册服务名称和类型；客户端查找可用服务时，中间件会返回匹配的服务端端点信息，之后双方建立点对点连接。

提示：在资源受限的嵌入式设备上，频繁创建销毁服务连接会产生较大开销。实践中建议对高频调用的服务保持长连接，或改用Action机制处理长时间任务。

2. 服务与话题的深度对比

理解服务与话题的区别是掌握ROS2通信模型的关键。下面从六个维度进行对比分析：

特性	服务(Service)	话题(Topic)
通信模式	同步请求-响应	异步发布-订阅
数据流向	双向（请求+响应）	单向（仅发布）
连接关系	1对1（多客户端需排队）	1对多/多对多
实时性	依赖服务端响应速度	仅受传输延迟影响
适用场景	需要确认结果的指令型操作	持续数据流（如传感器数据）
QoS策略	仅RELIABLE	可配置RELIABLE/BEST_EFFORT

一个常见的误区是将服务用于高频数据传输。实测表明，在Raspberry Pi 4B上，服务调用的往返延迟约5-8ms，而同样大小的消息通过话题传输仅需0.3-1ms。因此对于图像传输等场景，即使用于控制指令（如"开始录像"），也应搭配话题传输实际数据。

3. 服务实现的完整实践

3.1 创建自定义服务接口

在ROS2包中创建srv目录，新建AddTwoInts.srv文件：

bash复制cd ~/ros2_ws/src/my_package
mkdir srv
touch srv/AddTwoInts.srv

编辑内容为前文所示的加法服务定义。然后在CMakeLists.txt中声明编译依赖：

cmake复制find_package(rosidl_default_generators REQUIRED)
rosidl_generate_interfaces(${PROJECT_NAME}
  "srv/AddTwoInts.srv"
)

3.2 Python服务端实现

创建service_server.py：

python复制import rclpy
from rclpy.node import Node
from my_package.srv import AddTwoInts

class MathService(Node):
    def __init__(self):
        super().__init__('math_service')
        self.srv = self.create_service(
            AddTwoInts, 'add_two_ints', self.add_callback)
        
    def add_callback(self, request, response):
        response.sum = request.a + request.b
        self.get_logger().info(f'Incoming request: {request.a} + {request.b}')
        return response

def main():
    rclpy.init()
    node = MathService()
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        node.get_logger().info('Shutting down math service')
    node.destroy_node()
    rclpy.shutdown()

3.3 C++客户端实现

创建client.cpp：

cpp复制#include "rclcpp/rclcpp.hpp"
#include "my_package/srv/add_two_ints.hpp"

using namespace std::chrono_literals;

int main(int argc, char **argv) {
  rclcpp::init(argc, argv);
  auto node = rclcpp::Node::make_shared("add_client");
  auto client = node->create_client<my_package::srv::AddTwoInts>("add_two_ints");
  
  while (!client->wait_for_service(1s)) {
    RCLCPP_INFO(node->get_logger(), "Waiting for service...");
  }

  auto request = std::make_shared<my_package::srv::AddTwoInts::Request>();
  request->a = 5;
  request->b = 3;

  auto result = client->async_send_request(request);
  if (rclcpp::spin_until_future_complete(node, result) == 
      rclcpp::FutureReturnCode::SUCCESS) {
    RCLCPP_INFO(node->get_logger(), "Sum: %ld", result.get()->sum);
  } else {
    RCLCPP_ERROR(node->get_logger(), "Service call failed");
  }

  rclcpp::shutdown();
  return 0;
}

4. 高级应用与性能优化

4.1 服务超时与重试机制

实际部署中必须处理服务不可用的情况。Python客户端可设置超时：

python复制from rclpy.exceptions import ServiceException

try:
    future = cli.call_async(req)
    rclpy.spin_until_future_complete(node, future, timeout_sec=3.0)
    response = future.result()
except ServiceException as e:
    node.get_logger().warn(f"Service call timed out: {e}")

C++中可通过wait_for_service()结合定时器实现重试逻辑：

cpp复制auto timer = node->create_wall_timer(500ms, [&]() {
  if (!client->service_is_ready()) {
    RCLCPP_WARN(node->get_logger(), "Retrying service connection...");
    client->wait_for_service(1s);
  } else {
    timer->cancel();
    // 发起请求...
  }
});

4.2 多线程服务处理

默认情况下，ROS2服务回调在单线程中顺序执行。对于计算密集型服务，需配置执行器：

python复制executor = rclpy.executors.MultiThreadedExecutor(num_threads=4)
executor.add_node(node)
executor.spin()

C++中可通过回调组实现：

cpp复制auto callback_group = node->create_callback_group(
  rclcpp::CallbackGroupType::MutuallyExclusive);
auto options = rclcpp::ServiceOptions();
options.callback_group = callback_group;
auto srv = node->create_service<AddTwoInts>("add_two_ints", 
  std::bind(&MathService::add_callback, this, _1, _2), options);

4.3 服务质量(QoS)配置

虽然服务默认使用RELIABLE策略，但可调整历史深度等参数：

python复制from rclpy.qos import QoSProfile, QoSReliabilityPolicy

qos = QoSProfile(
  depth=10,
  reliability=QoSReliabilityPolicy.RELIABLE
)
self.srv = self.create_service(
  AddTwoInts, 'add_two_ints', self.add_callback, 
  qos_profile=qos)

5. 调试技巧与常见问题

5.1 服务列表查询

通过命令行工具检查服务状态：

bash复制ros2 service list  # 列出所有服务
ros2 service type /add_two_ints  # 查看服务类型
ros2 interface show my_package/srv/AddTwoInts  # 显示接口定义

5.2 手动调用服务

使用命令行测试服务：

bash复制ros2 service call /add_two_ints my_package/srv/AddTwoInts "{a: 5, b: 3}"

5.3 典型错误排查

服务未注册：确保服务端节点已运行且无异常退出。检查日志：
```
bash复制ros2 topic echo /rosout
```
类型不匹配：客户端和服务端必须使用完全相同的.srv定义。验证方法：
```
bash复制md5sum build/my_package/rosidl_generator_py/my_package/srv/*.py
```
DDS发现问题：跨机器通信时检查防火墙设置和ROS_DOMAIN_ID是否一致。
响应超时：对于长时间运行的服务，客户端应设置合理超时，或改用Action接口。