From 6fc6be666c5b583cc485a65b5d876b2caa0aedcf Mon Sep 17 00:00:00 2001 From: sasha80 Date: Tue, 2 Sep 2025 14:24:42 +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=9F=D0=BE=D0=B4=D1=81=D1=87=D1=91=D1=82=20?= =?UTF-8?q?=D0=BA=D0=BE=D0=BD=D1=82=D1=80=D0=BE=D0=BB=D1=8C=D0=BD=D0=BE?= =?UTF-8?q?=D0=B9=20=D1=81=D1=83=D0=BC=D0=BC=D1=83=20=D1=81=D0=BE=D0=B3?= =?UTF-8?q?=D0=BB=D0=B0=D1=81=D0=BE=D0=B2=D0=B0=D0=BD=20=D1=81=20=D0=A2?= =?UTF-8?q?=D1=83=D0=BB=D0=BE=D0=B9,=20=D1=80=D0=B0=D0=B7=D1=80=D0=B0?= =?UTF-8?q?=D0=B1=D0=BE=D1=82=D1=87=D0=B8=D0=BA=D0=B0=D0=BC=D0=B8=20=D0=A1?= =?UTF-8?q?=D0=9F=D0=A2-25?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- scripts/network.gd | 71 ++++++++++++++++++++++++++++++---------------- scripts/spt25.gd | 12 +++----- 2 files changed, 51 insertions(+), 32 deletions(-) diff --git a/scripts/network.gd b/scripts/network.gd index 3a0c46fc..8f9dbe2d 100644 --- a/scripts/network.gd +++ b/scripts/network.gd @@ -11,40 +11,63 @@ var tick: int = 0 class SocketSerial extends SerialPort: + const P_DIV: = 0x8408 + const FLAG: = 0x7e + const FLAG_MASK: = 0x20 + const FSC_MASK: = 0x8000 + const parity_code = { + 'N': SerialPort.PARITY_NONE, + 'E': SerialPort.PARITY_EVEN, + 'O': SerialPort.PARITY_ODD } + + var tx_buffer: PackedByteArray + + func _init() -> void: + tx_buffer.resize(256) + func send_to(data: PackedByteArray): - tools.allways(data.size() >= 3, 'длина буфера меньше необходимого') - var i_sum: = data.size() - 3 - data.encode_u16(i_sum, 0) + tx_buffer[0] = 0x7e + var i: = 1 + for v in data: + if v != 0x7e: + tx_buffer[i] = v + i += 1 + else: + tx_buffer[i] = FLAG + i += 1 + tx_buffer[i] = FLAG ^ FLAG_MASK + i += 1 var v_sum: = get_check_sum(data) - data.encode_u16(i_sum, v_sum) - write_raw(data) + tx_buffer.encode_u16(i, v_sum) + i += 2 + tx_buffer[i] = FLAG + i += 1 + write_raw(tx_buffer.slice(0, i)) func _to_string() -> String: return 'последовательный порт \"%s\" @ %d (%s)' % [self.port, self.baudrate, 'открыт' if is_open() else 'закрыт'] func get_check_sum(src: PackedByteArray) -> int: - var P_DIV: = 0xf0b8 - var FCS = ~((src[2]<<8) + src[1]) - for i in range(3, src.size()): - var C = src[i] - for j in 8: - if C & 1: - if FCS & 1: - FCS = ((FCS >> 1) | 0x8000) ^ P_DIV + var fsc: = ~((src[1]<<8) + src[0]) + for i: int in range(2, src.size()): + var chr: = src[i] + for j: int in 8: + if chr & 1: + if fsc & 1: + fsc = ((fsc >> 1) | FSC_MASK) ^ P_DIV else: - FCS = ((FCS >> 1) | 0x8000) + fsc = ((fsc >> 1) | FSC_MASK) else: - if FCS & 1: - FCS = (FCS >> 1) ^ P_DIV + if fsc & 1: + fsc = (fsc >> 1) ^ P_DIV else: - FCS = FCS >> 1 - C >>= 1 - for j in 16: - if FCS & 1: - FCS = (FCS >> 1) ^ P_DIV + fsc = fsc >> 1 + chr >>= 1 + for j: int in 16: + if fsc & 1: + fsc = (fsc >> 1) ^ P_DIV else: - FCS = FCS >> 1 - return ~FCS - + fsc = fsc >> 1 + return ~fsc func try_open(parsing_proc: Callable): if is_open(): diff --git a/scripts/spt25.gd b/scripts/spt25.gd index 002e5e98..632a38f6 100644 --- a/scripts/spt25.gd +++ b/scripts/spt25.gd @@ -15,16 +15,12 @@ class SPT25 extends unit.Unit: func _init(nm) -> void: self.name = nm - tx_data.resize(9) - tx_data[0] = 0x7e # Флаги синхронизации пакета - tx_data[1] = 0 # Адрес абонента, которому предназначен пакет - tx_data[2] = CmdCode.INFO # Тип пакета, КОД КОМАНДЫ - Получить информацию о состоянии преобразователя + tx_data.resize(5) + tx_data[0] = 0 # Адрес абонента, которому предназначен пакет + tx_data[1] = CmdCode.INFO # Тип пакета, КОД КОМАНДЫ - Получить информацию о состоянии преобразователя + tx_data[2] = 0 # Данные tx_data[3] = 0 # Данные tx_data[4] = 0 # Данные - tx_data[5] = 0 # Данные - tx_data[6] = 0 # Контрольная сумма мл. байт - tx_data[7] = 0 # Контрольная сумма ст. байт - tx_data[8] = 0x7e # Флаги синхронизации пакета func parse(rx_data: PackedByteArray, tick: int):