机器人 / 系统课时

用 Service 响应设备配置请求

用 Service 响应设备配置请求

把设备开关配置做成一次有明确返回值的 ROS 2 Service 调用:客户端提交开关请求,服务端更新参数并返回处理结果,再通过查询服务读回状态。本例模拟设备开关,不直接驱动真实硬件。

学习目标

  • 区分 SetBool 配置请求与 Trigger 状态查询的请求、响应字段。
  • 使用 ROS 2 Jazzy 的 rclpy 编写服务端和异步调用方。
  • 通过回读参数核对结果,并识别服务不可用、响应超时与业务失败。

定义配置与查询接口

示例运行于 Ubuntu 24.04、ROS 2 Jazzy,使用系统自带的 rclpy 和 std_srvs。服务端节点名为 /device_server,声明布尔参数 enabled,初始值为 false。两个服务分别承担写入与查询职责:

服务名称 类型 请求 响应
/device/set_enabled std_srvs/srv/SetBool data: true/false success、message
/device/get_status std_srvs/srv/Trigger 无字段 success、message

SetBool 适合开关量配置,不适合传递速度、PID 增益等多字段配置。Trigger 无请求字段,适合查询固定对象的简单状态;本例将状态放在 message 中,真实系统如需机器解析多个状态字段,应定义专用 .srv 类型。

设备配置请求和状态回读时序

编写服务端与调用方

新建 device_service.py,以下代码把服务端和调用方放在同一文件,用 server、set、status 三种子命令切换角色。服务端在回调中修改或读取参数;客户端先等待服务发现,再发送异步请求,并分别限制发现时间和应答时间。

python
import argparse

import rclpy
from rclpy.node import Node
from rclpy.parameter import Parameter
from std_srvs.srv import SetBool, Trigger

class DeviceServer(Node):
    def __init__(self):
        super().__init__('device_server')
        self.declare_parameter('enabled', False)
        self.create_service(SetBool, '/device/set_enabled', self.set_enabled)
        self.create_service(Trigger, '/device/get_status', self.get_status)

    def set_enabled(self, request, response):
        # 仅更新模拟设备状态;不把参数成功写入等同于硬件执行成功
        result = self.set_parameters([
            Parameter('enabled', value=request.data)
        ])[0]
        response.success = result.successful
        response.message = (
            f"enabled={self.get_parameter('enabled').value}"
            if result.successful else result.reason
        )
        return response

    def get_status(self, request, response):
        # 查询只读取当前值,不改变开关状态
        response.success = True
        response.message = f"enabled={self.get_parameter('enabled').value}"
        return response

class DeviceClient(Node):
    def __init__(self):
        super().__init__('device_client')

    def call(self, command, value):
        if command == 'set':
            client = self.create_client(SetBool, '/device/set_enabled')
            request = SetBool.Request()
            request.data = value
        else:
            client = self.create_client(Trigger, '/device/get_status')
            request = Trigger.Request()

        if not client.wait_for_service(timeout_sec=3.0):
            raise RuntimeError('服务未发现:检查服务端和 ROS_DOMAIN_ID')

        # 主程序等待 Future;不要在同一个单线程服务回调里阻塞等待
        future = client.call_async(request)
        rclpy.spin_until_future_complete(self, future, timeout_sec=5.0)
        if not future.done():
            client.remove_pending_request(future)
            raise TimeoutError('等待服务应答超时')
        if future.exception() is not None:
            raise RuntimeError(f'服务调用失败:{future.exception()}')
        return future.result()

def main():
    parser = argparse.ArgumentParser()
    parser.add_argument('command', choices=['server', 'set', 'status'])
    parser.add_argument('value', nargs='?', choices=['true', 'false'])
    args = parser.parse_args()
    if (args.command == 'set') != (args.value is not None):
        parser.error('set 必须附带 true/false,其余命令不带值')

    rclpy.init()
    node = None
    try:
        if args.command == 'server':
            node = DeviceServer()
            rclpy.spin(node)
        else:
            node = DeviceClient()
            result = node.call(args.command, args.value == 'true')
            print(f'{args.command}: success={result.success}, '
                  f'message={result.message}')
    finally:
        if node is not None:
            node.destroy_node()
        if rclpy.ok():
            rclpy.shutdown()

if __name__ == '__main__':
    main()

预期结果:以 server 模式启动后,两个服务保持可用;以 set 或 status 模式运行时,调用方会打印包含 success 和 message 的应答。

SetBool.Response.success 反映参数写入是否成功,Trigger.Response.success 表示查询回调成功返回;两者都不是传输层的超时标志。客户端还必须检查 Future 是否完成以及 success 是否为 True。本示例将结果打印供人工检查,业务程序应在收到 success=False 时进入失败处理分支。

启动并验证请求结果

在终端 A 进入保存脚本的目录,加载 Jazzy 环境后启动服务端:

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

预期结果:进程持续运行并等待请求;代码没有主动输出启动日志,因此终端保持等待是正常现象。

另开终端 B,在同一目录依次发送开启请求、查询请求,并从 ROS 2 参数服务独立回读:

bash
source /opt/ros/jazzy/setup.bash
python3 device_service.py set true
python3 device_service.py status
ros2 param get /device_server enabled

预期输出:

text
set: success=True, message=enabled=True
status: success=True, message=enabled=True
Boolean value is: True

这三处一致,说明配置服务写入了节点参数,查询服务读到了更新后的值。接着运行 python3 device_service.py set false,预期输出为 set: success=True, message=enabled=False;再次查询应得到 enabled=False。服务端进程结束并重新启动后,参数恢复为默认的 false,因为示例没有持久化状态。

排查未发现、超时和假成功

如果调用方在 3 秒内未发现服务,先确认终端 A 的服务端仍在运行、两个终端的 ROS_DOMAIN_ID 相同,并检查服务名和类型。可以用以下命令定位类型不匹配问题:

bash
ros2 service type /device/set_enabled
ros2 service type /device/get_status

预期输出:

text
std_srvs/srv/SetBool
std_srvs/srv/Trigger

发现成功并不保证服务端一定应答;请求发出后 5 秒仍未完成就按超时处理。业务回调返回 success=False 则属于已收到响应但操作失败,应读取 message 查原因,不能误判为通信中断。

用 Service 处理低频、需要明确答复的配置或查询;温度、里程计等持续更新的数据仍应使用 Topic。

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

目录与阅读设置

阅读设置

17

记录一个想法

用 Service 响应设备配置请求

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

登录哪都通