机器人 / 系统课时
等待服务可用并处理超时
等待服务可用并处理超时
服务调用卡住时,首先要分清服务尚未被发现,还是请求发出后没有收到响应。本篇使用 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(),因为该函数本身不通过返回值报告成功或超时。

编写可复现的客户端与服务端
以下完整脚本同时提供 server 和 client 两种启动模式,文件名为 setbool_timeout_demo.py。示例适用于已安装 rclpy、std_srvs 的 ROS 2 Jazzy 环境;服务端的 --delay 仅用于模拟慢回调,正式节点不应在单线程回调中用 sleep 执行耗时工作。
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 启动无延迟服务端:
source /opt/ros/jazzy/setup.bash
python3 setbool_timeout_demo.py server预期输出(进程会持续运行,直到按 Ctrl+C):
SERVER_READY: /device/enable终端 B 加载相同环境并发送请求:
source /opt/ros/jazzy/setup.bash
python3 setbool_timeout_demo.py client预期输出:
RESPONSE: success=True message=enabled要复现服务未发现,先在终端 A 按 Ctrl+C 停止服务,确认没有其他同名服务,再在终端 B 执行:
python3 setbool_timeout_demo.py client预期输出(约 2 秒后):
SERVICE_UNAVAILABLE: 2s要复现响应超时,在终端 A 重启一个延迟 4 秒响应的服务端:
python3 setbool_timeout_demo.py server --delay 4预期输出:
SERVER_READY: /device/enable终端 B 再发一次请求:
python3 setbool_timeout_demo.py client预期输出(请求发出后约 2 秒):
RESPONSE_TIMEOUT: 2s此时服务端通常还会在约 4 秒后完成状态更新。客户端等待超时与服务端操作是否成功是两件事。
根据失败阶段定位问题
遇到 SERVICE_UNAVAILABLE,先保持服务端运行,并在客户端环境执行:
ros2 service type /device/enable预期输出:
std_srvs/srv/SetBool如果查询不到类型,先用 ros2 service list -t 核对服务名及接口类型,再检查两个终端是否使用同一个 ROS_DOMAIN_ID、是否都加载了正确的 ROS 2 环境;不要把发现失败误判为服务回调耗时。
如果已发现服务,却出现 RESPONSE_TIMEOUT,检查服务端回调是否阻塞、进程是否退出以及请求处理是否超过 2 秒。若 future.done() 为真且返回 success=False,这代表收到了业务拒绝响应,不是通信超时;如要重试可能改变设备状态的命令,应先查询实际状态或使用幂等操作,避免迟到响应与重复执行造成误动作。