maxim/uarep-ctl
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Merge remote-tracking branch 'MaD_CaT/master'

Browse Source
This commit is contained in:
sasha80
2024-05-29 11:10:18 +03:00
parent bf1968c51a d79c1502b9
commit a3aa0c50e6
8 changed files with 197 additions and 51 deletions
Download Patch File Download Diff File Expand all files Collapse all files

122
scripts/interfer.gd
View File

@@ -4,22 +4,29 @@ extends Node
## Режимы помехи
const ITERFER_MODE = {
'off': ['Откл', ['freq', 'width']],
'auto': ['АВТО', ['freq', 'width']],
'srni1': ['СРН-И1', ['freq', 'width']],
'srnm2': ['СРН-М2', ['freq', 'width']],
'lchm1': ['ЛЧМ-1', ['freq', 'width']],
'mchm1': ['МЧМ-1', ['freq', 'width']],
'pdm2': ['ПД-М2', ['freq', 'width']],
'pdm4': ['ПД-М4', ['freq', 'width']],
'pdm4s': ['ПД-М4С', ['freq', 'width']],
'pdchm': ['ПД-ЧМ', ['freq', 'width']],
'svi1': ['СВ-И1', ['freq', 'width']],
'svm2': ['СВ-М2', ['freq', 'width']],
'k1': ['K1', ['freq', 'width', 'dur', 'period']],
'ozp1': ['ОЗП-1', ['freq', 'width']] }
'off': ['Откл', ['freq', 'width'], 0],
'auto': ['АВТО', ['freq', 'width'], 1000],
'srni1': ['СРН-И1', ['freq', 'width'], 1],
'srnm2': ['СРН-М2', ['freq', 'width'], 2],
'srngps': ['СРН-GPS', ['freq', 'width'], 3],
'lchm1': ['ЛЧМ-1', ['freq', 'width'], 10],
'lchm2': ['ЛЧМ-2', ['freq', 'width'], 4],
'mchm1': ['МЧМ-1', ['freq', 'width'], 11],
'pdm2': ['ПД-М2', ['freq', 'width'], 12],
'pdm4': ['ПД-М4', ['freq', 'width'], 13],
'pdm4s': ['ПД-М4С', ['freq', 'width'], 14],
'pdchm': ['ПД-ЧМ', ['freq', 'width'], 15],
'svi1': ['СВ-И1', ['freq', 'width'], 20],
'svm2': ['СВ-М2', ['freq', 'width'], 21],
'k1': ['K1', ['freq', 'width', 'dur', 'period'], 50],
'ozp1': ['ОЗП-1', ['freq', 'width'], 51] }
const TYPE_TH = ['th','fs']
const FREQ_MAX = 6000
const FREQ_MIN = 400
const WIDTH_MAX = 120
const WIDTH_MIN = 0
const SOURCE_INTERFER = ['th','fs','cu']
const ID_INTERFERS_LEN = 63 ## Размер пула номеров целей
const INTERFER_OFF = 'off'
const STATE_TSMT = 5 ## Значение svk для цели, когда ответ ещё не получен
@@ -27,21 +34,21 @@ var msg_ss: int = 0 ## счётчик сообщений
var id_array: Array ## Массив id воздействий
var thrs: Dictionary ## Словарь воздействия для целей, ключ - id воздействия
var fs: Dictionary ## Словарь воздействий для секторов, ключ - id воздействия
var cu: Dictionary ## Словарь воздействий для 5П-28, ключ - id воздействия
## Сеанс помехи
class Interfer:
var ss: int = 0 ## Счётчик сообщений.
var ispp: int = 0 ## Индекс сеанса.
var svk: = 0 ## Состояние сеанса. Ответ КАПСРПБ. Возможные значения в [param ITERFER_STATE].
var krp: String = '' ## Тип помехи. Возможные значения в [param INTERFER_MODE].
var powp: float = 0.0 ## Мощность излучения выраженная в процентах.
var kni: = 0.0 ## Курсовой угол направления излучения.
var params: = {} ## Параметры помехи.
var get_params: Array[String] ## Запрос массива параметров (список запрошенных параметров).
var retss: int ## Значение счётчика сообщения в котором был произведён запрос массива параметров.
var tick_tx: int ## Тик время обновления цели, мс.
var type_th: String = '' ## Тип объекта по которой поставлена помеха
var ss: int = 0 ## Счётчик сообщений.
var ispp: int = 0 ## Индекс сеанса.
var svk: = 0 ## Состояние сеанса. Ответ КАПСРПБ. Возможные значения в [param ITERFER_STATE].
var krp: String = '' ## Тип помехи. Возможные значения в [param INTERFER_MODE].
var powp: float = 0.0 ## Мощность излучения выраженная в процентах.
var kni: = 0.0 ## Курсовой угол направления излучения.
var params: = {} ## Параметры помехи.
var get_params: Array[String] ## Запрос массива параметров (список запрошенных параметров).
var retss: int ## Значение счётчика сообщения в котором был произведён запрос массива параметров.
var tick_tx: int ## Тик время обновления цели, мс.
var source_interfer: String = '' ## Тип объекта по которой поставлена помеха
func _to_string() -> String:
return 'номер: %d название: %s частота: %0.1f МГц пеленг: %0.1f гр.' % [ispp, ITERFER_MODE[krp][0], params['freq'], kni]
@@ -92,13 +99,17 @@ func _ready():
id_array.append(i + 1)
var unit_key = repsettings.get_unit_key('уарэп-капсрпб-отп')
var unit = repnetwork.units[unit_key]
var unit_5p28_key = repsettings.get_unit_key('уарэп-5п28')
var unit_5p28 = repnetwork.units_tcp[unit_5p28_key]
var timer_check_state: = Timer.new()
add_child(timer_check_state)
var resend_timeout = ProjectSettings.get_setting('application/interfer/resend_timeout', 1000.0)
timer_check_state.connect('timeout', Callable(self, 'on_timer_check_state').bind(unit, ecms, resend_timeout))
timer_check_state.start(resend_timeout / 1000.0)
unit.connect('data_received', Callable(self, 'on_data_capsrpb_received').bind(ecms))
unit_5p28.connect('get_interfers', Callable(self, 'on_get_interfers').bind(unit_5p28, ecms))
signaller.connect('interfer_create', Callable(self, 'on_interfer_create').bind(unit, ecms))
signaller.connect('interfer_rcv', Callable(self, 'on_interfer_rcv').bind(unit_5p28, ecms))
signaller.connect('interfer_new', Callable(self, 'send_ecm').bind(unit))
signaller.connect('interfer_off_all', Callable(self, 'on_interfer_off_all').bind(unit, ecms))
@@ -145,33 +156,62 @@ func on_interfer_create(btn, sel_threats, fs_arr, _unit, ecms):
var param: Dictionary = {}
var kni: float = item.aoa
var id = item.id
var interfer_name: String = btn.get_meta('rfi_name')
param['freq'] = item.freq
param['width'] = item.width
interfer_create(btn, ecms, param, kni, id, thrs, item, TYPE_TH[0])
interfer_create(interfer_name, ecms, param, kni, id, thrs, SOURCE_INTERFER[0])
for item in fs_arr:
var param: Dictionary = {}
var kni: float = item[0]
var id = item[3]
var interfer_name: String = btn.get_meta('rfi_name')
param['freq'] = item[1]
param['width'] = item[2]
interfer_create(btn, ecms, param, kni, id, fs, item, TYPE_TH[1])
interfer_create(interfer_name, ecms, param, kni, id, fs, SOURCE_INTERFER[1])
func interfer_create(btn, ecms, param, kni, id, dict, item, type_th):
func on_interfer_rcv(interfer_params: Array, unit, ecms):
var err: bool = false
var mode = interfer_params[0]
var id = interfer_params[1]
var aoa = interfer_params[2]
if (aoa < 0) and (aoa > 360):
err = true
var param: Dictionary = {}
param['freq'] = interfer_params[4]
if (param['freq'] < FREQ_MIN) and (param['freq'] > FREQ_MAX):
err = true
param['width'] = interfer_params[5]
if (param['width'] < WIDTH_MIN) and (param['width'] > WIDTH_MAX):
err = true
var interfer_name: String
for key in ITERFER_MODE:
if ITERFER_MODE[key][2] == mode:
interfer_name = key
break
if interfer_name == '':
err = true
if not err:
interfer_create(interfer_name, ecms, param, aoa, id, cu, SOURCE_INTERFER[2])
unit.on_interfer_accept(err)
func interfer_create(interfer_name, ecms, param, kni, id, dict, source_interfer):
var ispp: int = 0
var interfer_name: String = btn.get_meta('rfi_name')
if interfer_name == 'k1':
param['dur'] = 1.0 # Необходимо добавить параметры управления
param['period'] = 1.0 # Необходимо добавить параметры управления
var key = dict.find_key(id)
if key != null:
ispp = key
else:
if interfer_name == 'off':
return
ispp = pop_id()
if ispp == 0: return
if source_interfer != SOURCE_INTERFER[2]:
if key != null:
ispp = key
else:
if interfer_name == 'off':
return
ispp = pop_id()
if ispp == 0: return
else: ispp = id
dict[ispp] = id
msg_ss += 1
var ecm: Interfer
@@ -187,7 +227,7 @@ func interfer_create(btn, ecms, param, kni, id, dict, item, type_th):
ecm.krp = interfer_name
ecm.params = param
ecm.powp = 100.0 # Необходимо добавить управление мощностью
ecm.type_th = type_th
ecm.source_interfer = source_interfer
signaller.emit_signal('interfer_new', ecm)
if interfer_name == 'off':
signaller.emit_signal('interfer_off', ecm, ecms, thrs)
@@ -220,3 +260,7 @@ func pop_id():
func push_id(id : int):
id_array.append(id)
id_array.sort()
## отправляет словаhь помех в юнит, для запаковки и отправки в 5П28
func on_get_interfers(unit, ecms): unit.pack_interfers(cu, ecms)

