maxim/imitator-case-y5
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Доработка команды 70 (Флаг ЕМС Г)

Browse Source
This commit is contained in:
TotMaxim
2025-11-23 16:24:17 +03:00
parent d5e812581f
commit 1f93815d25
2 changed files with 107 additions and 101 deletions
Download Patch File Download Diff File Expand all files Collapse all files

9
main.gd
View File

@@ -165,6 +165,7 @@ func on_modify_device(toggled: bool, name_device: String) -> void:
dictionary_yau07[name_device] = udp_broadcast dictionary_yau07[name_device] = udp_broadcast
print("Устройство %s активировано" % name_device) print("Устройство %s активировано" % name_device)
dictionary_yau07[name_device].connect('update_isa_ports', _on_update_isa_ports) dictionary_yau07[name_device].connect('update_isa_ports', _on_update_isa_ports)
dictionary_yau07[name_device].connect('update_socket_status', _on_update_socket_status)
else: else:
if dictionary_yau07.has(name_device) and dictionary_yau07[name_device]: if dictionary_yau07.has(name_device) and dictionary_yau07[name_device]:
dictionary_yau07[name_device].close_udp_unit() dictionary_yau07[name_device].close_udp_unit()
@@ -202,6 +203,14 @@ func _update_tab_container(just_activated: bool = false, activated_device: Strin
tab_container.visible = has_visible_tabs tab_container.visible = has_visible_tabs
func _on_update_socket_status(status: int, device_name: String)->void:
var socket_arr = _get_nodes_for_device(device_name, 'socket')
for socket in socket_arr:
var bit_index = socket.get_meta('bit')
var is_bit_set = (status >> bit_index) & 1
socket.set_pressed_no_signal(is_bit_set == 1)
func _on_update_isa_ports(isa_ports: Dictionary, device_name: String)->void: func _on_update_isa_ports(isa_ports: Dictionary, device_name: String)->void:
for port_addr in isa_ports: for port_addr in isa_ports:
var value = isa_ports[port_addr] var value = isa_ports[port_addr]

199
udp_broadcast.gd
View File

@@ -13,28 +13,29 @@ const UKP_DATA_SIZE: int = 32
# Константы команд ISA # Константы команд ISA
const CMD_READ_ISA: int = 0 const CMD_READ_ISA: int = 0
const CMD_WRITE_ISA: int = 1 const CMD_WRITE_ISA: int = 1
const CMD_FLAG_EMS_G: int = 70
# Минимальный размер пакета для валидации # Минимальный размер пакета для валидации
const MIN_PACKET_SIZE: int = 7 const MIN_PACKET_SIZE: int = 7
# Словарь адресов устройств # Словарь адресов устройств
const ADDRESS_LIST: Dictionary = { const ADDRESS_LIST: Dictionary = {
'ПРД-Н1': [50011, "10.1.1.11"], 'ПРД-Н1': [50011, '10.1.1.11'],
'ПРД-В1': [50012, "10.1.1.12"], 'ПРД-В1': [50012, '10.1.1.12'],
'ПРД-К1': [50013, "10.1.1.13"], 'ПРД-К1': [50013, '10.1.1.13'],
'ПРД-Н2': [50021, "10.1.1.21"], 'ПРД-Н2': [50021, '10.1.1.21'],
'ПРД-В2': [50022, "10.1.1.22"], 'ПРД-В2': [50022, '10.1.1.22'],
'ПРД-К2': [50023, "10.1.1.23"], 'ПРД-К2': [50023, '10.1.1.23'],
'ПРД-Н3': [50031, "10.1.1.31"], 'ПРД-Н3': [50031, '10.1.1.31'],
'ПРД-В3': [50032, "10.1.1.32"], 'ПРД-В3': [50032, '10.1.1.32'],
'ПРД-К3': [50033, "10.1.1.33"], 'ПРД-К3': [50033, '10.1.1.33'],
'ПРД-Н4': [50041, "10.1.1.41"], 'ПРД-Н4': [50041, '10.1.1.41'],
'ПРД-В4': [50042, "10.1.1.42"], 'ПРД-В4': [50042, '10.1.1.42'],
'ПРД-К4': [50043, "10.1.1.43"], 'ПРД-К4': [50043, '10.1.1.43'],
} }
# Широковещательный адрес # Широковещательный адрес
const BROADCAST_ADDR: Array = [50000, "10.1.1.255"] const BROADCAST_ADDR: Array = [50000, '10.1.1.255']
# Приватные свойства # Приватные свойства
var status_manager: StatusManager var status_manager: StatusManager
@@ -52,10 +53,11 @@ var ukp0_data: PackedByteArray
var ukp1_data: PackedByteArray var ukp1_data: PackedByteArray
signal update_isa_ports(_isa_ports: Dictionary) signal update_isa_ports(_isa_ports: Dictionary)
signal update_socket_status(_sockets_status_bit: int)
func _init(name: String): func _init(name: String):
"""Инициализация UDP broadcast клиента""" '''Инициализация UDP broadcast клиента'''
status_manager = StatusManager.new(self) status_manager = StatusManager.new(self)
_self_name = name _self_name = name
_initialize_socket() _initialize_socket()
@@ -64,16 +66,16 @@ func _init(name: String):
_initialize_isa_ports() _initialize_isa_ports()
if not _bind_to_device_address(name): if not _bind_to_device_address(name):
push_error("Не удалось инициализировать устройство: %s" % name) push_error('Не удалось инициализировать устройство: %s' % name)
func _initialize_socket() -> void: func _initialize_socket() -> void:
"""Инициализация UDP сокета""" '''Инициализация UDP сокета'''
_socket = SocketUDP.new() _socket = SocketUDP.new()
func _initialize_timers() -> void: func _initialize_timers() -> void:
"""Инициализация таймеров""" '''Инициализация таймеров'''
# Таймер для широковещательной рассылки (3 раза в секунду) # Таймер для широковещательной рассылки (3 раза в секунду)
_timer = Timer.new() _timer = Timer.new()
_timer.wait_time = 1.0 / 5.0 _timer.wait_time = 1.0 / 5.0
@@ -81,7 +83,7 @@ func _initialize_timers() -> void:
func _initialize_ukp_data() -> void: func _initialize_ukp_data() -> void:
"""Инициализация данных UKP нулевыми значениями""" '''Инициализация данных UKP нулевыми значениями'''
ukp0_data = PackedByteArray() ukp0_data = PackedByteArray()
ukp0_data.resize(UKP_DATA_SIZE) ukp0_data.resize(UKP_DATA_SIZE)
ukp0_data.fill(0) ukp0_data.fill(0)
@@ -92,7 +94,7 @@ func _initialize_ukp_data() -> void:
func _initialize_isa_ports() -> void: func _initialize_isa_ports() -> void:
"""Инициализация ISA портов начальными значениями""" '''Инициализация ISA портов начальными значениями'''
# Инициализируем порты, которые могут запрашиваться # Инициализируем порты, которые могут запрашиваться
set_isa_port(0x0106, 0) # DOU2 статус set_isa_port(0x0106, 0) # DOU2 статус
set_isa_port(0x0108, 0) # DOU3 статус set_isa_port(0x0108, 0) # DOU3 статус
@@ -100,9 +102,9 @@ func _initialize_isa_ports() -> void:
func _bind_to_device_address(device_name: String) -> bool: func _bind_to_device_address(device_name: String) -> bool:
"""Привязка к адресу устройства по его имени""" '''Привязка к адресу устройства по его имени'''
if not ADDRESS_LIST.has(device_name): if not ADDRESS_LIST.has(device_name):
push_error("Неизвестное устройство: %s" % device_name) push_error('Неизвестное устройство: %s' % device_name)
return false return false
var port: int = ADDRESS_LIST[device_name][0] var port: int = ADDRESS_LIST[device_name][0]
@@ -112,85 +114,94 @@ func _bind_to_device_address(device_name: String) -> bool:
func bind_unit_address(port: int, address: String) -> bool: func bind_unit_address(port: int, address: String) -> bool:
"""Привязка сокета к указанному порту и адресу""" '''Привязка сокета к указанному порту и адресу'''
if port <= 0 or port > 65535: if port <= 0 or port > 65535:
push_error("Некорректный номер порта: %d" % port) push_error('Некорректный номер порта: %d' % port)
return false return false
var bind_result = _socket.bind(port, address) var bind_result = _socket.bind(port, address)
if bind_result != OK: if bind_result != OK:
push_error("Не удалось привязаться к %s:%d - %s" % [address, port, error_string(bind_result)]) push_error('Не удалось привязаться к %s:%d - %s' % [address, port, error_string(bind_result)])
return false return false
print("Успешно привязано к %s:%d" % [address, port]) print('Успешно привязано к %s:%d' % [address, port])
return true return true
func add_timers_to_scene(parent: Node) -> void: func add_timers_to_scene(parent: Node) -> void:
"""Добавление таймеров в дерево сцены""" '''Добавление таймеров в дерево сцены'''
# Проверяем что таймеры еще не имеют родителя # Проверяем что таймеры еще не имеют родителя
if not _timer.get_parent(): if not _timer.get_parent():
parent.add_child(_timer) parent.add_child(_timer)
elif _timer.get_parent() != parent: elif _timer.get_parent() != parent:
push_warning("Таймер broadcast уже добавлен в другую сцену") push_warning('Таймер broadcast уже добавлен в другую сцену')
func start_broadcast() -> void: func start_broadcast() -> void:
"""Запуск широковещательной рассылки и опроса сокета""" '''Запуск широковещательной рассылки и опроса сокета'''
_timer.start() _timer.start()
print("Широковещательная рассылка запущена") print('Широковещательная рассылка запущена')
func stop_broadcast() -> void: func stop_broadcast() -> void:
"""Остановка широковещательной рассылки""" '''Остановка широковещательной рассылки'''
_timer.stop() _timer.stop()
#_poll_timer.stop() #_poll_timer.stop()
print("Широковещательная рассылка остановлена") print('Широковещательная рассылка остановлена')
func close_udp_unit() -> void: func close_udp_unit() -> void:
"""Закрытие UDP соединения""" '''Закрытие UDP соединения'''
stop_broadcast() stop_broadcast()
_socket.close() _socket.close()
print("UDP соединение закрыто") print('UDP соединение закрыто')
#region Публичные методы для управления состоянием #region Публичные методы для управления состоянием
func _handle_set_flag_ems_g(set_flag: bool)->void:
'''Установка или сброс 5-го бита (бит 4) в статусе сокетов'''
var current_status = get_sockets_status()
if set_flag:
current_status = current_status | (1 << 4)
print('Установлен флаг загрузки EMS_G)')
set_sockets_status(current_status)
func set_sockets_status(status: int) -> void: func set_sockets_status(status: int) -> void:
"""Установка статуса сокетов""" '''Установка статуса сокетов'''
_sockets_status_bit = status _sockets_status_bit = status
emit_signal('update_socket_status', _sockets_status_bit, _self_name)
func get_sockets_status() -> int: func get_sockets_status() -> int:
"""Получение статуса сокетов""" '''Получение статуса сокетов'''
return _sockets_status_bit return _sockets_status_bit
func set_dkm_status(status: int) -> void: func set_dkm_status(status: int) -> void:
"""Установка статуса DKM""" '''Установка статуса DKM'''
_dkm_status_bit = status _dkm_status_bit = status
func get_dkm_status() -> int: func get_dkm_status() -> int:
"""Получение статуса DKM""" '''Получение статуса DKM'''
return _dkm_status_bit return _dkm_status_bit
func set_ip_status(status: int)->void: func set_ip_status(status: int)->void:
"""Установка статуса ИП""" '''Установка статуса ИП'''
_dry_contact_status_bit = status _dry_contact_status_bit = status
func get_ip_status()->int: func get_ip_status()->int:
"""Получение статуса ИП""" '''Получение статуса ИП'''
return _dry_contact_status_bit return _dry_contact_status_bit
func set_isa_port(port_addr: int, value: int) -> bool: func set_isa_port(port_addr: int, value: int) -> bool:
"""Установка значения ISA порта""" '''Установка значения ISA порта'''
if port_addr < 0 or port_addr > 0xFFFF: if port_addr < 0 or port_addr > 0xFFFF:
push_error("Некорректный адрес порта: 0x%03X" % port_addr) push_error('Некорректный адрес порта: 0x%03X' % port_addr)
return false return false
_isa_ports[port_addr] = value _isa_ports[port_addr] = value
@@ -199,19 +210,19 @@ func set_isa_port(port_addr: int, value: int) -> bool:
func get_isa_port(port_addr: int) -> int: func get_isa_port(port_addr: int) -> int:
"""Получение значения ISA порта""" '''Получение значения ISA порта'''
return _isa_ports.get(port_addr, 0xFFFF) return _isa_ports.get(port_addr, 0xFFFF)
func read_isa_ports(port_addresses: Array) -> Dictionary: func read_isa_ports(port_addresses: Array) -> Dictionary:
"""Чтение значений нескольких ISA портов""" '''Чтение значений нескольких ISA портов'''
var result = {} var result = {}
for port_addr in port_addresses: for port_addr in port_addresses:
if port_addr is int and port_addr >= 0 and port_addr <= 0xFFFF: if port_addr is int and port_addr >= 0 and port_addr <= 0xFFFF:
result[port_addr] = get_isa_port(port_addr) result[port_addr] = get_isa_port(port_addr)
else: else:
push_error("UDPBroadcast: Некорректный адрес порта: " + str(port_addr)) push_error('UDPBroadcast: Некорректный адрес порта: ' + str(port_addr))
return result return result
@@ -220,12 +231,12 @@ func read_isa_ports(port_addresses: Array) -> Dictionary:
#region Обработчики таймеров #region Обработчики таймеров
func _on_broadcast_timeout() -> void: func _on_broadcast_timeout() -> void:
"""Обработчик таймера широковещательной рассылки""" '''Обработчик таймера широковещательной рассылки'''
send_broadcast() send_broadcast()
func _on_poll_timeout() -> void: func _on_poll_timeout() -> void:
"""Обработчик таймера опроса сокета""" '''Обработчик таймера опроса сокета'''
_poll_socket() _poll_socket()
#endregion #endregion
@@ -233,7 +244,7 @@ func _on_poll_timeout() -> void:
#region Работа с сокетом #region Работа с сокетом
func send_broadcast() -> bool: func send_broadcast() -> bool:
"""Отправка широковещательного пакета""" '''Отправка широковещательного пакета'''
_socket.set_broadcast_enabled(true) _socket.set_broadcast_enabled(true)
var data: PackedByteArray = _form_status_device_packet() var data: PackedByteArray = _form_status_device_packet()
var send_result = _socket.send_to(BROADCAST_ADDR[1], BROADCAST_ADDR[0], data) var send_result = _socket.send_to(BROADCAST_ADDR[1], BROADCAST_ADDR[0], data)
@@ -241,12 +252,12 @@ func send_broadcast() -> bool:
if send_result == OK: if send_result == OK:
return true return true
else: else:
push_error("Ошибка отправки широковещательного пакета") push_error('Ошибка отправки широковещательного пакета')
return false return false
func _poll_socket() -> void: func _poll_socket() -> void:
"""Опрос сокета для получения входящих пакетов""" '''Опрос сокета для получения входящих пакетов'''
while _socket.get_available_packet_count() > 0: while _socket.get_available_packet_count() > 0:
var packet = _socket.get_packet() var packet = _socket.get_packet()
var address = _socket.get_packet_ip() var address = _socket.get_packet_ip()
@@ -293,7 +304,7 @@ func _form_status_device_packet() -> PackedByteArray:
func _encode_packet_header(buffer: PackedByteArray) -> void: func _encode_packet_header(buffer: PackedByteArray) -> void:
"""Кодирование заголовка пакета""" '''Кодирование заголовка пакета'''
# 0-1: Reserved (0x0000) # 0-1: Reserved (0x0000)
buffer.encode_u16(0, 0) buffer.encode_u16(0, 0)
# 2-3: Номер команды # 2-3: Номер команды
@@ -305,7 +316,7 @@ func _encode_packet_header(buffer: PackedByteArray) -> void:
func _encode_written_isa_ports(buffer: PackedByteArray, offset: int) -> void: func _encode_written_isa_ports(buffer: PackedByteArray, offset: int) -> void:
"""Добавление данных о записанных ISA портах в конец пакета""" '''Добавление данных о записанных ISA портах в конец пакета'''
for i in range(_written_isa_ports.size()): for i in range(_written_isa_ports.size()):
var port_data = _written_isa_ports[i] var port_data = _written_isa_ports[i]
# Добавляем порт и значение (по 2 байта каждый) # Добавляем порт и значение (по 2 байта каждый)
@@ -315,7 +326,7 @@ func _encode_written_isa_ports(buffer: PackedByteArray, offset: int) -> void:
func _encode_device_data(buffer: PackedByteArray) -> void: func _encode_device_data(buffer: PackedByteArray) -> void:
"""Кодирование данных устройств в пакет""" '''Кодирование данных устройств в пакет'''
# 8-9: Статус сокетов # 8-9: Статус сокетов
buffer.encode_u16(8, _sockets_status_bit) buffer.encode_u16(8, _sockets_status_bit)
@@ -331,7 +342,7 @@ func _encode_device_data(buffer: PackedByteArray) -> void:
func _encode_ems_g_data(buffer: PackedByteArray) -> void: func _encode_ems_g_data(buffer: PackedByteArray) -> void:
"""Кодирование данных EMS-G""" '''Кодирование данных EMS-G'''
var ems_g_data = [ var ems_g_data = [
0x9e00, 0xffff, 0xffff, 0x0000, 0xffff, 0xffff, 0x0000, 0x9e00, 0xffff, 0xffff, 0x0000, 0xffff, 0xffff, 0x0000,
0xffff, 0xffff, 0x0000, 0xffff, 0xffff, 0xffff 0xffff, 0xffff, 0x0000, 0xffff, 0xffff, 0xffff
@@ -342,7 +353,7 @@ func _encode_ems_g_data(buffer: PackedByteArray) -> void:
func _encode_ug_data(buffer: PackedByteArray) -> void: func _encode_ug_data(buffer: PackedByteArray) -> void:
"""Кодирование данных UG""" '''Кодирование данных UG'''
# D15...D8 = ДКМ (старший байт) # D15...D8 = ДКМ (старший байт)
buffer.encode_u8(UG_DATA_OFFSET + 1, _dkm_status_bit & 0xFF) buffer.encode_u8(UG_DATA_OFFSET + 1, _dkm_status_bit & 0xFF)
# D7...D0 = Сухие контакты (младший байт) # D7...D0 = Сухие контакты (младший байт)
@@ -350,7 +361,7 @@ func _encode_ug_data(buffer: PackedByteArray) -> void:
func _encode_ukp_data(buffer: PackedByteArray) -> void: func _encode_ukp_data(buffer: PackedByteArray) -> void:
"""Кодирование данных UKP""" '''Кодирование данных UKP'''
for i in range(UKP_DATA_SIZE): for i in range(UKP_DATA_SIZE):
if i < ukp0_data.size(): if i < ukp0_data.size():
buffer[UKP0_DATA_OFFSET + i] = ukp0_data[i] buffer[UKP0_DATA_OFFSET + i] = ukp0_data[i]
@@ -362,23 +373,23 @@ func _encode_ukp_data(buffer: PackedByteArray) -> void:
#region Прямая отправка ответа #region Прямая отправка ответа
func _send_immediate_response(address: String, port: int) -> void: func _send_immediate_response(address: String, port: int) -> void:
"""Немедленная отправка пакета на указанный адрес и порт""" '''Немедленная отправка пакета на указанный адрес и порт'''
var data: PackedByteArray = _form_status_device_packet() var data: PackedByteArray = _form_status_device_packet()
_socket.set_broadcast_enabled(false) # Отключаем broadcast для точечной отправки _socket.set_broadcast_enabled(false) # Отключаем broadcast для точечной отправки
var send_result = _socket.send_to(address, port, data) var send_result = _socket.send_to(address, port, data)
_socket.set_broadcast_enabled(true) # Включаем обратно для broadcast _socket.set_broadcast_enabled(true) # Включаем обратно для broadcast
if send_result == OK: if send_result == OK:
print("Отправлен немедленный ответ на %s:%d" % [address, port]) print('Отправлен немедленный ответ на %s:%d' % [address, port])
else: else:
push_error("Ошибка отправки ответа на %s:%d" % [address, port]) push_error('Ошибка отправки ответа на %s:%d' % [address, port])
#endregion #endregion
#region Обработка входящих данных #region Обработка входящих данных
func _handle_received_data(data: PackedByteArray, address: String, port: int) -> void: func _handle_received_data(data: PackedByteArray, address: String, port: int) -> void:
"""Обработка входящих данных""" '''Обработка входящих данных'''
if not _validate_received_packet(data): if not _validate_received_packet(data):
return return
@@ -390,40 +401,36 @@ func _handle_received_data(data: PackedByteArray, address: String, port: int) ->
func _validate_received_packet(data: PackedByteArray) -> bool: func _validate_received_packet(data: PackedByteArray) -> bool:
"""Валидация входящего пакета""" '''Валидация входящего пакета'''
if data.size() < MIN_PACKET_SIZE: if data.size() < MIN_PACKET_SIZE:
push_warning("Получен слишком короткий пакет: %d байт" % data.size()) push_warning('Получен слишком короткий пакет: %d байт' % data.size())
return false return false
return true return true
func _get_command_type(data: PackedByteArray) -> int: func _get_command_type(data: PackedByteArray) -> int:
"""Получение типа команды из данных пакета""" '''Получение типа команды из данных пакета'''
if data.size() < 7: if data.size() < 6:
return -1 # Используем -1 для обозначения ошибки return -1 # Используем -1 для обозначения ошибки
# Определяем длину статуса из заголовка
var status_length = data.decode_u8(7)
if data.size() <= (status_length + 8):
return -1 # Используем -1 для обозначения ошибки
return data.decode_u8(6) return data.decode_u8(6)
func _handle_isa_command(command_code: int, data: PackedByteArray, address: String, port: int) -> void: func _handle_isa_command(command_code: int, data: PackedByteArray, address: String, port: int) -> void:
"""Обработка команд ISA""" '''Обработка команд ISA'''
_last_received_command = command_code # Запоминаем последнюю команду _last_received_command = command_code # Запоминаем последнюю команду
match command_code: match command_code:
CMD_READ_ISA: CMD_READ_ISA:
_handle_read_isa_command(data, address, port) _handle_read_isa_command(data, address, port)
CMD_WRITE_ISA: CMD_WRITE_ISA:
_handle_write_isa_command(data, address, port) _handle_write_isa_command(data, address, port)
CMD_FLAG_EMS_G:
_handle_set_flag_ems_g(true)
_: _:
push_warning("Неизвестная команда ISA: %d от %s:%d" % [command_code, address, port]) push_warning('Неизвестная команда ISA: %d от %s:%d' % [command_code, address, port])
func _handle_read_isa_command(data: PackedByteArray, address: String, port: int) -> void: func _handle_read_isa_command(data: PackedByteArray, address: String, port: int) -> void:
"""Обработка команды чтения ISA портов""" '''Обработка команды чтения ISA портов'''
var ports = _parse_command_ports(data) var ports = _parse_command_ports(data)
if ports.is_empty(): if ports.is_empty():
return return
@@ -439,16 +446,13 @@ func _handle_read_isa_command(data: PackedByteArray, address: String, port: int)
func _handle_write_isa_command(data: PackedByteArray, address: String, port: int) -> void: func _handle_write_isa_command(data: PackedByteArray, address: String, port: int) -> void:
"""Обработка команды записи ISA портов""" '''Обработка команды записи ISA портов'''
var ports = _parse_command_ports(data) var ports = _parse_command_ports(data)
var data_to_write = _parse_command_ports_data(data) var data_to_write = _parse_command_ports_data(data)
if ports.size() != data_to_write.size(): if ports.size() != data_to_write.size():
push_warning("Несоответствие размеров портов и данных от %s:%d" % [address, port]) push_warning('Несоответствие размеров портов и данных от %s:%d' % [address, port])
return return
var added_ports = 0
var updated_ports = 0
# Обновляем или добавляем записанные порты # Обновляем или добавляем записанные порты
for i in range(ports.size()): for i in range(ports.size()):
var port_addr = ports[i] var port_addr = ports[i]
@@ -461,15 +465,10 @@ func _handle_write_isa_command(data: PackedByteArray, address: String, port: int
if _written_isa_ports[j][0] == port_addr: if _written_isa_ports[j][0] == port_addr:
_written_isa_ports[j][1] = value # Обновляем значение _written_isa_ports[j][1] = value # Обновляем значение
found = true found = true
updated_ports += 1
break break
if not found: if not found:
_written_isa_ports.append([port_addr, value]) # Добавляем новый порт _written_isa_ports.append([port_addr, value]) # Добавляем новый порт
added_ports += 1
if added_ports > 0 or updated_ports > 0:
print("Обработана команда записи от %s:%d - добавлено: %d, обновлено: %d портов" % [address, port, added_ports, updated_ports])
print('Принята команда на запись в ISA порты от %s:%d: %s' % [address, port, _isa_ports]) print('Принята команда на запись в ISA порты от %s:%d: %s' % [address, port, _isa_ports])
# Немедленная отправка ответа отправителю # Немедленная отправка ответа отправителю
@@ -479,7 +478,7 @@ func _handle_write_isa_command(data: PackedByteArray, address: String, port: int
#region Парсинг команд ISA #region Парсинг команд ISA
func _parse_command_ports(data: PackedByteArray) -> Array: func _parse_command_ports(data: PackedByteArray) -> Array:
"""Парсинг адресов портов из команды""" '''Парсинг адресов портов из команды'''
if data.size() < 7: if data.size() < 7:
return [] return []
@@ -488,22 +487,19 @@ func _parse_command_ports(data: PackedByteArray) -> Array:
return [] return []
var ports = [] var ports = []
if data.decode_u8(6) == 0: if _get_command_type(data) == CMD_READ_ISA:
for i in range(ports_count): for i in range(ports_count):
var port_address = data.decode_u16(8 + i * 2) var port_address = data.decode_u16(8 + i * 2)
ports.append(port_address) ports.append(port_address)
print("Порт %d: 0x%03X" % [i, port_address]) elif _get_command_type(data) == CMD_WRITE_ISA:
elif data.decode_u8(6) == 1:
for i in range(ports_count): for i in range(ports_count):
var port_address = data.decode_u16(8 + i * 4) var port_address = data.decode_u16(8 + i * 4)
ports.append(port_address) ports.append(port_address)
print("Порт %d: 0x%03X" % [i, port_address])
return ports return ports
func _parse_command_ports_data(data: PackedByteArray) -> Array: func _parse_command_ports_data(data: PackedByteArray) -> Array:
"""Парсинг данных портов из команды записи""" '''Парсинг данных портов из команды записи'''
if data.size() < 8: if data.size() < 8:
return [] return []
@@ -515,15 +511,16 @@ func _parse_command_ports_data(data: PackedByteArray) -> Array:
var data_offset = 10 # Смещение для данных портов var data_offset = 10 # Смещение для данных портов
for i in range(ports_count): for i in range(ports_count):
if data_offset + i * 2 < data.size(): if data_offset + i * 4 < data.size():
var port_data = data.decode_u16(data_offset + i * 2) var port = data.decode_u16(8 + i * 4)
var port_data = data.decode_u16(data_offset + i * 4)
ports_data.append(port_data) ports_data.append(port_data)
print("Данные порта %d: 0x%02X" % [i, port_data]) print('Данные порта 0x%02X: 0x%02X' % [port, port_data])
return ports_data return ports_data
func _get_isa_ports_data(ports: Array) -> Array: func _get_isa_ports_data(ports: Array) -> Array:
"""Получение данных указанных ISA портов""" '''Получение данных указанных ISA портов'''
var result = [] var result = []
for port_address in ports: for port_address in ports:
result.append(get_isa_port(port_address)) result.append(get_isa_port(port_address))
@@ -531,7 +528,7 @@ func _get_isa_ports_data(ports: Array) -> Array:
func _set_isa_ports_data(ports: Array, data: Array) -> void: func _set_isa_ports_data(ports: Array, data: Array) -> void:
"""Установка данных для указанных ISA портов""" '''Установка данных для указанных ISA портов'''
for i in range(ports.size()): for i in range(ports.size()):
if i < data.size(): if i < data.size():
set_isa_port(ports[i], data[i]) set_isa_port(ports[i], data[i])
@@ -541,10 +538,10 @@ func _set_isa_ports_data(ports: Array, data: Array) -> void:
#region Вложенный класс SocketUDP #region Вложенный класс SocketUDP
class SocketUDP extends PacketPeerUDP: class SocketUDP extends PacketPeerUDP:
"""Расширенный класс UDP сокета с улучшенной обработкой ошибок""" '''Расширенный класс UDP сокета с улучшенной обработкой ошибок'''
func send_to(address: String, port: int, data: PackedByteArray) -> int: func send_to(address: String, port: int, data: PackedByteArray) -> int:
"""Отправка данных на указанный адрес и порт""" '''Отправка данных на указанный адрес и порт'''
set_dest_address(address, port) set_dest_address(address, port)
var result = put_packet(data) var result = put_packet(data)
@@ -558,20 +555,20 @@ class SocketUDP extends PacketPeerUDP:
#region Методы управления записанными портами #region Методы управления записанными портами
func clear_written_ports() -> void: func clear_written_ports() -> void:
"""Очистка списка записанных портов (ручное управление)""" '''Очистка списка записанных портов (ручное управление)'''
_written_isa_ports.clear() _written_isa_ports.clear()
print("Список записанных портов очищен") print('Список записанных портов очищен')
func get_written_ports_count() -> int: func get_written_ports_count() -> int:
"""Получение количества записанных портов""" '''Получение количества записанных портов'''
return _written_isa_ports.size() return _written_isa_ports.size()
func remove_written_port(port_addr: int) -> bool: func remove_written_port(port_addr: int) -> bool:
"""Удаление конкретного порта из списка записанных""" '''Удаление конкретного порта из списка записанных'''
for i in range(_written_isa_ports.size()): for i in range(_written_isa_ports.size()):
if _written_isa_ports[i][0] == port_addr: if _written_isa_ports[i][0] == port_addr:
_written_isa_ports.remove_at(i) _written_isa_ports.remove_at(i)
print("Порт 0x%04X удален из списка записанных" % port_addr) print('Порт 0x%04X удален из списка записанных' % port_addr)
return true return true
return false return false