mirror of
https://github.com/dptech-corp/Uni-Lab-OS.git
synced 2026-02-05 22:15:04 +00:00
增加modbus支持
调整protocol node以更好支持多种类型的read和write
This commit is contained in:
@@ -5,6 +5,6 @@ io_snrd:
|
|||||||
type: python
|
type: python
|
||||||
hardware_interface:
|
hardware_interface:
|
||||||
name: modbus_client
|
name: modbus_client
|
||||||
extra_info: address
|
extra_info: []
|
||||||
read: read_io_coil
|
read: read_io_coil
|
||||||
write: write_io_coil
|
write: write_io_coil
|
||||||
@@ -241,15 +241,15 @@ class ROS2ProtocolNode(BaseROS2DeviceNode):
|
|||||||
|
|
||||||
def _setup_hardware_proxy(self, device: ROS2DeviceNode, communication_device: ROS2DeviceNode, read_method, write_method):
|
def _setup_hardware_proxy(self, device: ROS2DeviceNode, communication_device: ROS2DeviceNode, read_method, write_method):
|
||||||
"""为设备设置硬件接口代理"""
|
"""为设备设置硬件接口代理"""
|
||||||
extra_info = [getattr(device.driver_instance, info) for info in communication_device.ros_node_instance._hardware_interface.get("extra_info", [])]
|
# extra_info = [getattr(device.driver_instance, info) for info in communication_device.ros_node_instance._hardware_interface.get("extra_info", [])]
|
||||||
write_func = getattr(communication_device.ros_node_instance, communication_device.ros_node_instance._hardware_interface["write"])
|
write_func = getattr(communication_device.driver_instance, communication_device.ros_node_instance._hardware_interface["write"])
|
||||||
read_func = getattr(communication_device.ros_node_instance, communication_device.ros_node_instance._hardware_interface["read"])
|
read_func = getattr(communication_device.driver_instance, communication_device.ros_node_instance._hardware_interface["read"])
|
||||||
|
|
||||||
def _read():
|
def _read(*args, **kwargs):
|
||||||
return read_func(*extra_info)
|
return read_func(*args, **kwargs)
|
||||||
|
|
||||||
def _write(command):
|
def _write(*args, **kwargs):
|
||||||
return write_func(*extra_info, command)
|
return write_func(*args, **kwargs)
|
||||||
|
|
||||||
if read_method:
|
if read_method:
|
||||||
setattr(device.driver_instance, read_method, _read)
|
setattr(device.driver_instance, read_method, _read)
|
||||||
|
|||||||
Reference in New Issue
Block a user