5
scripts/signaller.gd
View File

@@ -104,6 +104,11 @@ signal interfer_off (ecm: interfer.Interfer, ecms: Dictionary, thrs: Dictionary)
signal interfer_off_all ()
## Вызывается при получении внешнего целеуказания
## [param interfer_params] - Параметры полученной помехи от 5П-28.[br]
signal interfer_rcv(interfer_params: Array)
## Вызывается, когда отключается действующая помеха.[br]
## [param ecm] - Выбранная помеха
signal interfer_selected (ecm: interfer.Interfer)

72
scripts/tcp5p28.gd
View File

@@ -26,6 +26,14 @@ const MOD_TYPES: Array = ['',
'psk',
'ofdm',]
const CU_STATE: Dictionary = {
0:2, # Подготовка к выполнению
1:1, # Выполняется
2:9, # Ошибка в команде
3:7, # Занят выполнением другого ЦУ
4:9, # Неисправность
}
class TCP5P28:
const PACK_TYPE_CMD: int = 1
const PACK_TYPE_RES: int = 2
@@ -38,6 +46,7 @@ class TCP5P28:
signal command_fail(unit: TCP5P28) ## Сигнал при не выполнении команды
signal parse_error(unit: TCP5P28, msg: String) ## Сигнал ошибки разбора сообщения
signal get_threats(unit: TCP5P28) ## Сигнал запрос целей
signal get_interfers(unit: TCP5P28) ## Запрос состояния выполнения целеуказания
var online: = false ## Состояние связи с источником сообщений
var name: String ## Имя экземпляра
@@ -58,6 +67,11 @@ class TCP5P28:
var cmd_type = data.decode_u8(8)
if cmd_type == CMD_TYPE_TH:
emit_signal('get_threats')
if cmd_type == CMD_TYPE_STATE:
emit_signal('get_interfers')
var external_cu = ProjectSettings.get_setting('application/config/external_cu', false)
if cmd_type == CMD_TYPE_IN and external_cu:
set_interfer(data)
func process(now_tick: int):
if online and ((now_tick - rx_tick) > ONLINE_TIMEOUT):
@@ -70,19 +84,44 @@ class TCP5P28:
else:
return Error.ERR_UNAVAILABLE
func pack_threats(threats):
func pack_threats(ths):
var data = PackedByteArray()
var data_len = 4 + len(threats) * 80 # длинна блока данных в байтах
var data_len = 4 + len(ths) * 80 # длинна блока данных в байтах
var tick = Time.get_ticks_msec()
data.resize(4)
data.encode_u16(0, 0) # Код ошибки
data.encode_u16(2, len(threats)) # Количество целей
for th in threats.values():
data.encode_u16(2, len(ths)) # Количество целей
for th in ths.values():
data.append_array(get_threats_data(th, int(tick)))
var data_to_send: PackedByteArray = create_header(data_len)
data_to_send.append_array(data)
tx_stack.append(data_to_send)
func pack_interfers(interfers, ecms):
var data = PackedByteArray()
var data_len = 12 # длинна блока данных в байтах
data.resize(data_len)
data.encode_u16(0, 0) # Код ошибки
data.encode_u16(2, len(interfers)) # Количество целей
data.encode_u32(4, 0) # Состояние УА-РЕП
data.encode_u32(8, 0) # Состояние линий связи
for id in interfers.values():
var cu_data: PackedByteArray = []
cu_data.resize(4)
var cu = ecms[id]
cu_data.encode_u16(0, cu.ispp)
var state: int
if CU_STATE.has(cu.svk):
state = CU_STATE[cu.svk]
else:
state = 9
cu_data.encode_u8(2, state) # Состояние выполнения команды
cu_data.encode_u8(3, 0xFF) # Эффективность работы помехи
data.append_array(cu_data)
var data_to_send: PackedByteArray = create_header(data_len + 4 * len(interfers))
data_to_send.append_array(data)
tx_stack.append(data_to_send)
func create_header(data_len):
var head_data = PackedByteArray()
head_data.resize(8) # Размер заголовка
@@ -127,10 +166,29 @@ class TCP5P28:
th_data.encode_s32(76, int(th.lat * c1))
return th_data
func to_cp866(proto: String, th_data):
func to_cp866(proto: String, th_data):
var cp866_proto: PackedByteArray = proto.to_ascii_buffer()
cp866_proto.resize(36)
for i in len(cp866_proto):
th_data[28 + i] = cp866_proto[i]
func set_interfer(data):
var mode = data.decode_u8(9)
var id = data.decode_u16(10)
var aoa = float(data.decode_u16(12)) / 10
var ela = float(data.decode_u16(14)) / 10
var freq = data.decode_u16(16)
var width = data.decode_u16(18)
var interfer_params: Array = [mode, id, aoa, ela, freq, width]
signaller.emit_signal('interfer_rcv', interfer_params)
func on_interfer_accept(err: bool):
var data_tx = PackedByteArray()
var data_len = 2 # длинна блока данных в байтах
var tick = Time.get_ticks_msec()
data_tx.resize(data_len)
data_tx.encode_u16(0, err) # Код ошибки
var data_to_send: PackedByteArray = create_header(data_len)
data_to_send.append_array(data_tx)
tx_stack.append(data_to_send)

2
scripts/threats.gd
View File

@@ -74,7 +74,7 @@ func on_timer_check_lost(time_lost: int, threats: Dictionary):
call_deferred('emit_signal', 'threats_resized', threats)
## отправляет словапь целей в юнит, для запаковки и отправки в 5П28
## отправляет словарь целей в юнит, для запаковки и отправки в 5П28
func on_get_threats(unit, threats): unit.pack_threats(threats)