open_pub/Uni-Lab-OS
1
0
Fork 0
mirror of https://github.com/dptech-corp/Uni-Lab-OS.git synced 2026-02-04 13:25:13 +00:00
Code Issues Packages Projects Releases Wiki Activity

调整protocol node以更好支持多种类型的read和write

Browse Source
This commit is contained in:
Xuwznln
2025-06-10 21:54:23 +08:00
parent 90169981c1
commit 369a21b904
1 changed files with 6 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
unilabos/ros/nodes/presets/protocol_node.py
View File

@@ -1,6 +1,7 @@
import time
import asyncio
import traceback
from types import MethodType
from typing import Union
import rclpy
@@ -252,9 +253,12 @@ class ROS2ProtocolNode(BaseROS2DeviceNode):
return write_func(*args, **kwargs)
if read_method:
setattr(device.driver_instance, read_method, _read)
bound_read = MethodType(_read, device.driver_instance)
setattr(device.driver_instance, read_method, bound_read)
if write_method:
setattr(device.driver_instance, write_method, _write)
bound_write = MethodType(_write, device.driver_instance)
setattr(device.driver_instance, write_method, bound_write)
async def _update_resources(self, goal, protocol_kwargs):