机器人 / 系统课时
用 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 三种子命令切换角色。服务端在回调中修改或读取参数;客户端先等待服务发现,再发送异步请求,并分别限制发现时间和应答时间。
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 环境后启动服务端:
source /opt/ros/jazzy/setup.bash
python3 device_service.py server预期结果:进程持续运行并等待请求;代码没有主动输出启动日志,因此终端保持等待是正常现象。
另开终端 B,在同一目录依次发送开启请求、查询请求,并从 ROS 2 参数服务独立回读:
source /opt/ros/jazzy/setup.bash
python3 device_service.py set true
python3 device_service.py status
ros2 param get /device_server enabled预期输出:
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 相同,并检查服务名和类型。可以用以下命令定位类型不匹配问题:
ros2 service type /device/set_enabled
ros2 service type /device/get_status预期输出:
std_srvs/srv/SetBool
std_srvs/srv/Trigger发现成功并不保证服务端一定应答;请求发出后 5 秒仍未完成就按超时处理。业务回调返回 success=False 则属于已收到响应但操作失败,应读取 message 查原因,不能误判为通信中断。
用 Service 处理低频、需要明确答复的配置或查询;温度、里程计等持续更新的数据仍应使用 Topic。