机器人 / 系统课时

等待服务可用并处理超时

等待服务可用并处理超时

服务调用卡住时,首先要分清服务尚未被发现,还是请求发出后没有收到响应。本篇使用 ROS 2 Jazzy 的 SetBool 服务,给发现阶段和响应阶段分别设置超时,并复现正常响应、服务未发现和响应超时三种结果。

学习目标

  • 使用 wait_for_service(timeout_sec=...) 限制服务发现等待时间。
  • 使用 call_async()、spin_until_future_complete() 和 future.done() 判断响应是否超时。
  • 通过可运行示例区分发现失败、响应超时和业务返回失败。

两段等待对应不同故障

调用前创建 std_srvs/srv/SetBool 客户端,目标服务名为 /device/enable。wait_for_service(timeout_sec=2.0) 最多等待约 2 秒:返回 False 说明这段时间内没有发现匹配的服务,不应继续发送请求。它不能证明服务端进程一定不存在,也可能是名称、类型或 DDS 通信域不一致。

服务可用后,call_async() 发送 data=True 并立即返回一个 Future。独立的 spin_until_future_complete(node, future, timeout_sec=2.0) 负责调度回调和等待响应;调用结束后必须检查 future.done(),因为该函数本身不通过返回值报告成功或超时。

SetBool 服务发现与响应超时的双阶段决策流程

编写可复现的客户端与服务端

以下完整脚本同时提供 server 和 client 两种启动模式,文件名为 setbool_timeout_demo.py。示例适用于已安装 rclpy、std_srvs 的 ROS 2 Jazzy 环境;服务端的 --delay 仅用于模拟慢回调,正式节点不应在单线程回调中用 sleep 执行耗时工作。

python
import argparse
import time

import rclpy
from rclpy.executors import ExternalShutdownException
from rclpy.node import Node
from std_srvs.srv import SetBool

SERVICE = '/device/enable'

def run_server(node, delay):
    state = {'enabled': False}

    def handle(request, response):
        # 故意延迟,模拟请求已经到达但迟迟没有响应
        time.sleep(delay)
        state['enabled'] = request.data
        response.success = True
        response.message = 'enabled' if state['enabled'] else 'disabled'
        return response

    node.create_service(SetBool, SERVICE, handle)
    print(f'SERVER_READY: {SERVICE}', flush=True)
    rclpy.spin(node)

def run_client(node):
    client = node.create_client(SetBool, SERVICE)
    # 第一段:只等待服务发现,超时则不发请求
    if not client.wait_for_service(timeout_sec=2.0):
        print('SERVICE_UNAVAILABLE: 2s')
        return

    request = SetBool.Request()
    request.data = True
    future = client.call_async(request)
    # 第二段:驱动执行器处理响应,等待最多约 2 秒
    rclpy.spin_until_future_complete(node, future, timeout_sec=2.0)

    if not future.done():
        client.remove_pending_request(future)
        print('RESPONSE_TIMEOUT: 2s')
        return

    try:
        response = future.result()
    except Exception as exc:
        print(f'REQUEST_FAILED: {type(exc).__name__}')
        return
    print(f'RESPONSE: success={response.success} message={response.message}')

def main():
    parser = argparse.ArgumentParser()
    parser.add_argument('role', choices=['server', 'client'])
    parser.add_argument('--delay', type=float, default=0.0)
    args = parser.parse_args()

    rclpy.init()
    node = Node(f'setbool_{args.role}')
    try:
        if args.role == 'server':
            run_server(node, max(args.delay, 0.0))
        else:
            run_client(node)
    except (KeyboardInterrupt, ExternalShutdownException):
        pass
    finally:
        node.destroy_node()
        rclpy.try_shutdown()

if __name__ == '__main__':
    main()

预期结果:以 server 模式运行会注册服务;client 模式根据实际状态打印 RESPONSE、SERVICE_UNAVAILABLE 或 RESPONSE_TIMEOUT。超时后调用 remove_pending_request() 清理客户端的未完成请求记录,但不会撤销服务端正在执行的操作。

分别验证正常、未发现与响应超时

在 Ubuntu 24.04 的两个终端中使用 ROS 2 Jazzy 环境,先保存上述脚本。终端 A 启动无延迟服务端:

bash
source /opt/ros/jazzy/setup.bash
python3 setbool_timeout_demo.py server

预期输出(进程会持续运行,直到按 Ctrl+C):

text
SERVER_READY: /device/enable

终端 B 加载相同环境并发送请求:

bash
source /opt/ros/jazzy/setup.bash
python3 setbool_timeout_demo.py client

预期输出:

text
RESPONSE: success=True message=enabled

要复现服务未发现,先在终端 A 按 Ctrl+C 停止服务,确认没有其他同名服务,再在终端 B 执行:

bash
python3 setbool_timeout_demo.py client

预期输出(约 2 秒后):

text
SERVICE_UNAVAILABLE: 2s

要复现响应超时,在终端 A 重启一个延迟 4 秒响应的服务端:

bash
python3 setbool_timeout_demo.py server --delay 4

预期输出:

text
SERVER_READY: /device/enable

终端 B 再发一次请求:

bash
python3 setbool_timeout_demo.py client

预期输出(请求发出后约 2 秒):

text
RESPONSE_TIMEOUT: 2s

此时服务端通常还会在约 4 秒后完成状态更新。客户端等待超时与服务端操作是否成功是两件事。

根据失败阶段定位问题

遇到 SERVICE_UNAVAILABLE,先保持服务端运行,并在客户端环境执行:

bash
ros2 service type /device/enable

预期输出:

text
std_srvs/srv/SetBool

如果查询不到类型,先用 ros2 service list -t 核对服务名及接口类型,再检查两个终端是否使用同一个 ROS_DOMAIN_ID、是否都加载了正确的 ROS 2 环境;不要把发现失败误判为服务回调耗时。

如果已发现服务,却出现 RESPONSE_TIMEOUT,检查服务端回调是否阻塞、进程是否退出以及请求处理是否超过 2 秒。若 future.done() 为真且返回 success=False,这代表收到了业务拒绝响应,不是通信超时;如要重试可能改变设备状态的命令,应先查询实际状态或使用幂等操作,避免迟到响应与重复执行造成误动作。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

等待服务可用并处理超时

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通