From 16118c54699e0e92ac6826ea115ab345a14df42e Mon Sep 17 00:00:00 2001 From: sasha80 Date: Fri, 12 Jan 2024 09:35:57 +0300 Subject: [PATCH] =?UTF-8?q?=D0=94=D0=BE=D1=80=D0=B0=D0=B1=D0=BE=D1=82?= =?UTF-8?q?=D0=BA=D0=B0.=20=D0=9A=D0=BE=D0=BC=D0=B0=D0=BD=D0=B4=D1=8B=20"?= =?UTF-8?q?=D0=A7=D0=B8=D1=82=D0=B0=D1=82=D1=8C=20=D0=B1=D0=BB=D0=BE=D0=BA?= =?UTF-8?q?=20=D0=B4=D0=B0=D0=BD=D0=BD=D1=8B=D1=85=20ISA"=20=D0=B8=20"?= =?UTF-8?q?=D0=97=D0=B0=D0=BF=D0=B8=D1=81=D0=B0=D1=82=D1=8C=20=D0=B1=D0=BB?= =?UTF-8?q?=D0=BE=D0=BA=20=D0=B4=D0=B0=D0=BD=D0=BD=D1=8B=D1=85=20ISA"?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- scripts/yau07.gd | 69 +++++++++++++++++++++++++++++++++++++++++------- 1 file changed, 59 insertions(+), 10 deletions(-) diff --git a/scripts/yau07.gd b/scripts/yau07.gd index 889748f2..3cb37f2b 100644 --- a/scripts/yau07.gd +++ b/scripts/yau07.gd @@ -2,9 +2,9 @@ extends Node ## Протокол ячейки ЯУ-07 -const BUFFER_SIZE = 2048 ## Размер буфера для приёма датаграмм, байты -const ONLINE_TIMEOUT = 5000 ## Время ожидания пакета от ячейки, мс -const RESEND_TIMEOUT = 300 ## Задержка для повторной отправки команды, мс +const BUFFER_SIZE = 2048 ## Размер буфера для приёма датаграмм +const ONLINE_TIMEOUT = 5.0 ## Время ожидания пакета от ячейки, секунды +const RESEND_TIMEOUT = 0.3 ## Задержка для повторной отправки команды, секунды const RETRY_COUNT = 5 ## Количество повторных отправок @@ -13,8 +13,10 @@ class YaU07: ## Коды выполняемых команд enum CmdCode { - READ_ISA = 0, ## Код команды "читать порт ISA" внешней шины ячейки ЯУ-07 - WRITE_ISA = 1 ## Код команды "записать порт ISA" внешней шины ячейки ЯУ-07 + READ_BLOCK = 61, ## Код команды "читать блок данных ISA" внешней шины ячейки ЯУ-07 + READ_ISA = 0, ## Код команды "читать порт ISA" ячейки ЯУ-07 + WRITE_BLOCK = 60, ## Код команды "записать блок данных ISA" внешней шины ячейки ЯУ-07 + WRITE_ISA = 1, ## Код команды "записать порт ISA" ячейки ЯУ-07 } ## Состояние автомата выполнения команды @@ -26,9 +28,10 @@ class YaU07: WAIT ## Ожидание выполнения } - signal line_changed(unit: YaU07) ## Вызывается когда меняется состояние связи с ячейкой signal command_done(unit: YaU07) ## Вызывается после выполнения команды signal command_fail(unit: YaU07) ## Вызывается если возникла ошибка при выполнении команды и команда не выполнена + signal line_changed(unit: YaU07) ## Вызывается когда меняется состояние связи с ячейкой + signal parse_failed(unit: YaU07) var cmd_data: = PackedByteArray() ## Данные команды. Устанавливается в ЯУ-07 var cmd_num_rx: = 0 ## Номер команды принятый @@ -38,6 +41,7 @@ class YaU07: var cmd_state: = CmdState.UNCK ## Состояние выполнения команды var cmd_tick_rx: = 0.0 ## Время последнего приёма команды var cmd_tick_tx: = 0.0 ## Время последней отправки команды + var isa_block: = {} ## Результат выполнения команды "читать массив из порта" var isa_ports: = {} ## Результат выполнения команды "читать порт" var name: = String() ## Имя var online: = false ## Состояние связи с ячейкой @@ -108,7 +112,30 @@ class YaU07: cmd_state = CmdState.SEND return true + func send_block(cmd_code: int, block_len: int, port: Array) -> bool: + if (cmd_state == CmdState.WAIT) \ + or (cmd_state == CmdState.SEND) \ + or (cmd_state == CmdState.UNCK): + return false + if not ((cmd_code == CmdCode.READ_BLOCK) or (cmd_code == CmdCode.WRITE_BLOCK)): + return false + cmd_num_tx = (cmd_num_rx + 1) % 0xffff + + tx_len = 11 + tx_data.encode_u16(0, cmd_retry) # Исправление для сетевого стека "nm-callback" процессоров STM + tx_data.encode_u16(2, cmd_num_tx) + + if cmd_code == CmdCode.WRITE_BLOCK: + block_len /= 2 + tx_data[6] = cmd_code + tx_data.encode_u16(7, block_len) + + tx_data.encode_u16(9, int(port[0])) + cmd_state = CmdState.SEND + return true + + ## Возвращает код команды ЯУ-07. ## [param rx_data] - Принятые данные.[br] ## Возвращает [b]null[/b] - Если код команды не найден.[br] @@ -147,6 +174,19 @@ class YaU07: cmd_data = rx_data.slice(addr_pos, (addr_pos + ports_count * 4) - 1) return i > 0 + func parse_block(rx_data: PackedByteArray, status_len) -> bool: + var ports_count_pos = status_len + 7 # Положение в приёмном буфере количества портов + if rx_data.size() < ports_count_pos: + return false + var block_len = rx_data.decode_u16(ports_count_pos + 3) + var block_adr = rx_data.decode_u16(ports_count_pos + 5) + var block_data = [] + for i in block_len: + var shift: int = i * 2 + block_data.append(rx_data.decode_u16(ports_count_pos + 7 + shift)) + isa_block[block_adr] = block_data + return true + ## Заполняет состояние прибора данными прочитанными из портов ЯУ-07 ## для команд "читать порты" или "записать порты"[br] @@ -155,6 +195,8 @@ class YaU07: ## Возвращает [b]false[/b] - Данные не обработаны из за ошибки.[br] func parse(rx_data: PackedByteArray) -> bool: + cmd_tick_rx = tick + if not online: online = true emit_signal('line_changed', self) @@ -194,10 +236,17 @@ class YaU07: return false var cmd_code: CmdCode = rx_data[cmd_code_pos] as CmdCode # "код команды" + var rc = true if (cmd_code == CmdCode.READ_ISA) or (cmd_code == CmdCode.WRITE_ISA): - parse_isa(rx_data, status_len) + rc = parse_isa(rx_data, status_len) - if (cmd_state == CmdState.WAIT) and (cmd_num_rx == cmd_num_tx): - cmd_state = CmdState.DONE - emit_signal('command_done', self) + elif (cmd_code == CmdCode.READ_BLOCK) or (cmd_code == CmdCode.WRITE_BLOCK): + rc = parse_block(rx_data, status_len) + + if rc: + if (cmd_state == CmdState.WAIT) and (cmd_num_rx == cmd_num_tx): + cmd_state = CmdState.DONE + emit_signal('command_done', self) + else: + emit_signal('parse_failed', self) return true