150 lines
5.4 KiB
GDScript
150 lines
5.4 KiB
GDScript
class_name trassa_unit
|
||
extends Node
|
||
|
||
const ONLINE_TIMEOUT: int = 5000 # Время ожидания данных
|
||
const REQUEST_PERIOD: int = 3000 # Период отправки, мс
|
||
const WORDS_TOTAL: int = 75
|
||
const NOINFO: int = 0x80000000
|
||
|
||
class Trassa extends unit.Unit:
|
||
|
||
var unit_caps = network.get_unit_instance('уарэп-капсрпб')
|
||
var source_addr: Array
|
||
var tx_stack: Array[int] = []
|
||
var msg_counter: int = 0
|
||
var ecms: Dictionary = {} # Словарь всех активных помех
|
||
var srn = 0
|
||
var jtids = 0
|
||
|
||
# Инициализация
|
||
func _init(nm: StringName) -> void:
|
||
self.name = nm
|
||
tx_stack.resize(WORDS_TOTAL)
|
||
tx_stack.fill(NOINFO)
|
||
interfer.connect("interfer_resized", Callable(self, "on_interfer_resized"))
|
||
|
||
|
||
# Обработка полученного пакета
|
||
func parse(rx_data: PackedByteArray, tick: int):
|
||
rx_tick = tick
|
||
if not online:
|
||
online = true
|
||
emit_signal("line_changed", self)
|
||
var words: Array[int] = []
|
||
var offset: int = 0
|
||
while offset < rx_data.size():
|
||
if offset + 4 <= rx_data.size():
|
||
var word = rx_data.decode_u32(offset)
|
||
words.append(word)
|
||
offset += 4
|
||
else:
|
||
break
|
||
if words.size() < 10:
|
||
emit_signal('parse_failed', self)
|
||
tx_stack.fill(NOINFO)
|
||
tx_stack[0] = words[0] # ID
|
||
tx_stack[1] = msg_counter # Nc
|
||
tx_stack[2] = 0x01 # Nб
|
||
tx_stack[3] = 0x00 # Ск
|
||
tx_stack[4] = 0x0194 # НТС
|
||
tx_stack[5] = (0x0001 << 16) | 0x0080 # Ии
|
||
tx_stack[6] = 0x01 # РКС
|
||
srn = words[7] # SRN
|
||
jtids = words[8] # JTIDS
|
||
btn_trassa_pressed()
|
||
interfer_data()
|
||
tx_stack[74] = _calc_crc(tx_stack)
|
||
emit_signal("data_received", self)
|
||
|
||
|
||
func interfer_data() -> void:
|
||
for i in range(67, 74):
|
||
tx_stack[i] = 0
|
||
for ecm in ecms.values():
|
||
if ecm.svk == 1:
|
||
var nmfs_value = ecm.nmfs
|
||
var fs_key = get_fs_key(nmfs_value)
|
||
if fs_key != NOINFO:
|
||
var string_index = fs_key / 4
|
||
var bit_position = fs_key % 4
|
||
if string_index >= 0 and string_index < 7:
|
||
var target_string = 67 + string_index
|
||
tx_stack[target_string] |= (1 << bit_position)
|
||
|
||
|
||
func get_fs_key(nmfs_value: int) -> int:
|
||
if prd.fs_caps_id.has(nmfs_value):
|
||
return prd.fs_caps_id[nmfs_value]
|
||
return NOINFO
|
||
|
||
|
||
# Отправка пакета от uarep-ctl
|
||
func process(now_tick: int) -> int:
|
||
if online and ((now_tick - rx_tick) > ONLINE_TIMEOUT):
|
||
online = false
|
||
emit_signal("line_changed", self)
|
||
if (now_tick - tx_tick) > REQUEST_PERIOD:
|
||
tx_tick = now_tick
|
||
msg_counter += 1
|
||
interfer_uarep()
|
||
interfer_data()
|
||
var data = PackedByteArray()
|
||
data.resize(WORDS_TOTAL * 4)
|
||
for i in range(WORDS_TOTAL):
|
||
data.encode_u32(i * 4, tx_stack[i])
|
||
tx_data = data
|
||
tx_len = WORDS_TOTAL * 4
|
||
return Error.OK
|
||
return Error.ERR_BUSY
|
||
|
||
|
||
# CRC вычисление
|
||
func _calc_crc(data: Array) -> int:
|
||
var acc: int = 0
|
||
for i in range(data.size() - 1): # кроме CRC
|
||
if i in [0, 1]:
|
||
continue
|
||
acc = (acc + (data[i] & 0xFFFFFFFF)) & 0xFFFFFFFF
|
||
return acc
|
||
|
||
|
||
# Обновление всех активных помех
|
||
func on_interfer_resized(ecms_dic: Dictionary) -> void: ecms = ecms_dic
|
||
|
||
|
||
func interfer_uarep() -> void:
|
||
tx_stack[65] = 0
|
||
tx_stack[66] = 0
|
||
for ecm in ecms.values():
|
||
if ecm.krp == "srni1" and ecm.svk == 1:
|
||
tx_stack[65] = 1
|
||
if ecm.krp == "svi1" and ecm.svk == 1:
|
||
tx_stack[66] = 1
|
||
tx_stack[1] = msg_counter
|
||
|
||
|
||
# Обработка указаний от Трассы по кнопке
|
||
func btn_trassa_pressed() -> void:
|
||
var state = ProjectSettings.get_setting('application/config/Внешнее указание Трасса', false)
|
||
if state == true:
|
||
if srn == 1:
|
||
tx_stack[65] = 1
|
||
signaller.emit_signal('interfer_prinuditelno', frm_ecm_list.srn_sectors)
|
||
else:
|
||
tx_stack[65] = 0
|
||
for ecm in ecms.values():
|
||
if ecm.krp == "srni1" and ecm.svk == 1:
|
||
ecm.krp = interfer.INTERFER_OFF
|
||
interfer.send_ecm(ecm, unit_caps)
|
||
signaller.emit_signal('interfer_off', ecm)
|
||
if jtids == 1:
|
||
tx_stack[66] = 1
|
||
signaller.emit_signal('interfer_prinuditelno', frm_ecm_list.jtids_sectors)
|
||
else:
|
||
tx_stack[66] = 0
|
||
for ecm in ecms.values():
|
||
if ecm.krp == "svi1" and ecm.svk == 1:
|
||
ecm.krp = interfer.INTERFER_OFF
|
||
interfer.send_ecm(ecm, unit_caps)
|
||
signaller.emit_signal('interfer_off', ecm)
|