diff --git a/project.godot b/project.godot index 00a4f64..c8cecac 100644 --- a/project.godot +++ b/project.godot @@ -145,6 +145,8 @@ external_cu=false default_reset="" power_supply="Ноды источников питания прибора" +fs_group="Группа модулей ФС" +y-5="" [gui] diff --git a/scenes/pribor-prd-k/kasseta-fs-kd.tscn b/scenes/pribor-prd-k/kasseta-fs-kd.tscn index d219213..ac2d952 100644 --- a/scenes/pribor-prd-k/kasseta-fs-kd.tscn +++ b/scenes/pribor-prd-k/kasseta-fs-kd.tscn @@ -34,13 +34,14 @@ offset_bottom = 183.0 fname = "Блок ФС-1" rname = "A4" -[node name="ref_A3" parent="." groups=["default_reset"] instance=ExtResource("3_kqnvt")] +[node name="ref_A3" parent="." groups=["default_reset", "fs_group"] instance=ExtResource("3_kqnvt")] offset_left = 55.0 offset_top = 33.0 offset_right = 105.0 offset_bottom = 183.0 fname = "Модуль ФС" rname = "A1" +metadata/fs = "fs_1" [node name="ref_A4" parent="." groups=["default_reset"] instance=ExtResource("3_kqnvt")] offset_left = 105.0 @@ -50,21 +51,23 @@ offset_bottom = 183.0 fname = "Блок ФС-2" rname = "A2" -[node name="ref_A6" parent="." groups=["default_reset"] instance=ExtResource("3_kqnvt")] +[node name="ref_A6" parent="." groups=["default_reset", "fs_group"] instance=ExtResource("3_kqnvt")] offset_left = 155.0 offset_top = 33.0 offset_right = 205.0 offset_bottom = 183.0 fname = "Модуль ФС" rname = "A5" +metadata/fs = "fs_6" -[node name="ref_A5" parent="." groups=["default_reset"] instance=ExtResource("3_kqnvt")] +[node name="ref_A5" parent="." groups=["default_reset", "fs_group"] instance=ExtResource("3_kqnvt")] offset_left = 205.0 offset_top = 33.0 offset_right = 255.0 offset_bottom = 183.0 fname = "Модуль ФС" rname = "A3" +metadata/fs = "fs_7" [node name="ref_A7" parent="." groups=["default_reset"] instance=ExtResource("3_kqnvt")] offset_left = 255.0 diff --git a/scenes/pribor-prd-k/pribor-prd-k.gd b/scenes/pribor-prd-k/pribor-prd-k.gd index 0024da2..8051033 100644 --- a/scenes/pribor-prd-k/pribor-prd-k.gd +++ b/scenes/pribor-prd-k/pribor-prd-k.gd @@ -1,20 +1,7 @@ @tool extends 'res://scenes/контроль/прибор.gd' -const Constants: Dictionary = { - 'IN_BLANK_PRD': 1, - 'OUT_BLANK_PRD': 13, - 'CI_1_OT_FS': 8, - 'CI_6_OT_FS': 13, - 'CI_7_OT_FS': 14, - 'CI_1_B_UF': 3, - 'CI_6_B_UF': 4, - 'CI_7_B_UF': 5, - 'CONST_MIN_TEMP': -25, - 'MAXIMUM_CODE_ADC': 3796, - 'MINIMUM_CODE_AD': 2660, - 'TEMPERATURE_UKP_1': 47, - 'TEMPERATURE_UKP_2': 79, +const constants_k: Dictionary = { 'POWER_UKP_1': 31, 'POWER_UKP_2': 63, 'DKM_BIT_1': 0, @@ -27,159 +14,166 @@ const Constants: Dictionary = { 'TEMP_THRESHOLD': 40, 'POWER_THRESHOLD': 40, 'TIMER_DELAY': 5.0, - 'dou_ray_nuber': 0x6, - 'attenutor_um_1': 0x7, - 'attenutor_um_2': 0x7, - 'attenutor_um_3': 0x0, + 'RAY_DOU_NUM': 0x3, + 'ATT_UM_1': 0x0, + 'ATT_UM_6': 0x7, + 'ATT_UM_7': 0x7, 'POWER_UM': 75, } # Конфигурация параметров для каждого прибора -const PRIBOR_CONFIG := { - '1к': {'angle': 0.0, 'sectors': [0, 20, 24]}, - '2к': {'angle': 90.0, 'sectors': [3, 23, 27]}, - '3к': {'angle': 180.0, 'sectors': [2, 22, 26]}, - '4к': {'angle': 270.0, 'sectors': [1, 21, 25]}, +const PRIBOR_CONFIG := { + '1к': {'angle': 0.0, 'sectors': [0, 20, 24]}, + '2к': {'angle': 90.0, 'sectors': [3, 23, 27]}, + '3к': {'angle': 180.0, 'sectors': [2, 22, 26]}, + '4к': {'angle': 270.0, 'sectors': [1, 21, 25]}, } # Конфигурация частот и ширин для каждого ФС -const FS_PARAMS := { - 1: {'freq': 450.0, 'width': 80.0}, - 6: {'freq': 2450.0, 'width': 110.0}, - 7: {'freq': 4750.0, 'width': 110.0} +const FS_PARAMS := { + 1: {'freq': 450.0, 'width': 80.0}, + 6: {'freq': 2450.0, 'width': 110.0}, + 7: {'freq': 4750.0, 'width': 110.0} } - enum STATE_VAL { NONE = 0, GOOD = 1, ERROR = 2 } -enum STATE_MASHINE { - INIT, - FS_TURN_ON, - FS_WORK, - UG_SET, - UM_RUN, - FS_TURN_OFF, - STOP_CONTROL, - AWAIT - } -var block_config_k := { - 'maa2000_1': [0, false], - 'maa2000_2': [1, false], - 'ip9_50_1': [2, false], - 'ip9_50_2': [3, false], - 'ip12_50_1': [4, false], - 'ip9_50_3': [5, false], - 'ip12_50_2': [6, false], - } -var fs_mapping_k = { - 0: { 'node': 'kasseta_fs_kd/ref_A3', 'condition': pribor == '1к' }, - 1: { 'node': 'kasseta_fs_kd/ref_A3', 'condition': pribor == '4к' }, - 2: { 'node': 'kasseta_fs_kd/ref_A3', 'condition': pribor == '3к' }, - 3: { 'node': 'kasseta_fs_kd/ref_A3', 'condition': pribor == '2к' }, - 20: { 'node': 'kasseta_fs_kd/ref_A6', 'condition': pribor == '1к' }, - 21: { 'node': 'kasseta_fs_kd/ref_A6', 'condition': pribor == '4к' }, - 22: { 'node': 'kasseta_fs_kd/ref_A6', 'condition': pribor == '3к' }, - 23: { 'node': 'kasseta_fs_kd/ref_A6', 'condition': pribor == '2к' }, - 24: { 'node': 'kasseta_fs_kd/ref_A5', 'condition': pribor == '1к' }, - 25: { 'node': 'kasseta_fs_kd/ref_A5', 'condition': pribor == '4к' }, - 26: { 'node': 'kasseta_fs_kd/ref_A5', 'condition': pribor == '3к' }, - 27: { 'node': 'kasseta_fs_kd/ref_A5', 'condition': pribor == '2к' }, - } + +var block_ip_config_k := { + 'maa2000_1': [0, false], + 'maa2000_2': [1, false], + 'ip9_50_1': [2, false], + 'ip9_50_2': [3, false], + 'ip12_50_1': [4, false], + 'ip9_50_3': [5, false], + 'ip12_50_2': [6, false], + 'ip5_25': [7, false], +} +# Проверка ДКМ +var block_dkm_config_k: = { + 'dkm_1': false, + 'dkm_6': false, + 'dkm_7': false, +} +# Проверка ФС +var block_fs_prd_config_k: = { + 'fs_1': false, + 'fs_6': false, + 'fs_7': false, +} +var block_kasseta_y5_prd_config_k: = { + 'yau07': false, + 'ems': false, + 'ug': false, + 'ukp1': false, + 'ukp2': false, +} # Основные переменные var current_fs: int = 1 -var state: int = STATE_MASHINE.INIT -var flag_check_dkm: bool = false -var flag_timer_started: bool = false - -var count_packet_1:int = 0 -var count_packet_6:int = 0 -var count_packet_7:int = 0 -var power_array_1: Array = [] -var power_array_2: Array = [] var ug_work_1: int = 0 var ug_work_2: int = 0 var ug_work_3: int = 0 -# Флаги и таймеры -var control_timer: Timer = Timer.new() var mashine_timer: Timer = Timer.new() -var pribor: String +var prd_k_module: Object +var unit_prd_k: Object # Результаты контроля -var _control_results: Dictionary = { +var control_results_k: Dictionary = { 'block_ip': false, # Проверка касет П1 и ИП МА2000 'temperature': true, # Проверка температур УМ - 'dkm_1': false, # Проверка ДКМ 1 - 'dkm_6': false, # Проверка ДКМ 6 - 'dkm_7': false, # Проверка ДКМ 7 - 'power_ip': false, # Мощность от УКП - 'fs_1': false, # Проверка ФС 1 - 'fs_6': false, # Проверка ФС 6 - 'fs_7': false, # Проверка ФС 7 + 'dkm': false, + 'dou': false, + 'power_um': false, # Мощность от УКП + 'fs': false, } -static var node_common_func = load('res://scripts/pribor-prd.gd') +var test = preload('res://scripts/pribor-prd.gd') +var control_prd_k: Object func _ready() -> void: if Engine.is_editor_hint(): return + initialize_connections() setup_timer() set_default_state() func on_state_mashine() -> void: - match state: - STATE_MASHINE.INIT: - if current_fs == 1 or current_fs == 6 or current_fs == 7: - state = STATE_MASHINE.FS_TURN_ON - else: - on_control_result() - state = STATE_MASHINE.AWAIT + control_prd_k.state_control_machine() - STATE_MASHINE.FS_TURN_ON: - node_common_func.manage_fs(true, pribor, PRIBOR_CONFIG, FS_PARAMS, current_fs, Constants.POWER_UM) - control_timer.wait_time = Constants.TIMER_DELAY - control_timer.start() - state = STATE_MASHINE.FS_WORK + block_kasseta_y5_prd_config_k = control_prd_k.block_kasseta_y5_config + var nodes_y5: Array = get_tree().get_nodes_in_group('y-5') + for node_y5 in nodes_y5: + var meta_y5 = node_y5.get_meta('y5') + if block_kasseta_y5_prd_config_k.has(meta_y5): + if block_kasseta_y5_prd_config_k['yau07'] == false: + node_y5.state = STATE_VAL.ERROR if meta_y5 == 'yau07' else STATE_VAL.NONE + return + node_y5.state = STATE_VAL.GOOD if block_kasseta_y5_prd_config_k[meta_y5] else STATE_VAL.ERROR - STATE_MASHINE.FS_WORK: - if (current_fs == 6 and flag_check_dkm and not flag_timer_started) or \ - (current_fs == 7 and flag_check_dkm and not flag_timer_started) or \ - (current_fs == 1 and not flag_timer_started): - state = STATE_MASHINE.UM_RUN + block_ip_config_k = control_prd_k.block_ip_config + var node_ip_power_arr: Array = get_tree().get_nodes_in_group('power_supply') + for power_supply in node_ip_power_arr: + var meta_ip = power_supply.get_meta('ip') + if block_ip_config_k.has(meta_ip) and block_kasseta_y5_prd_config_k.ug: + power_supply.state = STATE_VAL.GOOD if block_ip_config_k[meta_ip][1] else STATE_VAL.ERROR - STATE_MASHINE.UM_RUN: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.BASE_ADDR_EMS_G, 6666]]) - flag_timer_started = true - state = STATE_MASHINE.UG_SET + var fs_results: Dictionary = control_prd_k.block_fs_config + var fs_nodes: Array = get_tree().get_nodes_in_group('fs_group') + for f in fs_nodes: + var fs_meta: String = f.get_meta('fs') + if fs_results.has(fs_meta): + var new_state = fs_results[fs_meta] + f.state = new_state + fs_results[fs_meta] = new_state + + var dkm: Dictionary = control_prd_k.block_dkm_config + if control_prd_k.current_fs == 1 and fs_results.fs_1: + $kasseta_fs_kd/ref_A2.state = STATE_VAL.GOOD if dkm.dkm_1 else STATE_VAL.ERROR + elif control_prd_k.current_fs == 6 and fs_results.fs_6: + $kasseta_fs_kd/ref_A4.state = STATE_VAL.GOOD if dkm.dkm_6 else STATE_VAL.ERROR + elif control_prd_k.current_fs == 7 and fs_results.fs_7: + $kasseta_fs_kd/ref_A7.state = STATE_VAL.GOOD if dkm.dkm_7 else STATE_VAL.ERROR - STATE_MASHINE.UG_SET: - on_ug_setting() - state = STATE_MASHINE.FS_WORK - - STATE_MASHINE.FS_TURN_OFF: - node_common_func.manage_fs(false, pribor, PRIBOR_CONFIG, FS_PARAMS, current_fs, Constants.POWER_UM) - power_control_result() - state = STATE_MASHINE.STOP_CONTROL - - STATE_MASHINE.STOP_CONTROL: - flag_timer_started = false - flag_check_dkm = false - match current_fs: - 1: current_fs = 6 - 6: current_fs = 7 - 7: current_fs = 0 - state = STATE_MASHINE.INIT + #if not control_prd_k.power_result['ray_25_1'] or not control_prd_k.power_result['ray_25_6'] or not control_prd_k.power_result['ray_25_7']: + #return + if 1 == 1: + return + + var node_arr_power: Array = get_tree().get_nodes_in_group('power_amplifier') + for i_pow in node_arr_power.size(): + if i_pow < 1: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_k.power_result['ray_25_1'][i_pow]) + elif i_pow < 7: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_k.power_result['ray_25_6'][i_pow-1]) + elif i_pow < 13: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_k.power_result['ray_25_7'][i_pow-7]) func initialize_connections() -> void: - signaller.conn(signaller.fs_update_state, Callable(self, 'on_fs_update_state')) var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - var current_unit = unit_prd.name - var parts = current_unit.split('-') - pribor = parts[-1] - unit_prd.connect('data_received', Callable(self, 'on_data_received')) - unit_prd.connect('line_changed', Callable(self, 'on_line_changed')) + prd_k_module = prd.prd_dict[unit_name] + unit_prd_k = prd_k_module.unit_yau07 + + unit_prd_k.connect('line_changed', Callable(self, 'on_line_changed')) + var power_amplifiers: Array = get_tree().get_nodes_in_group('power_amplifier') + var init_data: Dictionary = { + 'control_label': $control_result, + 'power_amplifiers': power_amplifiers, + 'unit_prd': unit_prd_k, + 'module_prd' : prd_k_module, + 'constants': constants_k, + 'prd_config': PRIBOR_CONFIG, + 'fs_params': FS_PARAMS, + 'block_ip_prd_config': block_ip_config_k, + 'block_dkm_prd_config': block_dkm_config_k, + 'block_fs_prd_config': block_fs_prd_config_k, + 'block_kasseta_y5_prd_config': block_kasseta_y5_prd_config_k, + 'control_results': control_results_k, + 'current_fs': current_fs, + } + control_prd_k = test.TestPRD.new(init_data) + add_child(control_prd_k) func setup_timer() -> void: @@ -188,12 +182,6 @@ func setup_timer() -> void: mashine_timer.wait_time = 0.5 mashine_timer.start() - add_child(control_timer) - control_timer.connect('timeout', Callable(self, 'on_stop_control')) - control_timer.one_shot = true - control_timer.wait_time = 10.0 - control_timer.start() - func set_default_state() -> void: for group in get_tree().get_nodes_in_group('default_reset'): @@ -206,238 +194,56 @@ func set_default_state() -> void: func _enter_tree() -> void: if Engine.is_editor_hint(): return - $control_result.text = '' + $control_result.text = 'Выполняется ...' + $control_result.add_theme_color_override('font_color', Color.ALICE_BLUE) signaller.connect('режим_работа', Callable(self, 'on_mode_changed').bind(false)) func _exit_tree() -> void: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.ADDR_UG_LITERA_1, ug_work_1, Constants.ADDR_UG_LITERA_2, ug_work_2, Constants.ADDR_UG_LITERA_3, ug_work_3]]) - - -func on_line_changed(unit_prd: Object) -> void: - if not unit_prd.online: - set_default_state() - - -func on_data_received(unit_prd: Object) -> void: - if not is_inside_tree(): + if Engine.is_editor_hint(): return - - var status: PackedByteArray = unit_prd.status - # 1. Обновляем статусы блоков - block_config_k = node_common_func.check_block_ip(status, block_config_k) - # 2. Обновляем ноды power_supply - for power_supply in get_tree().get_nodes_in_group('power_supply'): - var meta_ip = power_supply.get_meta('ip') - if block_config_k.has(meta_ip): - power_supply.status = block_config_k[meta_ip][1] - - node_common_func.check_temperature_um(status, get_tree().get_nodes_in_group('power_amplifier')) - # Обработка данных ЭМС - #_process_ems_data(status) - - if current_fs == 1 and _control_results.fs_1: - flag_check_dkm = check_dkm(status, Constants.DKM_BIT_1) - elif current_fs == 6 and _control_results.fs_6: - flag_check_dkm = check_dkm(status, Constants.DKM_BIT_6) - elif current_fs == 7 and _control_results.fs_7: - flag_check_dkm = check_dkm(status, Constants.DKM_BIT_7) - - if flag_check_dkm: - _process_ukp_power(status) + prd_k_module.cmd_array.append([unit_prd_k.CmdCode.WRITE_ISA, [constants_k.ADDR_UG_LITERA_1, ug_work_1, constants_k.ADDR_UG_LITERA_2, ug_work_2, constants_k.ADDR_UG_LITERA_3, ug_work_3]]) -## Обрабатывает данные ЭМС и обновляет UI панели -#func _process_ems_data(status: PackedByteArray) -> void: - ### Контроль ЭМС - #var in_blank: int = status.decode_u16(Constants.IN_BLANK_PRD) - #var out_blank: int = status.decode_u16(Constants.OUT_BLANK_PRD) -# - ## Обновление фреймов для входных сигналов - #$Monitoring_panel/in_fs_1.frame = (in_blank >> Constants.CI_6_OT_FS) & 1 - #$Monitoring_panel/in_fs_2.frame = (in_blank >> Constants.CI_7_OT_FS) & 1 - #$Monitoring_panel/in_fs_3.frame = (in_blank >> Constants.CI_1_OT_FS) & 1 -# - ## Обновление фреймов для выходных сигналов ЭМС - #$Monitoring_panel/out_ems_1.frame = (out_blank >> Constants.CI_6_B_UF) & 1 - #$Monitoring_panel/out_ems_2.frame = (out_blank >> Constants.CI_7_B_UF) & 1 - #$Monitoring_panel/out_ems_3.frame = (out_blank >> Constants.CI_1_B_UF) & 1 - - -## Проверка ДКМ -func check_dkm(status_prd: PackedByteArray, bit_dkm: int) -> bool: - const DKM: int = 28 - - var status_dkm = status_prd[DKM] >> bit_dkm & 1 - print(status_prd[DKM]) - if bit_dkm == 5: - $dou6_A7.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - $kasseta_fs_kd/ref_A4.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_6'] = status_dkm - elif bit_dkm == 6: - $dou7_A8.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - $kasseta_fs_kd/ref_A7.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_7'] = status_dkm - elif bit_dkm == 0: - $kasseta_fs_kd/ref_A2.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_1'] = status_dkm - return status_dkm - - -func _process_ukp_power(status: PackedByteArray) -> void: - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - if current_fs == 1: - ## Мощность от УМ (УКП) литеры 1 - var arr_power_ukp_1: Array = [] - var power_ukp_1: int - power_ukp_1 = status.decode_u16(Constants.POWER_UKP_1 + 2 * 7) - arr_power_ukp_1.append(power_ukp_1) - - if count_packet_1 == 0: - power_array_1 = arr_power_ukp_1 - else: - for i in arr_power_ukp_1.size(): - if arr_power_ukp_1[i] > power_array_1[i]: - power_array_1[i] = arr_power_ukp_1[i] - - power_amplifier[6].value1 = '%d' % power_array_1[0] - power_amplifier[6].state = STATE_VAL.GOOD if power_array_1[0] > Constants.TEMP_THRESHOLD else STATE_VAL.ERROR - - count_packet_1 += 1 - - elif current_fs == 6: - ## Мощность УМ от УКП 1 - var arr_power_ukp_1: Array = [] - if (status[0] >> 2) & 1: - var power_ukp_1: int - for i_power in range(6): - power_ukp_1 = status.decode_u16(Constants.POWER_UKP_1 + 2 * i_power) - arr_power_ukp_1.append(power_ukp_1) - - if count_packet_6 == 0: - power_array_1 = arr_power_ukp_1 - else: - for i in arr_power_ukp_1.size(): - if arr_power_ukp_1[i] > power_array_1[i]: - power_array_1[i] = arr_power_ukp_1[i] - - for i in 6: - power_amplifier[i].value1 = '%d' % power_array_1[i] - power_amplifier[i].state = STATE_VAL.GOOD if power_array_1[i] > Constants.TEMP_THRESHOLD else STATE_VAL.ERROR - count_packet_6 += 1 - - elif current_fs == 7: - ## Мощность УМ от УКП 2 - var arr_power_ukp_2: Array = [] - if (status[0] >> 2) & 1: - for i_power in range(6): - var power_ukp_2 = status.decode_u16(Constants.POWER_UKP_2 + 2 * i_power) - arr_power_ukp_2.append(power_ukp_2) - - if count_packet_7 == 0: - power_array_2 = arr_power_ukp_2 - else: - for i in arr_power_ukp_2.size(): - if arr_power_ukp_2[i] > power_array_2[i]: - power_array_2[i] = arr_power_ukp_2[i] - - for i in 6: - power_amplifier[i+7].value1 = '%d' % power_array_2[i] - power_amplifier[i+7].state = STATE_VAL.GOOD if power_array_2[i] > Constants.TEMP_THRESHOLD else STATE_VAL.ERROR - - count_packet_7 += 1 - - -func power_control_result() -> void: - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - _control_results['power_ukp'] = true - for amp in power_amplifier: - if amp.state != STATE_VAL.GOOD: - _control_results['power_ukp'] = false - break - - -func on_stop_control() -> void: - state = STATE_MASHINE.FS_TURN_OFF - - -func on_fs_update_state(packet_type_7: Dictionary, fs_mapping: Dictionary) -> void: - # Словарь для маппинга: ключ - номер FS, значение - целевая нода и условие прибора - - for fs in packet_type_7: - if fs in fs_mapping and fs_mapping[fs]['condition']: - var data = packet_type_7[fs] - if fs < 4 and current_fs == 1: - _control_results['fs_1'] = (data.isg == 1) - var state_fs = STATE_VAL.GOOD if data.isg == 1 else STATE_VAL.ERROR if data.isg == 0 else STATE_VAL.NONE - var node_name = fs_mapping[fs]['node'] - var node = get_node(node_name) - node.state = state_fs - elif fs < 24 and current_fs == 6: - _control_results['fs_6'] = (data.isg == 1) - var state_fs = STATE_VAL.GOOD if data.isg == 1 else STATE_VAL.ERROR if data.isg == 0 else STATE_VAL.NONE - var node_name = fs_mapping[fs]['node'] - var node = get_node(node_name) - node.state = state_fs - elif fs > 23 and current_fs == 7: - _control_results['fs_7'] = (data.isg == 1) - var state_fs = STATE_VAL.GOOD if data.isg == 1 else STATE_VAL.ERROR if data.isg == 0 else STATE_VAL.NONE - var node_name = fs_mapping[fs]['node'] - var node = get_node(node_name) - node.state = state_fs - - -func on_ug_setting() -> void: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.units[unit_name] - - var result_1 = ((Constants.attenutor_um_1 & 0x07) << 3) | (Constants.dou_ray_nuber & 0x07) - var result_2 = ((Constants.attenutor_um_2 & 0x07) << 3) | (Constants.dou_ray_nuber & 0x07) - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.ADDR_UG_LITERA_1, result_1, - Constants.ADDR_UG_LITERA_2, result_2, - Constants.ADDR_UG_LITERA_3, Constants.attenutor_um_3]]) - - prd_module.cmd_array.append([unit_prd.CmdCode.READ_ISA, [Constants.ADDR_UG_LITERA_1, Constants.ADDR_UG_LITERA_2, Constants.ADDR_UG_LITERA_3]]) +func on_line_changed(unit_pribor: Object) -> void: + if not unit_pribor.online: + set_default_state() func on_mode_changed(in_tree: bool) -> void: if not in_tree: queue_free() +# +#func on_control_result() -> void: + #var pribor = 'her' + #var all_blocks_ok = true + #for block in block_ip_config_k: + #if not block_ip_config_k[block][1]: + #all_blocks_ok = false + #break + #control_results_k['block_ip'] = all_blocks_ok -func on_control_result() -> void: - #Обновляем _control_results['block_ip'] на основе block_config_k - var all_blocks_ok = true - for block in block_config_k: - if not block_config_k[block][1]: # Если хоть один блок false - all_blocks_ok = false - break - _control_results['block_ip'] = all_blocks_ok - - # Словарь соответствия ключей ошибок и нод - var error_nodes := { - 'fs_1': $kasseta_fs_kd/ref_A3, - 'fs_6': $kasseta_fs_kd/ref_A6, - 'fs_7': $kasseta_fs_kd/ref_A5 - } - # Проверка результатов и установка состояний - var result: bool = true - for key in _control_results: - if not _control_results[key]: - result = false - if error_nodes.has(key): - error_nodes[key].state = STATE_VAL.ERROR - - # Установка текста и цвета результата - var status_text := 'неисправен' - var status_color := Color.CRIMSON - if result: - status_text = 'исправен' - status_color = Color.AQUAMARINE - - $control_result.text = 'Прибор ПРД-%s %s' % [pribor, status_text] - $control_result.add_theme_color_override('font_color', status_color) + ## Словарь соответствия ключей ошибок и нод + #var error_nodes := { + #'fs_1': $kasseta_fs_kd/ref_A3, + #'fs_6': $kasseta_fs_kd/ref_A6, + #'fs_7': $kasseta_fs_kd/ref_A5 + #} + ## Проверка результатов и установка состояний + #var result: bool = true + #for key in control_results_k: + #if not control_results_k[key]: + #result = false + #if error_nodes.has(key): + #error_nodes[key].state = STATE_VAL.ERROR +# + ## Установка текста и цвета результата + #var status_text := 'неисправен' + #var status_color := Color.RED + #if result: + #status_text = 'исправен' + #status_color = Color.GREEN +# + #$control_result.text = 'Прибор ПРД-%s %s' % [pribor, status_text] + #$control_result.add_theme_color_override('font_color', status_color) diff --git a/scenes/pribor-prd-k/pribor-prd-k.tscn b/scenes/pribor-prd-k/pribor-prd-k.tscn index 7a12d7f..acb6db2 100644 --- a/scenes/pribor-prd-k/pribor-prd-k.tscn +++ b/scenes/pribor-prd-k/pribor-prd-k.tscn @@ -1,10 +1,9 @@ -[gd_scene load_steps=16 format=3 uid="uid://m5s87q7m66lj"] +[gd_scene load_steps=15 format=3 uid="uid://m5s87q7m66lj"] [ext_resource type="PackedScene" uid="uid://d3iqb5e4g81m5" path="res://scenes/контроль/элемент-г.tscn" id="1_8dmgr"] [ext_resource type="Script" uid="uid://cwvikiygf8b1m" path="res://scenes/pribor-prd-k/pribor-prd-k.gd" id="1_tpdyp"] [ext_resource type="Texture2D" uid="uid://c4mdrmk7h638f" path="res://data/nine-patch-round.png" id="2_14h25"] [ext_resource type="PackedScene" uid="uid://cm5jd4gjrrpba" path="res://scenes/контроль/кассета-у-5-к.tscn" id="2_tb85r"] -[ext_resource type="Script" uid="uid://dow4nqi6hbak8" path="res://scenes/контроль/кассета-у-5.gd" id="3_wip3a"] [ext_resource type="PackedScene" uid="uid://bkxblfoj7ejv0" path="res://scenes/контроль/блок-а.tscn" id="6_fmhtx"] [ext_resource type="PackedScene" uid="uid://bmagw8nd0ulhj" path="res://scenes/pribor-prd-k/kasseta-fs-kd.tscn" id="7_ia27q"] [ext_resource type="Script" uid="uid://crpedygm3gohi" path="res://scenes/контроль/кассета.gd" id="7_xpa2n"] @@ -51,8 +50,6 @@ offset_left = 175.0 offset_top = 242.0 offset_right = 485.0 offset_bottom = 432.0 -script = ExtResource("3_wip3a") -fname = "Кассета У5" [node name="maa2000_A22" parent="." groups=["default_reset", "power_supply"] instance=ExtResource("1_8dmgr")] layout_mode = 0 diff --git a/scenes/pribor-prd-n/kasseta-fs-nd.tscn b/scenes/pribor-prd-n/kasseta-fs-nd.tscn index 9ad7bd9..4eee49c 100644 --- a/scenes/pribor-prd-n/kasseta-fs-nd.tscn +++ b/scenes/pribor-prd-n/kasseta-fs-nd.tscn @@ -34,21 +34,23 @@ offset_bottom = 182.0 fname = "Блок ФС-3" rname = "A3" -[node name="ref_A3" parent="." instance=ExtResource("2_mkgdh")] +[node name="ref_A3" parent="." groups=["fs_group"] instance=ExtResource("2_mkgdh")] offset_left = 105.0 offset_top = 32.0 offset_right = 155.0 offset_bottom = 182.0 fname = "Модуль ФС" rname = "A1" +metadata/fs = "fs_4" -[node name="ref_A4" parent="." instance=ExtResource("2_mkgdh")] +[node name="ref_A4" parent="." groups=["fs_group"] instance=ExtResource("2_mkgdh")] offset_left = 155.0 offset_top = 32.0 offset_right = 205.0 offset_bottom = 182.0 fname = "Модуль ФС" rname = "A2" +metadata/fs = "fs_5" [node name="ref_A6" parent="." instance=ExtResource("2_mkgdh")] offset_left = 205.0 diff --git a/scenes/pribor-prd-n/pribor-prd-n.gd b/scenes/pribor-prd-n/pribor-prd-n.gd index 0aca3e9..13813b2 100644 --- a/scenes/pribor-prd-n/pribor-prd-n.gd +++ b/scenes/pribor-prd-n/pribor-prd-n.gd @@ -1,13 +1,7 @@ @tool extends 'res://scenes/контроль/прибор.gd' -const Constants = { - 'IN_BLANK_PRD': 1, - 'OUT_BLANK_PRD': 13, - 'CI_2_OT_FS': 9, - 'CI_3_OT_FS': 10, - 'CI_2_B_UF': 4, - 'CI_3_B_UF': 5, +const constants_n = { 'POWER_UKP_1': 31, 'POWER_UKP_2': 63, 'DKM_BIT_2': 1, @@ -15,122 +9,159 @@ const Constants = { 'BASE_ADDR_EMS_G': 0x120, 'ADDR_UG_LITERA_1': 0x106, 'ADDR_UG_LITERA_2': 0x108, + 'ADDR_UG_LITERA_3': 0x10A, 'TEMP_THRESHOLD': 70, 'POWER_THRESHOLD': 40, - 'RAY_DOU': 3, + 'TIMER_DELAY': 5.0, + 'RAY_DOU_NUM': 0x3, 'ATT_UM_2': 0x7, 'ATT_UM_3': 0x7, - 'TIMER_DELAY': 5.0, 'POWER_UM': 70, } +# Конфигурация параметров для каждого прибора +const PRIBOR_CONFIG_N := { + '1н': {'angle': 0.0, 'sectors': [4, 8]}, + '2н': {'angle': 90.0, 'sectors': [7, 11]}, + '3н': {'angle': 180.0, 'sectors': [6, 10]}, + '4н': {'angle': 270.0, 'sectors': [5, 9]}, +} +# Конфигурация частот и ширин для каждого ФС +const FS_PARAMS_N := { + 2: {'freq': 900.0, 'width': 100.0}, + 3: {'freq': 1157.0, 'width': 100.0} +} enum STATE_VAL { NONE = 0, GOOD = 1, ERROR = 2 } -enum STATE_MASHINE { - INIT, - FS_TURN_ON, - FS_WORK, - UG_SET, - UM_RUN, - FS_TURN_OFF, - STOP_CONTROL, - AWAIT - } -# Основные переменные -var current_fs: int = 2 -var state: int = STATE_MASHINE.INIT -var flag_check_dkm: bool = false -var flag_timer_started: bool = false - -var count_packet_2:int = 0 -var count_packet_3:int = 0 -var power_array_2: Array = [] -var power_array_3: Array = [] -var pribor: String -var ug_work_2: int -var ug_work_3: int -# Флаги и таймеры -var control_timer: Timer = Timer.new() -var mashine_timer: Timer = Timer.new() - -# Результаты контроля -var _control_results: Dictionary = { - 'block_ip': false, # Проверка касет П1 и ИП МА2000 - 'temperature': true, # Проверка температур УМ - 'dkm_2': false, # Проверка ДКМ - 'dkm_3': false, # Проверка ДКМ - 'power_ukp': false, # Мощность от УКП - 'fs_2': false, # Проверка ФС +var block_ip_config_n:= { + 'maa2000_1': [0, false], + 'maa2000_2': [1, false], + 'ip9_50_1': [2, false], + 'ip9_50_2': [3, false], + 'ip12_50_1': [4, false], + 'ip5_25': [7, false], +} +# Проверка ДКМ +var block_dkm_config_n: = { + 'dkm_2': false, + 'dkm_3': false, +} +# Проверка ФС +var block_fs_prd_config_n: = { + 'fs_2': false, 'fs_3': false, } +var block_kasseta_y5_prd_config_n: = { + 'yau07': false, + 'ems': false, + 'ug': false, + 'ukp1': false, + 'ukp2': false, +} + +# Основные переменные +var current_fs: int = 2 +var ug_work_1: int = 0 +var ug_work_2: int = 0 +# Флаги и таймеры +var mashine_timer: Timer = Timer.new() +var prd_n_module: Object +var unit_prd_n: Object +var control_prd_n: Object +# Результаты контроля +var control_results_n: Dictionary = { + 'block_ip': false, # Проверка касет П1 и ИП МА2000 + 'temperature': true, # Проверка температур УМ + 'dkm': false, + 'dou': false, + 'power_um': false, # Мощность от УКП + 'fs': false, +} +var test = preload('res://scripts/pribor-prd.gd') + + +################################ +func on_state_mashine() -> void: + control_prd_n.state_control_machine() + + block_kasseta_y5_prd_config_n = control_prd_n.block_kasseta_y5_config + var nodes_y5: Array = get_tree().get_nodes_in_group('y-5') + for node_y5 in nodes_y5: + var meta_y5 = node_y5.get_meta('y5') + if block_kasseta_y5_prd_config_n.has(meta_y5): + if block_kasseta_y5_prd_config_n['yau07'] == false: + node_y5.state = STATE_VAL.ERROR if meta_y5 == 'yau07' else STATE_VAL.NONE + return + node_y5.state = STATE_VAL.GOOD if block_kasseta_y5_prd_config_n[meta_y5] else STATE_VAL.ERROR + + block_ip_config_n = control_prd_n.block_ip_config + var node_ip_power_arr: Array = get_tree().get_nodes_in_group('power_supply') + for power_supply in node_ip_power_arr: + var meta_ip = power_supply.get_meta('ip') + if block_ip_config_n.has(meta_ip) and block_kasseta_y5_prd_config_n.ug: + power_supply.state = STATE_VAL.GOOD if block_ip_config_n[meta_ip][1] else STATE_VAL.ERROR + + var fs_results: Dictionary = control_prd_n.block_fs_config + var fs_nodes: Array = get_tree().get_nodes_in_group('fs_group') + for f in fs_nodes: + var fs_meta: String = f.get_meta('fs') + if fs_results.has(fs_meta): + var new_state = fs_results[fs_meta] + f.state = new_state + fs_results[fs_meta] = new_state + + var dkm: Dictionary = control_prd_n.block_dkm_config + if control_prd_n.current_fs == 2 and fs_results.fs_2: + $kasseta_FS_ND/ref_A4.state = STATE_VAL.GOOD if dkm.dkm_2 else STATE_VAL.ERROR + elif control_prd_n.current_fs == 3 and fs_results.fs_3: + $kasseta_FS_ND/ref_A3.state = STATE_VAL.GOOD if dkm.dkm_3 else STATE_VAL.ERROR + + #if not control_prd_n.power_result['ray_25_2'] or not control_prd_n.power_result['ray_25_3']: + if 1 == 1: + return + + var node_arr_power: Array = get_tree().get_nodes_in_group('power_amplifier') + for i_pow in node_arr_power.size(): + if i_pow < 6: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_n.power_result['ray_25_2'][i_pow]) + elif i_pow < 12: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_n.power_result['ray_25_3'][i_pow-6]) + func _ready() -> void: + if Engine.is_editor_hint(): + return + initialize_connections() setup_timer() set_default_state() -func on_state_mashine() -> void: - match state: - STATE_MASHINE.INIT: - print('Текущий запуск current_fs: ', current_fs) - if current_fs == 2 or current_fs == 3: - state = STATE_MASHINE.FS_TURN_ON - else: - on_control_result() - state = STATE_MASHINE.AWAIT - - STATE_MASHINE.FS_TURN_ON: - print('FS_TURN_ON') - _on_control_fs(true) - control_timer.wait_time = Constants.TIMER_DELAY - control_timer.start() - state = STATE_MASHINE.FS_WORK - - STATE_MASHINE.FS_WORK: - print('FS_WORK') - if (current_fs == 2 and flag_check_dkm and not flag_timer_started) or \ - (current_fs == 3 and flag_check_dkm and not flag_timer_started): - state = STATE_MASHINE.UM_RUN - - STATE_MASHINE.UM_RUN: - print('UM_RUN') - var unit_key = settings.get_unit_key(get_meta('unit_name')[0]) - var unit_prd = network.units[unit_key] - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.BASE_ADDR_EMS_G, 6666]]) - flag_timer_started = true - state = STATE_MASHINE.UG_SET - - STATE_MASHINE.UG_SET: - print('UG_SET') - on_ug_setting() - state = STATE_MASHINE.FS_WORK - - STATE_MASHINE.FS_TURN_OFF: - print('FS_TURN_OFF') - _on_control_fs(false) - power_control_result() - state = STATE_MASHINE.STOP_CONTROL - - STATE_MASHINE.STOP_CONTROL: - print('STOP_CONTROL') - flag_timer_started = false - flag_check_dkm = false - match current_fs: - 2: current_fs = 3 - 3: current_fs = 0 - state = STATE_MASHINE.INIT - - func initialize_connections() -> void: - signaller.conn(signaller.fs_update_state, Callable(self, 'on_fs_update_state')) var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - var current_unit = unit_prd.name - var parts = current_unit.split('-') - pribor = parts[-1] - unit_prd.connect('data_received', Callable(self, 'on_data_received')) - unit_prd.connect('line_changed', Callable(self, 'on_line_changed')) + prd_n_module = prd.prd_dict[unit_name] + unit_prd_n = prd_n_module.unit_yau07 + + unit_prd_n.connect('line_changed', Callable(self, 'on_line_changed')) + var power_amplifiers: Array = get_tree().get_nodes_in_group('power_amplifier') + var init_data: Dictionary = { + 'control_label': $control_result, + 'power_amplifiers': power_amplifiers, + 'unit_prd': unit_prd_n, + 'module_prd' : prd_n_module, + 'constants': constants_n, + 'prd_config': PRIBOR_CONFIG_N, + 'fs_params': FS_PARAMS_N, + 'block_ip_prd_config': block_ip_config_n, + 'block_dkm_prd_config': block_dkm_config_n, + 'block_fs_prd_config': block_fs_prd_config_n, + 'block_kasseta_y5_prd_config': block_kasseta_y5_prd_config_n, + 'control_results': control_results_n, + 'current_fs': current_fs, + } + control_prd_n = test.TestPRD.new(init_data) + add_child(control_prd_n) func setup_timer() -> void: @@ -139,12 +170,6 @@ func setup_timer() -> void: mashine_timer.wait_time = 0.5 mashine_timer.start() - add_child(control_timer) - control_timer.connect('timeout', Callable(self, 'on_stop_control')) - control_timer.one_shot = true - control_timer.wait_time = 10.0 - control_timer.start() - func set_default_state() -> void: for group in get_tree().get_nodes_in_group('default_reset'): @@ -155,304 +180,48 @@ func set_default_state() -> void: func _enter_tree() -> void: - $control_result.text = '' + if Engine.is_editor_hint(): + return + $control_result.text = 'Выполняется ...' + $control_result.add_theme_color_override('font_color', Color.ALICE_BLUE) signaller.connect('режим_работа', Callable(self, 'on_mode_changed').bind(false)) func _exit_tree() -> void: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - var prd_module = prd.prd_dict[unit_prd.name] - - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.ADDR_UG_LITERA_1, ug_work_2, Constants.ADDR_UG_LITERA_2, ug_work_3]]) - - -func on_line_changed(unit_prd: Object) -> void: - if not unit_prd.online: - set_default_state() - - -func on_data_received(unit_prd: Object) -> void: - if not is_inside_tree(): + if Engine.is_editor_hint(): return - - var status = unit_prd.status - check_block_ip(status) - check_temperature_um(status) - # Обработка данных ЭМС - _process_ems_data(status) - - if current_fs == 2 and _control_results.fs_2: - flag_check_dkm = check_dkm(status, Constants.DKM_BIT_2) - elif current_fs == 3 and _control_results.fs_3: - flag_check_dkm = check_dkm(status, Constants.DKM_BIT_3) - - if _control_results.fs_2 or _control_results.fs_3: - # Обработка мощности от УКП - _process_ukp_power(status) + prd_n_module.cmd_array.append([unit_prd_n.CmdCode.WRITE_ISA, [constants_n.ADDR_UG_LITERA_1, ug_work_1, constants_n.ADDR_UG_LITERA_2, ug_work_2]]) -# Обрабатывает данные ЭМС и обновляет UI панели -func _process_ems_data(status: PackedByteArray) -> void: - ## Контроль ЭМС - var in_blank: int = status.decode_u16(Constants.IN_BLANK_PRD) - var out_blank: int = status.decode_u16(Constants.OUT_BLANK_PRD) - - # Обновление фреймов для входных сигналов - $Monitoring_panel/in_fs_1.frame = (in_blank >> Constants.CI_2_OT_FS) & 1 - $Monitoring_panel/in_fs_2.frame = (in_blank >> Constants.CI_3_OT_FS) & 1 - - # Обновление фреймов для выходных сигналов ЭМС - $Monitoring_panel/out_ems_1.frame = (out_blank >> Constants.CI_2_B_UF) & 1 - $Monitoring_panel/out_ems_2.frame = (out_blank >> Constants.CI_3_B_UF) & 1 - - -## Проверка касет П1 и ИП МА2000 -func check_block_ip(status_prd: PackedByteArray) -> void : - var ug_online: bool = (status_prd[0] >> 1) & 1 - if ug_online: - const BYTE_DRY_CONTACT: int = 27 - const BIT_MAA2000_1: int = 0 - const BIT_MAA2000_2: int = 1 - const BIT_IP9_50_1: int = 2 - const BIT_IP9_50_2: int = 3 - const BIT_IP12_50_1: int = 4 - - var maa2000_1 = status_prd[BYTE_DRY_CONTACT] >> BIT_MAA2000_1 & 1 - var maa2000_2 = status_prd[BYTE_DRY_CONTACT] >> BIT_MAA2000_2 & 1 - var ip9_50_1 = status_prd[BYTE_DRY_CONTACT] >> BIT_IP9_50_1 & 1 - var ip9_50_2 = status_prd[BYTE_DRY_CONTACT] >> BIT_IP9_50_2 & 1 - var ip12_50_1 = status_prd[BYTE_DRY_CONTACT] >> BIT_IP12_50_1 & 1 - - $maa2000_A23.state = STATE_VAL.ERROR if maa2000_1 else STATE_VAL.GOOD - $maa2000_A22.state = STATE_VAL.ERROR if maa2000_2 else STATE_VAL.GOOD - $kasseta_P_1/ref_A20.state = STATE_VAL.ERROR if ip9_50_1 else STATE_VAL.GOOD - $kasseta_P_1/ref_A21.state = STATE_VAL.ERROR if ip9_50_2 else STATE_VAL.GOOD - $kasseta_P_1/ref_A19.state = STATE_VAL.ERROR if ip12_50_1 else STATE_VAL.GOOD - else: - $maa2000_A23.state = STATE_VAL.NONE - $maa2000_A22.state = STATE_VAL.NONE - $kasseta_P_1/ref_A19.state = STATE_VAL.NONE - $kasseta_P_1/ref_A20.state = STATE_VAL.NONE - $kasseta_P_1/ref_A21.state = STATE_VAL.NONE - - _control_results['block_ip'] = ( - $maa2000_A23.state == STATE_VAL.GOOD and - $maa2000_A22.state == STATE_VAL.GOOD and - $kasseta_P_1/ref_A19.state == STATE_VAL.GOOD and - $kasseta_P_1/ref_A20.state == STATE_VAL.GOOD and - $kasseta_P_1/ref_A21.state == STATE_VAL.GOOD - ) - - -## Проверка температур УМ от УКП -func check_temperature_um(status_prd: PackedByteArray) -> void: - const CONST_MIN_TEMP: int = -25 - const MAXIMUM_CODE_ADC: int = 3796 - const MINIMUM_CODE_AD: int = 2660 - const TEMP: float = 115.0 / (MAXIMUM_CODE_ADC - MINIMUM_CODE_AD) - const TEMPERATURE_UKP_1: int = 47 - const TEMPERATURE_UKP_2: int = 79 - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - - var ukp1_online: int = (status_prd[0] >> 2) & 1 - if ukp1_online: - for i_temp in range(6): - var temperature_ukp_1: int = status_prd.decode_u16(TEMPERATURE_UKP_1 + 2 * i_temp) - var tmp_1: int = round(CONST_MIN_TEMP + (MAXIMUM_CODE_ADC - temperature_ukp_1) * TEMP + 3) - power_amplifier[i_temp].value0 = tmp_1 - if tmp_1 > Constants.TEMP_THRESHOLD: - _control_results['temperature'] = false - var ukp2_online = (status_prd[0] >> 3) & 1 - if ukp2_online: - for i_temp in range(6): - var temperature_ukp_2: int = status_prd.decode_u16(TEMPERATURE_UKP_2 + 2 * i_temp) - var tmp_2: int = round(CONST_MIN_TEMP + (MAXIMUM_CODE_ADC - temperature_ukp_2) * TEMP + 3) - power_amplifier[i_temp+6].value0 = tmp_2 - if tmp_2 > Constants.TEMP_THRESHOLD: - _control_results['temperature'] = false - - - -## Проверка ДКМ -func check_dkm(status_prd: PackedByteArray, bit_dkm: int) -> bool: - const DKM: int = 28 - - var status_dkm = status_prd[DKM] >> bit_dkm & 1 - #print('^: ', status_prd[DKM]) - if bit_dkm == 1: - $dou3_A5.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - $kasseta_FS_ND/ref_A3.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_2'] = status_dkm - elif bit_dkm == 2: - $dou2_A6.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - $kasseta_FS_ND/ref_A4.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_3'] = status_dkm - return status_dkm - - -func _process_ukp_power(status: PackedByteArray) -> void: - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - if current_fs == 2: - ## Мощность УМ от УКП 1 - var arr_power_ukp_1: Array = [] - if (status[0] >> 2) & 1: - var power_ukp_1: int - for i_power in range(6): - power_ukp_1 = status.decode_u16(Constants.POWER_UKP_1 + 2 * i_power) - arr_power_ukp_1.append(power_ukp_1) - - if count_packet_2 == 0: - power_array_2 = arr_power_ukp_1 - else: - for i in arr_power_ukp_1.size(): - if arr_power_ukp_1[i] > power_array_2[i]: - power_array_2[i] = arr_power_ukp_1[i] - - for i in 6: - power_amplifier[i].value1 = '%d' % power_array_2[i] - power_amplifier[i].state = STATE_VAL.GOOD if power_array_2[i] > Constants.TEMP_THRESHOLD else STATE_VAL.ERROR - count_packet_2 += 1 - - elif current_fs == 3: - ## Мощность УМ от УКП 2 - var arr_power_ukp_2: Array = [] - if (status[0] >> 2) & 1: - for i_power in range(6): - var power_ukp_2 = status.decode_u16(Constants.POWER_UKP_2 + 2 * i_power) - arr_power_ukp_2.append(power_ukp_2) - - if count_packet_3 == 0: - power_array_3 = arr_power_ukp_2 - else: - for i in arr_power_ukp_2.size(): - if arr_power_ukp_2[i] > power_array_3[i]: - power_array_3[i] = arr_power_ukp_2[i] - - for i in 6: - power_amplifier[i+6].value1 = '%d' % power_array_3[i] - power_amplifier[i+6].state = STATE_VAL.GOOD if power_array_3[i] > Constants.TEMP_THRESHOLD else STATE_VAL.ERROR - - count_packet_3 += 1 - - -func _on_control_fs(mode: bool) -> void: - # Конфигурация параметров для каждого прибора - var pribor_config := { - '1н': {'angle': 0.0, 'sectors': [4, 8]}, - '2н': {'angle': 90.0, 'sectors': [7, 11]}, - '3н': {'angle': 180.0, 'sectors': [6, 10]}, - '4н': {'angle': 270.0, 'sectors': [5, 9]}, - } - # Получаем конфигурацию для текущего прибора - var config: Dictionary = pribor_config.get(pribor) - var angle: float = config.angle - var sectors: Array = config.sectors - - # Конфигурация частот и ширин для каждого ФС - var fs_params := { - 2: {'freq': 900.0, 'width': 100.0}, - 3: {'freq': 1157.0, 'width': 100.0} - } - - # Формируем выходные данные - var interfer_name: String = 'k1' if mode else 'off' - var fs_arr: Array = [] - - if (state == STATE_MASHINE.FS_TURN_ON or state == STATE_MASHINE.FS_TURN_OFF): - if current_fs in fs_params: - var params = fs_params[current_fs] - fs_arr.append([ - angle, - params.freq, - params.width, - sectors[current_fs - 2] - ]) - signaller.emit_signal('interfer_init', interfer_name, fs_arr, Constants.POWER_UM) - - -func power_control_result() -> void: - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - _control_results['power_ukp'] = true - for amp in power_amplifier: - if amp.state != STATE_VAL.GOOD: - _control_results['power_ukp'] = false - break - - -func on_stop_control() -> void: - state = STATE_MASHINE.FS_TURN_OFF - - -func on_fs_update_state(packet_type_7: Dictionary) -> void: - # Словарь для маппинга: ключ - номер FS, значение - целевая нода и условие прибора - var fs_mapping = { - 4: { 'node': $kasseta_FS_ND/ref_A1, 'condition': pribor == '1н' }, - 5: { 'node': $kasseta_FS_ND/ref_A1, 'condition': pribor == '4н' }, - 6: { 'node': $kasseta_FS_ND/ref_A1, 'condition': pribor == '3н' }, - 7: { 'node': $kasseta_FS_ND/ref_A1, 'condition': pribor == '2н' }, - 8: { 'node': $kasseta_FS_ND/ref_A2, 'condition': pribor == '1н' }, - 9: { 'node': $kasseta_FS_ND/ref_A2, 'condition': pribor == '4н' }, - 10: { 'node': $kasseta_FS_ND/ref_A2, 'condition': pribor == '3н' }, - 11: { 'node': $kasseta_FS_ND/ref_A2, 'condition': pribor == '2н' } - } - for fs in packet_type_7: - if fs in fs_mapping and fs_mapping[fs]['condition']: - var data = packet_type_7[fs] - if fs < 8 and current_fs == 2: - _control_results['fs_2'] = (data.isg == 1) - var state_fs = STATE_VAL.GOOD if data.isg == 1 else STATE_VAL.ERROR if data.isg == 0 else STATE_VAL.NONE - fs_mapping[fs]['node'].state = state_fs - elif fs > 7 and current_fs == 3: - _control_results['fs_3'] = (data.isg == 1) - var state_fs = STATE_VAL.GOOD if data.isg == 1 else STATE_VAL.ERROR if data.isg == 0 else STATE_VAL.NONE - fs_mapping[fs]['node'].state = state_fs - - -func on_ug_setting() -> void: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - - - if unit_prd.isa_ports.has(Constants.ADDR_UG_LITERA_1): - ug_work_2 = unit_prd.isa_ports[Constants.ADDR_UG_LITERA_1] - if unit_prd.isa_ports.has(Constants.ADDR_UG_LITERA_2): - ug_work_3 = unit_prd.isa_ports[Constants.ADDR_UG_LITERA_2] - - var result_1 = ((Constants.ATT_UM_2 & 0x07) << 3) | (Constants.RAY_DOU & 0x07) - var result_2 = ((Constants.ATT_UM_3 & 0x07) << 3) | (Constants.RAY_DOU & 0x07) - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.ADDR_UG_LITERA_1, result_1, - Constants.ADDR_UG_LITERA_2, result_2]]) - - prd_module.cmd_array.append([unit_prd.CmdCode.READ_ISA, [Constants.ADDR_UG_LITERA_1, Constants.ADDR_UG_LITERA_2]]) +func on_line_changed(unit_pribor: Object) -> void: + if not unit_pribor.online: + set_default_state() func on_mode_changed(in_tree: bool) -> void: if not in_tree: queue_free() - -func on_control_result() -> void: - # Словарь соответствия ключей ошибок и нод - var error_nodes := { - 'fs_2': $kasseta_FS_ND/ref_A2, - 'fs_3': $kasseta_FS_ND/ref_A1, - } - # Проверка результатов и установка состояний - var result: bool = true - for key in _control_results: - if not _control_results[key]: - result = false - if error_nodes.has(key): - error_nodes[key].state = STATE_VAL.ERROR - - # Установка текста и цвета результата - var status_text := 'неисправен' - var status_color := Color.CRIMSON - if result: - status_text = 'исправен' - status_color = Color.AQUAMARINE - - $control_result.text = 'Прибор ПРД-%s %s' % [pribor, status_text] - $control_result.add_theme_color_override('font_color', status_color) +# +#func on_control_result() -> void: + #var result: bool = true +# + #for key in _control_results: + #if not _control_results[key]: + #if key == 'fs_1': + #$kasseta_FS_VD/ref_A3.state = STATE_VAL.ERROR + #if key == 'fs_2': + #$kasseta_FS_VD/ref_A4.state = STATE_VAL.ERROR + #result = false + #print_debug('%s false' % key) +# + #var parts = currecnt_unit.split('-') + #var last_part = parts[-1] # Прибор + #if result: + #$control_result.text = 'Прибор ПРД-%s исправен' % last_part + #$control_result.add_theme_color_override('font_color', Color.AQUAMARINE) + #else: + #$control_result.text = 'Прибор ПРД-%s неисправен' % last_part + #$control_result.add_theme_color_override('font_color', Color.CRIMSON) + #await get_tree().create_timer(Constants.TIMER_DELAY).timeout + #flag_timer_started = false diff --git a/scenes/pribor-prd-n/pribor-prd-n.tscn b/scenes/pribor-prd-n/pribor-prd-n.tscn index eaa22e5..8905fe6 100644 --- a/scenes/pribor-prd-n/pribor-prd-n.tscn +++ b/scenes/pribor-prd-n/pribor-prd-n.tscn @@ -1,10 +1,9 @@ -[gd_scene load_steps=14 format=3 uid="uid://dnuexoef2nnv5"] +[gd_scene load_steps=13 format=3 uid="uid://dnuexoef2nnv5"] [ext_resource type="Script" uid="uid://cto2r4ipew65m" path="res://scenes/pribor-prd-n/pribor-prd-n.gd" id="1_bnnv3"] [ext_resource type="PackedScene" uid="uid://d3iqb5e4g81m5" path="res://scenes/контроль/элемент-г.tscn" id="2_is25t"] [ext_resource type="Texture2D" uid="uid://c4mdrmk7h638f" path="res://data/nine-patch-round.png" id="3_meukj"] [ext_resource type="PackedScene" uid="uid://bk1655p4e8y4u" path="res://scenes/контроль/кассета-у-5-нв.tscn" id="4_xkifg"] -[ext_resource type="Script" uid="uid://dow4nqi6hbak8" path="res://scenes/контроль/кассета-у-5.gd" id="5_1wf07"] [ext_resource type="Script" uid="uid://crpedygm3gohi" path="res://scenes/контроль/кассета.gd" id="6_b5wvk"] [ext_resource type="PackedScene" uid="uid://p2suppildvq0" path="res://scenes/контроль/элемент-в.tscn" id="7_eoqf2"] [ext_resource type="PackedScene" uid="uid://bkxblfoj7ejv0" path="res://scenes/контроль/блок-а.tscn" id="8_sia5h"] @@ -43,7 +42,7 @@ offset_right = 15.0 offset_bottom = 30.0 script = ExtResource("1_bnnv3") -[node name="maa2000_A23" parent="." groups=["default_reset"] instance=ExtResource("2_is25t")] +[node name="maa2000_A23" parent="." groups=["default_reset", "power_supply"] instance=ExtResource("2_is25t")] layout_mode = 2 offset_left = 8.0 offset_top = 877.0 @@ -51,8 +50,9 @@ offset_right = 175.0 offset_bottom = 949.0 fname = "MAA2000" rname = "A23" +metadata/ip = "maa2000_2" -[node name="maa2000_A22" parent="." groups=["default_reset"] instance=ExtResource("2_is25t")] +[node name="maa2000_A22" parent="." groups=["default_reset", "power_supply"] instance=ExtResource("2_is25t")] layout_mode = 2 offset_left = 485.0 offset_top = 877.0 @@ -60,6 +60,7 @@ offset_right = 652.0 offset_bottom = 949.0 fname = "MAA2000" rname = "A22" +metadata/ip = "maa2000_1" [node name="dou3_A5" parent="." groups=["default_reset"] instance=ExtResource("2_is25t")] layout_mode = 2 @@ -109,8 +110,6 @@ offset_left = 175.0 offset_top = 242.0 offset_right = 485.0 offset_bottom = 432.0 -script = ExtResource("5_1wf07") -fname = "Кассета У5" [node name="kasseta_FS_ND" type="NinePatchRect" parent="."] layout_mode = 0 @@ -146,23 +145,23 @@ offset_bottom = 182.0 fname = "Блок ФС-2" rname = "A3" -[node name="ref_A1" parent="kasseta_FS_ND" groups=["default_reset"] instance=ExtResource("7_eoqf2")] +[node name="ref_A1" parent="kasseta_FS_ND" groups=["default_reset", "fs_group"] instance=ExtResource("7_eoqf2")] offset_left = 105.0 offset_top = 32.0 offset_right = 155.0 offset_bottom = 182.0 fname = "Модуль ФС" rname = "A1" -state = 2 +metadata/fs = "fs_3" -[node name="ref_A2" parent="kasseta_FS_ND" groups=["default_reset"] instance=ExtResource("7_eoqf2")] +[node name="ref_A2" parent="kasseta_FS_ND" groups=["default_reset", "fs_group"] instance=ExtResource("7_eoqf2")] offset_left = 155.0 offset_top = 32.0 offset_right = 205.0 offset_bottom = 182.0 fname = "Модуль ФС" rname = "A2" -state = 2 +metadata/fs = "fs_2" [node name="ref_A4" parent="kasseta_FS_ND" groups=["default_reset"] instance=ExtResource("7_eoqf2")] offset_left = 205.0 @@ -186,29 +185,32 @@ patch_margin_bottom = 16 script = ExtResource("6_b5wvk") fname = "Кассета П-1" -[node name="ref_A21" parent="kasseta_P_1" groups=["default_reset"] instance=ExtResource("7_eoqf2")] +[node name="ref_A21" parent="kasseta_P_1" groups=["default_reset", "power_supply"] instance=ExtResource("7_eoqf2")] offset_left = 9.0 offset_top = 33.0 offset_right = 59.0 offset_bottom = 183.0 fname = "ИП12-50" rname = "A21" +metadata/ip = "ip12_50_1" -[node name="ref_A20" parent="kasseta_P_1" groups=["default_reset"] instance=ExtResource("7_eoqf2")] +[node name="ref_A20" parent="kasseta_P_1" groups=["default_reset", "power_supply"] instance=ExtResource("7_eoqf2")] offset_left = 59.0 offset_top = 33.0 offset_right = 109.0 offset_bottom = 183.0 fname = "ИП9-50" rname = "A20" +metadata/ip = "ip9_50_1" -[node name="ref_A19" parent="kasseta_P_1" groups=["default_reset"] instance=ExtResource("7_eoqf2")] +[node name="ref_A19" parent="kasseta_P_1" groups=["default_reset", "power_supply"] instance=ExtResource("7_eoqf2")] offset_left = 109.0 offset_top = 33.0 offset_right = 159.0 offset_bottom = 183.0 fname = "ИП9-50" rname = "A19" +metadata/ip = "ip9_50_2" [node name="lbl_fname" type="Label" parent="kasseta_P_1"] self_modulate = Color(1, 1, 1, 0.62) diff --git a/scenes/pribor-prd-v/pribor-prd-v.gd b/scenes/pribor-prd-v/pribor-prd-v.gd index 8c159cb..101b682 100644 --- a/scenes/pribor-prd-v/pribor-prd-v.gd +++ b/scenes/pribor-prd-v/pribor-prd-v.gd @@ -1,83 +1,173 @@ +@tool extends 'res://scenes/контроль/прибор.gd' -const Constants = { - 'IN_BLANK_PRD': 1, - 'OUT_BLANK_PRD': 13, - 'CI_4_OT_FS': 11, - 'CI_5_OT_FS': 12, - 'CI_4_B_UF': 4, - 'CI_5_B_UF': 5, +const constants_v = { 'POWER_UKP_1': 31, 'POWER_UKP_2': 63, - 'DKM_BIT_3': 3, - 'DKM_BIT_4': 4, + 'DKM_BIT_4': 3, + 'DKM_BIT_5': 4, + 'BASE_ADDR_EMS_G': 0x120, 'ADDR_UG_LITERA_1': 0x106, 'ADDR_UG_LITERA_2': 0x108, + 'ADDR_UG_LITERA_3': 0x10A, 'TEMP_THRESHOLD': 70, 'POWER_THRESHOLD': 40, - 'TIMER_DELAY': 1.4, + 'TIMER_DELAY': 5.0, + 'RAY_DOU_NUM': 0x3, + 'ATT_UM_4': 0x7, + 'ATT_UM_5': 0x7, 'POWER_UM': 70, } +# Конфигурация параметров для каждого прибора +const PRIBOR_CONFIG_V := { + '1в': {'angle': 0.0, 'sectors': [12, 16]}, + '2в': {'angle': 90.0, 'sectors': [15, 19]}, + '3в': {'angle': 180.0, 'sectors': [14, 18]}, + '4в': {'angle': 270.0, 'sectors': [13, 17]}, +} +# Конфигурация частот и ширин для каждого ФС +const FS_PARAMS_V := { + 4: {'freq': 1227.0, 'width': 110.0}, + 5: {'freq': 1575.0, 'width': 110.0}, +} enum STATE_VAL { NONE = 0, GOOD = 1, ERROR = 2 } +var block_ip_config_v := { + 'maa2000_1': [0, false], + 'maa2000_2': [1, false], + 'ip9_50_1': [2, false], + 'ip9_50_2': [3, false], + 'ip12_50_1': [4, false], + 'ip5_25': [7, false], +} +# Проверка ДКМ +var block_dkm_config_v: = { + 'dkm_4': false, + 'dkm_5': false, +} +# Проверка ФС +var block_fs_prd_config_v: = { + 'fs_4': false, + 'fs_5': false, +} +var block_kasseta_y5_prd_config_v: = { + 'yau07': false, + 'ems': false, + 'ug': false, + 'ukp1': false, + 'ukp2': false, +} + # Основные переменные -var count_packet_1:int = 0 -var count_packet_2:int = 0 -var power_array_1: Array = [] -var power_array_2: Array = [] -var currecnt_unit: String -var ug_work_1: int -var ug_work_2: int +var current_fs: int = 4 +var ug_work_1: int = 0 +var ug_work_2: int = 0 # Флаги и таймеры -var control_timer: Timer = Timer.new() -var flag_timer_started: bool = false +var mashine_timer: Timer = Timer.new() +var prd_v_module: Object +var unit_prd_v: Object +var control_prd_v: Object # Результаты контроля -var _control_results: Dictionary = { +var control_results_v: Dictionary = { 'block_ip': false, # Проверка касет П1 и ИП МА2000 'temperature': true, # Проверка температур УМ - 'dkm_1': false, # Проверка ДКМ - 'dkm_2': false, # Проверка ДКМ - 'power_ukp': false, # Мощность от УКП - 'fs_1': false, # Проверка ФС - 'fs_2': false, + 'dkm': false, + 'dou': false, + 'power_um': false, # Мощность от УКП + 'fs': false, } +var test = preload('res://scripts/pribor-prd.gd') + + +func on_state_mashine() -> void: + control_prd_v.state_control_machine() + + block_kasseta_y5_prd_config_v = control_prd_v.block_kasseta_y5_config + var nodes_y5: Array = get_tree().get_nodes_in_group('y-5') + for node_y5 in nodes_y5: + var meta_y5 = node_y5.get_meta('y5') + if block_kasseta_y5_prd_config_v.has(meta_y5): + if block_kasseta_y5_prd_config_v['yau07'] == false: + node_y5.state = STATE_VAL.ERROR if meta_y5 == 'yau07' else STATE_VAL.NONE + return + node_y5.state = STATE_VAL.GOOD if block_kasseta_y5_prd_config_v[meta_y5] else STATE_VAL.ERROR + + block_ip_config_v = control_prd_v.block_ip_config + var node_ip_power_arr: Array = get_tree().get_nodes_in_group('power_supply') + for power_supply in node_ip_power_arr: + var meta_ip = power_supply.get_meta('ip') + if block_ip_config_v.has(meta_ip) and block_kasseta_y5_prd_config_v.ug: + power_supply.state = STATE_VAL.GOOD if block_ip_config_v[meta_ip][1] else STATE_VAL.ERROR + + var fs_results: Dictionary = control_prd_v.block_fs_config + var fs_nodes: Array = get_tree().get_nodes_in_group('fs_group') + for f in fs_nodes: + var fs_meta: String = f.get_meta('fs') + if fs_results.has(fs_meta): + var new_state = fs_results[fs_meta] + f.state = new_state + fs_results[fs_meta] = new_state + + var dkm: Dictionary = control_prd_v.block_dkm_config + if control_prd_v.current_fs == 4 and fs_results.fs_4: + $kasseta_FS_VD/ref_A2.state = STATE_VAL.GOOD if dkm.dkm_4 else STATE_VAL.ERROR + elif control_prd_v.current_fs == 5 and fs_results.fs_5: + $kasseta_FS_VD/ref_A6.state = STATE_VAL.GOOD if dkm.dkm_5 else STATE_VAL.ERROR + + #if not control_prd_v.power_result['ray_25_4'] or not control_prd_v.power_result['ray_25_5']: + #return + if 1 == 1: + return + + var node_arr_power: Array = get_tree().get_nodes_in_group('power_amplifier') + for i_pow in node_arr_power.size(): + if i_pow < 6: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_v.power_result['ray_25_4'][i_pow]) + elif i_pow < 12: + var pw = node_arr_power[i_pow] + pw.value1 = str(control_prd_v.power_result['ray_25_5'][i_pow-6]) func _ready() -> void: + if Engine.is_editor_hint(): + return + initialize_connections() setup_timer() set_default_state() func initialize_connections() -> void: - signaller.conn(signaller.fs_update_state, Callable(self, 'on_fs_update_state')) var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - currecnt_unit = unit_prd.name - unit_prd.connect('data_received', Callable(self, 'on_data_received')) - unit_prd.connect('line_changed', Callable(self, 'on_line_changed')) + prd_v_module = prd.prd_dict[unit_name] + unit_prd_v = prd_v_module.unit_yau07 + + unit_prd_v.connect('line_changed', Callable(self, 'on_line_changed')) + var power_amplifiers: Array = get_tree().get_nodes_in_group('power_amplifier') + var init_data: Dictionary = { + 'control_label': $control_result, + 'power_amplifiers': power_amplifiers, + 'unit_prd': unit_prd_v, + 'module_prd' : prd_v_module, + 'constants': constants_v, + 'prd_config': PRIBOR_CONFIG_V, + 'fs_params': FS_PARAMS_V, + 'block_ip_prd_config': block_ip_config_v, + 'block_dkm_prd_config': block_dkm_config_v, + 'block_fs_prd_config': block_fs_prd_config_v, + 'block_kasseta_y5_prd_config': block_kasseta_y5_prd_config_v, + 'control_results': control_results_v, + 'current_fs': current_fs, + } + control_prd_v = test.TestPRD.new(init_data) + add_child(control_prd_v) func setup_timer() -> void: - add_child(control_timer) - control_timer.connect('timeout', Callable(self, 'on_stop_control')) - control_timer.one_shot = true - control_timer.wait_time = 10.0 - control_timer.start() - - -func _enter_tree() -> void: - $control_result.text = '' - signaller.connect('режим_работа', Callable(self, 'on_mode_changed').bind(false)) - signaller.emit_signal('interfer_off_all') - await get_tree().create_timer(2.0).timeout - _on_control_fs(true) - - -func _exit_tree() -> void: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.get_unit_instance(unit_name) - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.ADDR_UG_LITERA_1, ug_work_1, Constants.ADDR_UG_LITERA_2, ug_work_2]]) + add_child(mashine_timer) + mashine_timer.connect('timeout', Callable(self, 'on_state_mashine')) + mashine_timer.wait_time = 0.5 + mashine_timer.start() func set_default_state() -> void: @@ -88,286 +178,49 @@ func set_default_state() -> void: group.state = STATE_VAL.NONE -func on_line_changed(unit_prd: Object) -> void: - if not unit_prd.online: +func _enter_tree() -> void: + if Engine.is_editor_hint(): + return + $control_result.text = 'Выполняется ...' + $control_result.add_theme_color_override('font_color', Color.ALICE_BLUE) + signaller.connect('режим_работа', Callable(self, 'on_mode_changed').bind(false)) + + +func _exit_tree() -> void: + if Engine.is_editor_hint(): + return + prd_v_module.cmd_array.append([unit_prd_v.CmdCode.WRITE_ISA, [constants_v.ADDR_UG_LITERA_1, ug_work_1, constants_v.ADDR_UG_LITERA_2, ug_work_2]]) + + +func on_line_changed(unit_pribor: Object) -> void: + if not unit_pribor.online: set_default_state() -# Основной процесс по принятию и обработки пакетов -func on_data_received(unit_prd: Object) -> void: - if not is_inside_tree(): - return - - var status = unit_prd.status - check_block_ip(status) - check_temperature_um(status) - # Обработка данных ЭМС - _process_ems_data(status) - - if flag_timer_started: - check_dkm(status, Constants.DKM_BIT_3) - check_dkm(status, Constants.DKM_BIT_4) - # Обработка мощности от УКП - _process_ukp_power(status) - - -## Проверка касет П1 и ИП МА2000 -func check_block_ip(status_prd: PackedByteArray) -> void: - var ug_online: bool = (status_prd[0] >> 1) & 1 - if not ug_online: - for node in [$maa2000_A23, $maa2000_A22, $kasseta_P_1/ref_A19, $kasseta_P_1/ref_A20, $kasseta_P_1/ref_A21]: - node.state = STATE_VAL.NONE - return - - const BYTE_DRY_CONTACT: int = 27 - const BIT_MAA2000_1: int = 0 - const BIT_MAA2000_2: int = 1 - const BIT_IP9_50_1: int = 2 - const BIT_IP9_50_2: int = 3 - const BIT_IP12_50_1: int = 4 - - var maa2000_1 = status_prd[BYTE_DRY_CONTACT] >> BIT_MAA2000_1 & 1 - var maa2000_2 = status_prd[BYTE_DRY_CONTACT] >> BIT_MAA2000_2 & 1 - var ip9_50_1 = status_prd[BYTE_DRY_CONTACT] >> BIT_IP9_50_1 & 1 - var ip9_50_2 = status_prd[BYTE_DRY_CONTACT] >> BIT_IP9_50_2 & 1 - var ip12_50_1 = status_prd[BYTE_DRY_CONTACT] >> BIT_IP12_50_1 & 1 - - $maa2000_A23.state = STATE_VAL.ERROR if maa2000_1 else STATE_VAL.GOOD - $maa2000_A22.state = STATE_VAL.ERROR if maa2000_2 else STATE_VAL.GOOD - $kasseta_P_1/ref_A19.state = STATE_VAL.ERROR if ip9_50_1 else STATE_VAL.GOOD - $kasseta_P_1/ref_A20.state = STATE_VAL.ERROR if ip9_50_2 else STATE_VAL.GOOD - $kasseta_P_1/ref_A21.state = STATE_VAL.ERROR if ip12_50_1 else STATE_VAL.GOOD - - _control_results['block_ip'] = ( - $maa2000_A23.state == STATE_VAL.GOOD and - $maa2000_A22.state == STATE_VAL.GOOD and - $kasseta_P_1/ref_A19.state == STATE_VAL.GOOD and - $kasseta_P_1/ref_A20.state == STATE_VAL.GOOD and - $kasseta_P_1/ref_A21.state == STATE_VAL.GOOD - ) - - -## Проверка температур УМ от УКП -func check_temperature_um(status_prd: PackedByteArray) -> void: - const TEMP_CONSTANTS = { - 'min_temp': -25, - 'max_code': 3796, - 'min_code': 2660, - 'temp_factor': 115.0 / (3796 - 2660), - 'offset': 3 # Корректировка температуры - } - const TEMPERATURE_UKP_1: int = 47 - const TEMPERATURE_UKP_2: int = 79 - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - - # Сбрас флагов перед проверкой - _control_results['temperature'] = true - - var ukp1_online: int = (status_prd[0] >> 2) & 1 - if ukp1_online: - for i_temp in range(6): - var temperature_ukp_1: int = status_prd.decode_u16(TEMPERATURE_UKP_1 + 2 * i_temp) - var tmp_1: int = round(TEMP_CONSTANTS['min_temp'] + (TEMP_CONSTANTS['max_code'] - temperature_ukp_1) * TEMP_CONSTANTS['temp_factor'] + TEMP_CONSTANTS['offset']) - power_amplifier[i_temp].value0 = tmp_1 - if tmp_1 > Constants.TEMP_THRESHOLD: - _control_results['temperature'] = false - - var ukp2_online = (status_prd[0] >> 3) & 1 - if ukp2_online: - for i_temp in range(6): - var temperature_ukp_2: int = status_prd.decode_u16(TEMPERATURE_UKP_2 + 2 * i_temp) - var tmp_2: int = round(TEMP_CONSTANTS['min_temp'] + (TEMP_CONSTANTS['max_code'] - temperature_ukp_2) * TEMP_CONSTANTS['temp_factor'] + TEMP_CONSTANTS['offset']) - power_amplifier[i_temp+6].value0 = tmp_2 - if tmp_2 > Constants.TEMP_THRESHOLD: - _control_results['temperature'] = false - - -## Проверка ДКМ -func check_dkm(status_prd: PackedByteArray, bit_dkm: int) -> void: - const DKM: int = 28 - var status_dkm = status_prd[DKM] >> bit_dkm & 1 - if bit_dkm == Constants.DKM_BIT_3: - $dou5_A6.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - $kasseta_FS_VD/ref_A2.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_1'] = status_dkm - elif bit_dkm == Constants.DKM_BIT_4: - $dou4_A5.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - $kasseta_FS_VD/ref_A6.state = STATE_VAL.GOOD if status_dkm else STATE_VAL.ERROR - _control_results['dkm_2'] = status_dkm - - -# Обрабатывает данные ЭМС и обновляет UI панели -func _process_ems_data(status: PackedByteArray) -> void: - ## Контроль ЭМС - var in_blank: int = status.decode_u16(Constants.IN_BLANK_PRD) - var out_blank: int = status.decode_u16(Constants.OUT_BLANK_PRD) - - # Обновление фреймов для входных сигналов - $Monitoring_panel/in_fs_1.frame = (in_blank >> Constants.CI_4_OT_FS) & 1 - $Monitoring_panel/in_fs_2.frame = (in_blank >> Constants.CI_5_OT_FS) & 1 - - # Обновление фреймов для выходных сигналов ЭМС - $Monitoring_panel/out_ems_1.frame = (out_blank >> Constants.CI_4_B_UF) & 1 - $Monitoring_panel/out_ems_2.frame = (out_blank >> Constants.CI_5_B_UF) & 1 - - -func _process_ukp_power(status: PackedByteArray) -> void: - ## Мощность УМ от УКП 1 - var arr_power_ukp_1: Array = [] - - if (status[0] >> 2) & 1: - for i_power in range(6): - var power_ukp_1 = status.decode_u16(Constants.POWER_UKP_1 + 2 * i_power) - arr_power_ukp_1.append(power_ukp_1) - - if count_packet_1 == 0: - power_array_1 = arr_power_ukp_1 - else: - for i in arr_power_ukp_1.size(): - if arr_power_ukp_1[i] > power_array_1[i]: - power_array_1[i] = arr_power_ukp_1[i] - - var power_amplifier: Array = get_tree().get_nodes_in_group('power_amplifier') - for i in 6: - power_amplifier[i].value1 = '%d' % power_array_1[i] - power_amplifier[i].state = STATE_VAL.GOOD if power_array_1[i] > Constants.POWER_THRESHOLD else STATE_VAL.ERROR - count_packet_1 += 1 - - ## Мощность УМ от УКП 2 - var arr_power_ukp_2: Array = [] - - if (status[0] >> 2) & 1: - for i_power in range(6): - var power_ukp_2 = status.decode_u16(Constants.POWER_UKP_2 + 2 * i_power) - arr_power_ukp_2.append(power_ukp_2) - - if count_packet_2 == 0: - power_array_2 = arr_power_ukp_2 - else: - for i in arr_power_ukp_2.size(): - if arr_power_ukp_2[i] > power_array_2[i]: - power_array_2[i] = arr_power_ukp_2[i] - - for i in 6: - power_amplifier[i+6].value1 = '%d' % power_array_2[i] - power_amplifier[i+6].state = STATE_VAL.GOOD if power_array_2[i] > Constants.POWER_THRESHOLD else STATE_VAL.ERROR - - count_packet_2 += 1 - - _control_results['power_ukp'] = true - for amp in power_amplifier: - if amp.state != STATE_VAL.GOOD: - _control_results['power_ukp'] = false - break - - -func _on_control_fs(mode: bool) -> void: - var parts = currecnt_unit.split('-') - var last_part = parts[-1] - var angle: float = 0.0 # -> ПРД-В1; 90.0 -> ПРД-В2; 180.0 -> ПРД-В3; 270.0 -> ПРД-В4 - var sector_1: float = 12 # -> ПРД-В1; 15 -> ПРД-В2; 14 -> ПРД-В3; 13 -> ПРД-В4; - var sector_2: float = 16 # -> ПРД-В1; 19 -> ПРД-В2; 18 -> ПРД-В3; 17 -> ПРД-В4; - if last_part == '2в': - angle = 90.0 - sector_1 = 15 - sector_2 = 19 - elif last_part == '3в': - angle = 180.0 - sector_1 = 14 - sector_2 = 18 - elif last_part == '4в': - angle = 270.0 - sector_1 = 13 - sector_2 = 17 - - var interfer_name: String = 'k1' if mode else 'off' - var freq_1: float = 1227.0 # ФС_1 - var freq_2: float = 1575.0 # ФС_2 - var width_1: float = 110.0 # ФС_1 - var width_2: float = 110.0 # ФС_2 - - var fs_arr: Array = [[angle, freq_1, width_1, sector_1], [angle, freq_2, width_2, sector_2]] - signaller.emit_signal('interfer_init', interfer_name, fs_arr, Constants.POWER_UM) - - -func on_stop_control() -> void: - print_debug('Остановка контроля ПРД') - _on_control_fs(false) - on_control_result() - - -func on_fs_update_state(packet_type_7: Dictionary) -> void: - var parts = currecnt_unit.split('-') - var last_part = parts[-1] # Прибор - - # Словарь для маппинга: ключ - номер FS, значение - целевая нода и условие прибора - var fs_mapping = { - 12: { 'node': $kasseta_FS_VD/ref_A3, 'condition': last_part == '1в' }, - 13: { 'node': $kasseta_FS_VD/ref_A3, 'condition': last_part == '4в' }, - 14: { 'node': $kasseta_FS_VD/ref_A3, 'condition': last_part == '3в' }, - 15: { 'node': $kasseta_FS_VD/ref_A3, 'condition': last_part == '2в' }, - 16: { 'node': $kasseta_FS_VD/ref_A4, 'condition': last_part == '1в' }, - 17: { 'node': $kasseta_FS_VD/ref_A4, 'condition': last_part == '4в' }, - 18: { 'node': $kasseta_FS_VD/ref_A4, 'condition': last_part == '3в' }, - 19: { 'node': $kasseta_FS_VD/ref_A4, 'condition': last_part == '2в' } - } - for fs in packet_type_7: - if fs in fs_mapping and fs_mapping[fs]['condition']: - var data = packet_type_7[fs] - var state = STATE_VAL.GOOD if data.isg == 1 else STATE_VAL.ERROR if data.isg == 0 else STATE_VAL.NONE - fs_mapping[fs]['node'].state = state - if fs < 16: - _control_results['fs_1'] = (data.isg == 1) - else: - _control_results['fs_2'] = (data.isg == 1) - if _control_results['fs_1'] and _control_results['fs_2'] and not flag_timer_started: - on_ug_setting() - control_timer.wait_time = Constants.TIMER_DELAY - control_timer.start() - flag_timer_started = true - - -func on_ug_setting() -> void: - var unit_name = get_meta('unit_name')[0] - var unit_prd = network.units[unit_name] - - if unit_prd.isa_ports.has(Constants.ADDR_UG_LITERA_1): - ug_work_1 = unit_prd.isa_ports[Constants.ADDR_UG_LITERA_1] - if unit_prd.isa_ports.has(Constants.ADDR_UG_LITERA_2): - ug_work_2 = unit_prd.isa_ports[Constants.ADDR_UG_LITERA_2] - - const dou = 0x3 - const att = 0x7 - var result = ((att & 0x07) << 3) | (dou & 0x07) - - var prd_module = prd.prd_dict[unit_prd.name] - prd_module.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [Constants.ADDR_UG_LITERA_1, result, Constants.ADDR_UG_LITERA_2, result, 0x120, 6666]]) - - func on_mode_changed(in_tree: bool) -> void: if not in_tree: queue_free() - -func on_control_result() -> void: - var result: bool = true - - for key in _control_results: - if not _control_results[key]: - if key == 'fs_1': - $kasseta_FS_VD/ref_A3.state = STATE_VAL.ERROR - if key == 'fs_2': - $kasseta_FS_VD/ref_A4.state = STATE_VAL.ERROR - result = false - print_debug('%s false' % key) - - var parts = currecnt_unit.split('-') - var last_part = parts[-1] # Прибор - if result: - $control_result.text = 'Прибор ПРД-%s исправен' % last_part - $control_result.add_theme_color_override('font_color', Color.AQUAMARINE) - else: - $control_result.text = 'Прибор ПРД-%s неисправен' % last_part - $control_result.add_theme_color_override('font_color', Color.CRIMSON) - await get_tree().create_timer(Constants.TIMER_DELAY).timeout - flag_timer_started = false +# +#func on_control_result() -> void: + #var result: bool = true +# + #for key in _control_results: + #if not _control_results[key]: + #if key == 'fs_1': + #$kasseta_FS_VD/ref_A3.state = STATE_VAL.ERROR + #if key == 'fs_2': + #$kasseta_FS_VD/ref_A4.state = STATE_VAL.ERROR + #result = false + #print_debug('%s false' % key) +# + #var parts = currecnt_unit.split('-') + #var last_part = parts[-1] # Прибор + #if result: + #$control_result.text = 'Прибор ПРД-%s исправен' % last_part + #$control_result.add_theme_color_override('font_color', Color.AQUAMARINE) + #else: + #$control_result.text = 'Прибор ПРД-%s неисправен' % last_part + #$control_result.add_theme_color_override('font_color', Color.CRIMSON) + #await get_tree().create_timer(Constants.TIMER_DELAY).timeout + #flag_timer_started = false diff --git a/scenes/pribor-prd-v/pribor-prd-v.tscn b/scenes/pribor-prd-v/pribor-prd-v.tscn index 02fd115..38702ac 100644 --- a/scenes/pribor-prd-v/pribor-prd-v.tscn +++ b/scenes/pribor-prd-v/pribor-prd-v.tscn @@ -1,10 +1,9 @@ -[gd_scene load_steps=15 format=3 uid="uid://cvskpe1ti3p45"] +[gd_scene load_steps=14 format=3 uid="uid://cvskpe1ti3p45"] [ext_resource type="Script" uid="uid://cvuosuvjaci1h" path="res://scenes/pribor-prd-v/pribor-prd-v.gd" id="1_c20s6"] [ext_resource type="PackedScene" uid="uid://d3iqb5e4g81m5" path="res://scenes/контроль/элемент-г.tscn" id="2_xpo4b"] [ext_resource type="Texture2D" uid="uid://c4mdrmk7h638f" path="res://data/nine-patch-round.png" id="3_wyy1b"] [ext_resource type="PackedScene" uid="uid://bk1655p4e8y4u" path="res://scenes/контроль/кассета-у-5-нв.tscn" id="4_gl2bl"] -[ext_resource type="Script" uid="uid://dow4nqi6hbak8" path="res://scenes/контроль/кассета-у-5.gd" id="5_6p5qb"] [ext_resource type="PackedScene" uid="uid://cd5sue1e8iyrv" path="res://scenes/pribor-prd-n/kasseta-fs-nd.tscn" id="5_nhd2k"] [ext_resource type="Script" uid="uid://crpedygm3gohi" path="res://scenes/контроль/кассета.gd" id="6_os4mt"] [ext_resource type="PackedScene" uid="uid://p2suppildvq0" path="res://scenes/контроль/элемент-в.tscn" id="7_38u2b"] @@ -44,7 +43,7 @@ offset_right = 15.0 offset_bottom = 30.0 script = ExtResource("1_c20s6") -[node name="maa2000_A22" parent="." groups=["default_reset"] instance=ExtResource("2_xpo4b")] +[node name="maa2000_A22" parent="." groups=["default_reset", "power_supply"] instance=ExtResource("2_xpo4b")] layout_mode = 2 offset_left = 485.0 offset_top = 877.0 @@ -52,6 +51,7 @@ offset_right = 652.0 offset_bottom = 949.0 fname = "MAA2000" rname = "A22" +metadata/ip = "maa2000_1" [node name="dou4_A5" parent="." groups=["default_reset"] instance=ExtResource("2_xpo4b")] layout_mode = 2 @@ -62,7 +62,7 @@ offset_bottom = 877.0 fname = "ДОУ-4" rname = "A5" -[node name="maa2000_A23" parent="." groups=["default_reset"] instance=ExtResource("2_xpo4b")] +[node name="maa2000_A23" parent="." groups=["default_reset", "power_supply"] instance=ExtResource("2_xpo4b")] layout_mode = 2 offset_left = 8.0 offset_top = 877.0 @@ -70,6 +70,7 @@ offset_right = 175.0 offset_bottom = 949.0 fname = "MAA2000" rname = "A23" +metadata/ip = "maa2000_2" [node name="dou5_A6" parent="." groups=["default_reset"] instance=ExtResource("2_xpo4b")] layout_mode = 2 @@ -110,8 +111,6 @@ offset_left = 175.0 offset_top = 242.0 offset_right = 485.0 offset_bottom = 432.0 -script = ExtResource("5_6p5qb") -fname = "Кассета У5" [node name="kasseta_FS_VD" parent="." instance=ExtResource("5_nhd2k")] layout_mode = 0 @@ -135,29 +134,32 @@ patch_margin_bottom = 16 script = ExtResource("6_os4mt") fname = "Кассета П-1В" -[node name="ref_A19" parent="kasseta_P_1" groups=["default_reset"] instance=ExtResource("7_38u2b")] +[node name="ref_A19" parent="kasseta_P_1" groups=["default_reset", "power_supply"] instance=ExtResource("7_38u2b")] offset_left = 9.0 offset_top = 33.0 offset_right = 59.0 offset_bottom = 183.0 fname = "ИП9-50" rname = "A19" +metadata/ip = "ip9_50_1" -[node name="ref_A20" parent="kasseta_P_1" groups=["default_reset"] instance=ExtResource("7_38u2b")] +[node name="ref_A20" parent="kasseta_P_1" groups=["default_reset", "power_supply"] instance=ExtResource("7_38u2b")] offset_left = 59.0 offset_top = 33.0 offset_right = 109.0 offset_bottom = 183.0 fname = "ИП9-50" rname = "A20" +metadata/ip = "ip9_50_2" -[node name="ref_A21" parent="kasseta_P_1" groups=["default_reset"] instance=ExtResource("7_38u2b")] +[node name="ref_A21" parent="kasseta_P_1" groups=["default_reset", "power_supply"] instance=ExtResource("7_38u2b")] offset_left = 109.0 offset_top = 33.0 offset_right = 159.0 offset_bottom = 183.0 fname = "ИП12-50" rname = "A21" +metadata/ip = "ip12_50_1" [node name="lbl_fname" type="Label" parent="kasseta_P_1"] self_modulate = Color(1, 1, 1, 0.62) diff --git a/scenes/контроль/кассета-у-5-к.tscn b/scenes/контроль/кассета-у-5-к.tscn index 19d0607..1a0654a 100644 --- a/scenes/контроль/кассета-у-5-к.tscn +++ b/scenes/контроль/кассета-у-5-к.tscn @@ -25,50 +25,56 @@ text = "Кассета У5" horizontal_alignment = 1 vertical_alignment = 1 -[node name="ref_A24" parent="." instance=ExtResource("3_wtlpi")] +[node name="ref_A24" parent="." groups=["power_supply"] instance=ExtResource("3_wtlpi")] offset_left = 5.0 offset_top = 32.0 offset_right = 55.0 offset_bottom = 182.0 fname = "ИП5-25" rname = "A31" +metadata/ip = "ip5_25" -[node name="ref_A30" parent="." instance=ExtResource("3_wtlpi")] +[node name="ref_A30" parent="." groups=["y-5"] instance=ExtResource("3_wtlpi")] offset_left = 55.0 offset_top = 32.0 offset_right = 105.0 offset_bottom = 182.0 fname = "ЯУ-07Б" rname = "A37" +metadata/y5 = "yau07" -[node name="ref_A26" parent="." instance=ExtResource("3_wtlpi")] +[node name="ref_A26" parent="." groups=["y-5"] instance=ExtResource("3_wtlpi")] offset_left = 105.0 offset_top = 32.0 offset_right = 155.0 offset_bottom = 182.0 fname = "ЭМС-Г" rname = "A33" +metadata/y5 = "ems" -[node name="ref_A27" parent="." instance=ExtResource("3_wtlpi")] +[node name="ref_A27" parent="." groups=["y-5"] instance=ExtResource("3_wtlpi")] offset_left = 155.0 offset_top = 32.0 offset_right = 205.0 offset_bottom = 182.0 fname = "УГ" rname = "A34" +metadata/y5 = "ug" -[node name="ref_A28" parent="." instance=ExtResource("3_wtlpi")] +[node name="ref_A28" parent="." groups=["y-5"] instance=ExtResource("3_wtlpi")] offset_left = 205.0 offset_top = 32.0 offset_right = 255.0 offset_bottom = 182.0 fname = "УКП" rname = "A35" +metadata/y5 = "ukp1" -[node name="ref_A29" parent="." instance=ExtResource("3_wtlpi")] +[node name="ref_A29" parent="." groups=["y-5"] instance=ExtResource("3_wtlpi")] offset_left = 254.0 offset_top = 32.0 offset_right = 304.0 offset_bottom = 182.0 fname = "УКП" rname = "A36" +metadata/y5 = "ukp2" diff --git a/scenes/контроль/кассета-у-5-нв.tscn b/scenes/контроль/кассета-у-5-нв.tscn index 21c75f4..dad7c79 100644 --- a/scenes/контроль/кассета-у-5-нв.tscn +++ b/scenes/контроль/кассета-у-5-нв.tscn @@ -25,50 +25,56 @@ text = "Кассета У5" horizontal_alignment = 1 vertical_alignment = 1 -[node name="ref_A24" parent="." instance=ExtResource("3_picsk")] +[node name="ref_A24" parent="." groups=["power_supply"] instance=ExtResource("3_picsk")] offset_left = 5.0 offset_top = 32.0 offset_right = 55.0 offset_bottom = 182.0 fname = "ИП5-25" rname = "A24" +metadata/ip = "ip5_25" -[node name="ref_A30" parent="." instance=ExtResource("3_picsk")] +[node name="ref_A30" parent="." groups=["y-5"] instance=ExtResource("3_picsk")] offset_left = 55.0 offset_top = 32.0 offset_right = 105.0 offset_bottom = 182.0 fname = "ЯУ-07Б" rname = "A30" +metadata/y5 = "yau07" -[node name="ref_A26" parent="." instance=ExtResource("3_picsk")] +[node name="ref_A26" parent="." groups=["y-5"] instance=ExtResource("3_picsk")] offset_left = 105.0 offset_top = 32.0 offset_right = 155.0 offset_bottom = 182.0 fname = "ЭМС-Г" rname = "A26" +metadata/y5 = "ems" -[node name="ref_A27" parent="." instance=ExtResource("3_picsk")] +[node name="ref_A27" parent="." groups=["y-5"] instance=ExtResource("3_picsk")] offset_left = 155.0 offset_top = 32.0 offset_right = 205.0 offset_bottom = 182.0 fname = "УГ" rname = "A27" +metadata/y5 = "ug" -[node name="ref_A28" parent="." instance=ExtResource("3_picsk")] +[node name="ref_A28" parent="." groups=["y-5"] instance=ExtResource("3_picsk")] offset_left = 205.0 offset_top = 32.0 offset_right = 255.0 offset_bottom = 182.0 fname = "УКП" rname = "A28" +metadata/y5 = "ukp1" -[node name="ref_A29" parent="." instance=ExtResource("3_picsk")] +[node name="ref_A29" parent="." groups=["y-5"] instance=ExtResource("3_picsk")] offset_left = 254.0 offset_top = 32.0 offset_right = 304.0 offset_bottom = 182.0 fname = "УКП" rname = "A29" +metadata/y5 = "ukp2" diff --git a/scripts/pribor-prd.gd b/scripts/pribor-prd.gd index 139dfcd..26c1b9c 100644 --- a/scripts/pribor-prd.gd +++ b/scripts/pribor-prd.gd @@ -1,69 +1,657 @@ -extends Node +class TestPRD extends Node: + const RAY_m5:= 'RAY_m5' + const RAY_5:= 'RAY_5' + const RAY_15:= 'RAY_15' + const RAY_25:= 'RAY_25' + const RAY_35:= 'RAY_35' + const RAY_45:= 'RAY_45' + enum STATE_VAL { NONE = 0, GOOD = 1, ERROR = 2 } + enum STATE_MASHINE { + INIT, + FS_TURN_ON, + FS_WORK, + WRITE_ISA, + READ_ISA, + CHEK_KASSETA_Y5, + UG_SET_RAY, + UG_SET_RAY_0, + UG_SET_RAY_1, + UG_SET_RAY_2, + UG_SET_RAY_3, + UG_SET_RAY_4, + UG_SET_RAY_5, + IN_EMS_RUN, + IN_EMS_STOP, + FS_TURN_OFF, + STOP_CONTROL, + AWAIT + } + const FS_KEYS := { + 1: 'fs_1', + 2: 'fs_2', + 3: 'fs_3', + 4: 'fs_4', + 5: 'fs_5', + 6: 'fs_6', + 7: 'fs_7' + } + const TEMPERATURE_CONSTANTS := { + 'CONST_MIN_TEMP': -25, + 'MAXIMUM_CODE_ADC': 3796, + 'MINIMUM_CODE_AD': 2660, + 'TEMPERATURE_UKP_1': 47, + 'TEMPERATURE_UKP_2': 79, + } + + var power_result: Dictionary = { + 1: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + 2: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + 3: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + 4: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + 5: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + 6: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + 7: {RAY_m5: [], RAY_5: [], RAY_15: [], RAY_25: [], RAY_35: [], RAY_45: [],}, + } + var constants: Dictionary + var pribor_config: Dictionary + var fs_parameters: Dictionary + var block_ip_config: Dictionary + var block_dkm_config: Dictionary + var block_fs_config: Dictionary + var block_kasseta_y5_config: Dictionary + var control_results: Dictionary + var self_name: String + var state: int = STATE_MASHINE.INIT + var current_fs: int + var flag_timer_started: bool = false + #var ug_online: bool + var unit_prd: Object + var module_prd: Object + var power_amplify: Array + var control_label: Label + var control_timer: Timer = Timer.new() + var ems_6666_timer: Timer = Timer.new() -static func manage_fs(mode: bool, pribor: String, pribor_config: Dictionary, fs_params: Dictionary, current_fs: int, power_um: int) -> void: - # Получаем конфигурацию для текущего прибора - var config: Dictionary = pribor_config[pribor] - var angle: float = config.angle - var sectors: Array = config.sectors + ## Инициализация аргуметнов + func _init(init_data: Dictionary) -> void: + control_label = init_data['control_label'] + power_amplify = init_data['power_amplifiers'] + unit_prd = init_data['unit_prd'] + module_prd = init_data['module_prd'] + constants = init_data['constants'] + pribor_config = init_data['prd_config'] + fs_parameters = init_data['fs_params'] + block_ip_config = init_data['block_ip_prd_config'] + block_dkm_config = init_data['block_dkm_prd_config'] + block_fs_config = init_data['block_fs_prd_config'] + control_results = init_data['control_results'] + current_fs = init_data['current_fs'] + block_kasseta_y5_config = init_data['block_kasseta_y5_prd_config'] - # Формируем выходные данные - var interfer_name: String = 'k1' if mode else 'off' - var fs_arr: Array = [] - if current_fs in fs_params: - var params = fs_params[current_fs] - fs_arr.append([ - angle, - params.freq, - params.width, - sectors[current_fs - 1] if current_fs == 1 else sectors[current_fs - 5] + func _ready() -> void: + initialize_connections() + setup_timer() + + + func _process(_delta: float) -> void: + pass + + + ## Пакеты от ЯУ-07 + func on_data_received(unit_pribor: Object) -> void: + if not is_inside_tree(): + return + + var status: PackedByteArray = unit_pribor.status + block_kasseta_y5_config = check_block_kasseta_y5(status, block_kasseta_y5_config) + block_ip_config = check_block_ip(status, block_ip_config) + check_temperature_um(status, power_amplify) + _process_dkm_status(status) + if current_fs != 0: + var tek_litera: Dictionary = power_result[current_fs] + var interes = _get_ray_key(state) + if interes != '': + tek_litera[_get_ray_key(state)] = power_um_ukp(status, current_fs, tek_litera[_get_ray_key(state)]) + power_result[current_fs] = tek_litera + + + ## Пакеты от MP550Service + func on_fs_update_state(packet_type_7: Dictionary, fs_mapping: Dictionary) -> void: + var fs_key: String = FS_KEYS.get(current_fs, '') + if fs_key.is_empty(): + return + + var fs_result := {fs_key: STATE_VAL.NONE} + fs_result = on_fs_state(packet_type_7, fs_mapping, fs_result) + block_fs_config[fs_key] = fs_result[fs_key] + + + ## + func state_control_machine() -> void: + match state: + STATE_MASHINE.INIT: + _handle_init_state() + STATE_MASHINE.FS_TURN_ON: + _handle_fs_turn_on_state() + state = STATE_MASHINE.FS_WORK + STATE_MASHINE.FS_WORK: + if not flag_timer_started: + _handle_fs_work_state() + STATE_MASHINE.CHEK_KASSETA_Y5: + if block_kasseta_y5_config['yau07']: + state = STATE_MASHINE.WRITE_ISA + else: + print_debug('Яу-07Б: нет связи ', block_kasseta_y5_config) + STATE_MASHINE.WRITE_ISA: + _handle_ug_set_state(0x6) + state = STATE_MASHINE.READ_ISA + #STATE_MASHINE.IN_EMS_RUN: + #ems_6666_timer.start() + #state = STATE_MASHINE.READ_ISA + STATE_MASHINE.READ_ISA: + if (unit_prd.cmd_state == unit_prd.CmdState.DONE) or (unit_prd.cmd_state == unit_prd.CmdState.FALSE): + _handle_read_isa(module_prd, unit_prd, [constants.ADDR_UG_LITERA_1, constants.ADDR_UG_LITERA_2, constants.ADDR_UG_LITERA_3]) + state = STATE_MASHINE.UG_SET_RAY + STATE_MASHINE.UG_SET_RAY: + var addr: int = constants.ADDR_UG_LITERA_1 + if current_fs == 3 or current_fs == 5 or current_fs == 7: + addr = constants.ADDR_UG_LITERA_2 + if unit_prd.isa_ports.has(addr) and (unit_prd.cmd_state == unit_prd.CmdState.DONE): + control_timer.stop() + if unit_prd.isa_ports[addr] & 0x07 == 0: + state = STATE_MASHINE.UG_SET_RAY_1 + elif unit_prd.isa_ports[addr] & 0x07 == 1: + state = STATE_MASHINE.UG_SET_RAY_2 + elif unit_prd.isa_ports[addr] & 0x07 == 2: + state = STATE_MASHINE.UG_SET_RAY_3 + elif unit_prd.isa_ports[addr] & 0x07 == 3: + state = STATE_MASHINE.UG_SET_RAY_4 + elif unit_prd.isa_ports[addr] & 0x07 == 4: + state = STATE_MASHINE.UG_SET_RAY_5 + elif unit_prd.isa_ports[addr] & 0x07 == 5: + state = STATE_MASHINE.IN_EMS_STOP + elif unit_prd.isa_ports[addr] & 0x07 == 6: + state = STATE_MASHINE.UG_SET_RAY_0 + + STATE_MASHINE.UG_SET_RAY_0: + _handle_ug_set_state(0x0) + await get_tree().create_timer(1.0).timeout + state = STATE_MASHINE.READ_ISA + STATE_MASHINE.UG_SET_RAY_1: + _handle_ug_set_state(0x1) + state = STATE_MASHINE.READ_ISA + STATE_MASHINE.UG_SET_RAY_2: + _handle_ug_set_state(0x2) + state = STATE_MASHINE.READ_ISA + STATE_MASHINE.UG_SET_RAY_3: + _handle_ug_set_state(0x3) + state = STATE_MASHINE.READ_ISA + STATE_MASHINE.UG_SET_RAY_4: + _handle_ug_set_state(0x4) + state = STATE_MASHINE.READ_ISA + STATE_MASHINE.UG_SET_RAY_5: + _handle_ug_set_state(0x5) + state = STATE_MASHINE.READ_ISA + STATE_MASHINE.IN_EMS_STOP: + ems_6666_timer.stop() + state = STATE_MASHINE.FS_TURN_OFF + STATE_MASHINE.FS_TURN_OFF: + _handle_fs_turn_off_state() + STATE_MASHINE.STOP_CONTROL: + _handle_stop_control_state() + + + func _handle_init_state() -> void: + control_label.text = 'Выполняется инициализация ФС-%s' % current_fs + if current_fs in [1, 2, 3, 4, 5, 6, 7]: + state = STATE_MASHINE.FS_TURN_ON + #state = STATE_MASHINE.STOP_CONTROL + else: + control_results = on_control_result(block_ip_config, block_dkm_config, block_fs_config, control_results, power_result, self_name, constants) + state = STATE_MASHINE.AWAIT + #print_debug(power_result) + + + func _handle_fs_turn_on_state() -> void: + control_label.text = 'Выполняется включение ФС-%s' % current_fs + manage_fs(true, self_name, pribor_config, fs_parameters, current_fs, constants.POWER_UM) + control_timer.wait_time = constants.TIMER_DELAY + control_timer.start() + + + func _handle_fs_work_state() -> void: + control_label.text = 'Выполняется проверка ФС-%s' % current_fs + if not module_prd.unit_yau07.online: + return + if (current_fs == 2 and block_fs_config.fs_2) or \ + (current_fs == 3 and block_fs_config.fs_3) or \ + (current_fs == 4 and block_fs_config.fs_4) or \ + (current_fs == 5 and block_fs_config.fs_5) or \ + (current_fs == 6 and block_fs_config.fs_6) or \ + (current_fs == 7 and block_fs_config.fs_7) or \ + (current_fs == 1 and block_fs_config.fs_1): + state = STATE_MASHINE.CHEK_KASSETA_Y5 + + + func _handle_ug_set_state(RAY_DOU_NUM: int) -> void: + var dic_att := { + 'RAY_DOU_NUM': RAY_DOU_NUM, + 'ADDR_UG_LITERA_1': constants.ADDR_UG_LITERA_1, + 'ADDR_UG_LITERA_2': constants.ADDR_UG_LITERA_2, + 'ADDR_UG_LITERA_3': constants.ADDR_UG_LITERA_3, + 'ATT_UM_3': 0x00, + 'BASE_EMS_G': constants.BASE_ADDR_EMS_G + } + if self_name == '1к' or self_name == '2к' or self_name == '3к' or self_name == '4к': + dic_att['ATT_UM_1'] = constants.ATT_UM_6 + dic_att['ATT_UM_2'] = constants.ATT_UM_7 + dic_att['ATT_UM_3'] = constants.ATT_UM_1 + elif self_name == '1в' or self_name == '2в' or self_name == '3в' or self_name == '4в': + dic_att['ATT_UM_1'] = constants.ATT_UM_4 + dic_att['ATT_UM_2'] = constants.ATT_UM_5 + elif self_name == '1н' or self_name == '2н' or self_name == '3н' or self_name == '4н': + dic_att['ATT_UM_1'] = constants.ATT_UM_2 + dic_att['ATT_UM_2'] = constants.ATT_UM_3 + control_label.text = 'Выполняется настройка угла (%s) и атт (%s, %s, %s)' % [ + dic_att.RAY_DOU_NUM, + dic_att.ATT_UM_1, + dic_att.ATT_UM_2, + dic_att.ATT_UM_3, + ] + on_ug_setting(module_prd, unit_prd, dic_att) + + + func _on_ems_6666_timer() -> void: + print_debug('Write 6666') + module_prd.cmd_array.append([unit_prd.CmdCode.WRITE_ISA, [constants.BASE_ADDR_EMS_G, 6666]]) + + + func _handle_fs_turn_off_state() -> void: + control_label.text = 'Выполняется отключение ФС-%s' % current_fs + manage_fs(false, self_name, pribor_config, fs_parameters, current_fs, constants.POWER_UM) + state = STATE_MASHINE.STOP_CONTROL + + + func _handle_stop_control_state() -> void: + control_label.text = 'Выполняется завершение проверки ФС-%s' % current_fs + flag_timer_started = false + _advance_to_next_fs() + state = STATE_MASHINE.INIT + + + func _advance_to_next_fs() -> void: + match current_fs: + 1: current_fs = 6 + 2: current_fs = 3 + 3: current_fs = 0 + 4: current_fs = 5 + 5: current_fs = 0 + 6: current_fs = 7 + 7: current_fs = 0 + + + ###################################### + func initialize_connections() -> void: + _determine_self_name() + var fs_mapping = _create_fs_mapping(self_name) + signaller.conn(signaller.fs_update_state, Callable(self, 'on_fs_update_state').bind(fs_mapping)) + unit_prd.connect('data_received', Callable(self, 'on_data_received')) + + + func _determine_self_name() -> void: + var current_unit = unit_prd.name + var parts = current_unit.split('-') + self_name = parts[-1] + + + func setup_timer() -> void: + add_child(control_timer) + control_timer.timeout.connect(on_stop_control) + control_timer.one_shot = true + control_timer.wait_time = 15.0 + control_timer.start() + + add_child(ems_6666_timer) + ems_6666_timer.timeout.connect(_on_ems_6666_timer) + ems_6666_timer.wait_time = 1.5 + + + func _process_dkm_status(status: PackedByteArray) -> void: + if not block_fs_config.has(_get_current_fs_key()): + return + var dkm_bit = _get_dkm_bit_for_current_fs() + block_dkm_config = check_dkm(status, dkm_bit, block_dkm_config) + + + func _get_current_fs_key() -> String: + return FS_KEYS.get(current_fs, '') + + + func _get_dkm_bit_for_current_fs() -> int: + match current_fs: + 1: return constants.DKM_BIT_1 + 2: return constants.DKM_BIT_2 + 3: return constants.DKM_BIT_3 + 4: return constants.DKM_BIT_4 + 5: return constants.DKM_BIT_5 + 6: return constants.DKM_BIT_6 + 7: return constants.DKM_BIT_7 + _: return -1 + + + func _get_dkm_key_for_current_fs() -> String: + match current_fs: + 1: return 'dkm_1' + 2: return 'dkm_2' + 3: return 'dkm_3' + 4: return 'dkm_4' + 5: return 'dkm_5' + 6: return 'dkm_6' + 7: return 'dkm_7' + _: return '' + + + static func _get_ray_key(machine_state: int) -> String: + match machine_state: + STATE_MASHINE.UG_SET_RAY_0: return RAY_m5 + STATE_MASHINE.UG_SET_RAY_1: return RAY_5 + STATE_MASHINE.UG_SET_RAY_2: return RAY_15 + STATE_MASHINE.UG_SET_RAY_3: return RAY_25 + STATE_MASHINE.UG_SET_RAY_4: return RAY_35 + STATE_MASHINE.UG_SET_RAY_5: return RAY_45 + _: return '' + + + func on_stop_control() -> void: + state = STATE_MASHINE.FS_TURN_OFF + + + static func on_control_result(ip_config: Dictionary, dkm_config: Dictionary, fs_config: Dictionary, ctrl_results: Dictionary, power_config: Dictionary, pribor: String, cnstnt: Dictionary) -> Dictionary: + var all_blocks_ip_ok = true + var all_blocks_dkm_ok = true + var all_blocks_fs_ok = true + var all_dou_ok = true + + for block in ip_config: + if not ip_config[block][1]: + all_blocks_ip_ok = false + ctrl_results['block_ip'] = all_blocks_ip_ok + + for block in dkm_config: + if not dkm_config[block]: + all_blocks_dkm_ok = false + ctrl_results['dkm'] = all_blocks_dkm_ok + + for block in fs_config: + if not fs_config[block]: + all_blocks_fs_ok = false + ctrl_results['fs'] = all_blocks_fs_ok + + var arr_liters = [2, 3] + if pribor == '1к' or pribor == '2к' or pribor == '3к' or pribor == '4к': + arr_liters = [1, 6, 7] + elif pribor == '1в' or pribor == '2в' or pribor == '3в' or pribor == '4в': + arr_liters = [4, 5] + + for i_liter in arr_liters: + var amp_array = power_config[i_liter] + if amp_array[RAY_m5].size() == 0 or \ + amp_array[RAY_5].size() == 0 or \ + amp_array[RAY_15].size() == 0 or \ + amp_array[RAY_25].size() == 0 or \ + amp_array[RAY_35].size() == 0 or \ + amp_array[RAY_45].size() == 0: + all_dou_ok = false + + for i_powers in amp_array.values(): + for k_pow in i_powers.size(): + if i_powers[k_pow] < cnstnt.POWER_THRESHOLD: + print_debug(i_powers[k_pow]) + all_dou_ok = false + + print([i_liter, amp_array]) + ctrl_results['dou'] = all_dou_ok + return ctrl_results + + + ## Установка угла и аттенюации для УМ + static func on_ug_setting(prd_module: Object, prd_unit: Object, settings_ug: Dictionary) -> void: + var result_1 = ((settings_ug.ATT_UM_1 & 0x07) << 3) | (settings_ug.RAY_DOU_NUM & 0x07) + var result_2 = ((settings_ug.ATT_UM_2 & 0x07) << 3) | (settings_ug.RAY_DOU_NUM & 0x07) + + prd_module.cmd_array.append([prd_unit.CmdCode.WRITE_ISA, [ settings_ug.BASE_EMS_G, 6666, + settings_ug.ADDR_UG_LITERA_1, result_1, + settings_ug.ADDR_UG_LITERA_2, result_2, + settings_ug.ADDR_UG_LITERA_3, settings_ug.ATT_UM_3, + ] ]) - signaller.emit_signal('interfer_init', interfer_name, fs_arr, power_um) - print_debug(['interfer_init: ', interfer_name, fs_arr]) + + static func _handle_read_isa(prd_module: Object, prd_unit: Object, read_isa_ports: Array) -> void: + prd_module.cmd_array.append([prd_unit.CmdCode.READ_ISA, read_isa_ports]) -## Проверка касет П1 и ИП МА2000 -static func check_block_ip(status_prd: PackedByteArray, block_config: Dictionary) -> Dictionary: - # Конфигурация проверяемых блоков - const BYTE_DRY_CONTACT: int = 27 - var ug_online: bool = (status_prd[0] >> 1) & 1 - for block in block_config: - var bit: int = block_config[block][0] - if ug_online: - var status = status_prd[BYTE_DRY_CONTACT] >> bit & 1 - block_config[block][1] = status + ## Управаление модулем фс (включить/отключить излучение) + static func manage_fs(mode: bool, pribor: String, p_conf: Dictionary, fs_params: Dictionary, cur_fs: int, power_um: int) -> void: + # Получаем конфигурацию для текущего прибора + var config: Dictionary = p_conf[pribor] + var angle: float = config.angle + var sectors: Array = config.sectors - return block_config + # Формируем выходные данные + var interfer_name: String = 'k1' if mode else 'off' + var fs_arr: Array = [] + + if cur_fs in fs_params: + var params = fs_params[cur_fs] + fs_arr.append([ + angle, + params.freq, + params.width, + sectors[cur_fs - 1] if cur_fs == 1 else sectors[cur_fs - 5] if cur_fs > 5 else sectors[cur_fs - 4] if cur_fs > 3 else sectors[cur_fs - 2] + ]) + signaller.emit_signal('interfer_init', interfer_name, fs_arr, power_um) -## Проверка температур УМ от УКП -static func check_temperature_um(status_prd: PackedByteArray, power_amplifier: Array) -> void: - const Constants: Dictionary = { - 'CONST_MIN_TEMP': -25, - 'MAXIMUM_CODE_ADC': 3796, - 'MINIMUM_CODE_AD': 2660, - 'TEMPERATURE_UKP_1': 47, - 'TEMPERATURE_UKP_2': 79, - } - const TEMP: float = 115.0 / (Constants.MAXIMUM_CODE_ADC - Constants.MINIMUM_CODE_AD) - var ukp1_online: int = (status_prd[0] >> 2) & 1 - if ukp1_online: - var tmp_1: int - var temperature_ukp_1: int - for i_temp in 6: - temperature_ukp_1 = status_prd.decode_u16(Constants.TEMPERATURE_UKP_1 + 2 * i_temp) - tmp_1 = round(Constants.CONST_MIN_TEMP + (Constants.MAXIMUM_CODE_ADC - temperature_ukp_1) * TEMP + 3) - power_amplifier[i_temp].value0 = tmp_1 - # Темпуратура от УМ литеры 1 - temperature_ukp_1 = status_prd.decode_u16(Constants.TEMPERATURE_UKP_1 + 2 * 7) - tmp_1 = round(Constants.CONST_MIN_TEMP + (Constants.MAXIMUM_CODE_ADC - temperature_ukp_1) * TEMP + 3) - power_amplifier[6].value0 = tmp_1 + ## Проверка касет П1 и ИП МА2000 + static func check_block_ip(status_prd: PackedByteArray, ip_config: Dictionary) -> Dictionary: + # Конфигурация проверяемых блоков + var byte_dry: int = 27 + var ug_valid: bool = (status_prd[0] >> 1) & 1 + for block in ip_config: + var bit: int = ip_config[block][0] + if ug_valid: + var status = status_prd[byte_dry] >> bit & 1 + ip_config[block][1] = false if status else true + return ip_config - var ukp2_online = (status_prd[0] >> 3) & 1 - if ukp2_online: - for i_temp in 6: - var temperature_ukp_2: int = status_prd.decode_u16(Constants.TEMPERATURE_UKP_2 + 2 * i_temp) - var tmp_2: int = round(Constants.CONST_MIN_TEMP + (Constants.MAXIMUM_CODE_ADC - temperature_ukp_2) * TEMP + 3) - power_amplifier[i_temp+7].value0 = tmp_2 + + ## Проверка кассеты у-5 (ЯУ-07Б, ЭМС-Г, УГ, УКП-1, УКП-2) + static func check_block_kasseta_y5(status_prd: PackedByteArray, y5_config: Dictionary) -> Dictionary: + y5_config.yau07 = true + y5_config.ems = (status_prd[0] & 1) and ((status_prd[0] >> 4) & 1) + y5_config.ug = (status_prd[0] >> 1) & 1 + y5_config.ukp1 = (status_prd[0] >> 2) & 1 + y5_config.ukp2 = (status_prd[0] >> 3) & 1 + return y5_config + + + ## Проверка температур УМ от УКП + static func check_temperature_um(status_prd: PackedByteArray, power_amplifier: Array) -> void: + const Constants: Dictionary = { + 'CONST_MIN_TEMP': -25, + 'MAXIMUM_CODE_ADC': 3796, + 'MINIMUM_CODE_AD': 2660, + 'TEMPERATURE_UKP_1': 47, + 'TEMPERATURE_UKP_2': 79, + } + const TEMP: float = 115.0 / (Constants.MAXIMUM_CODE_ADC - Constants.MINIMUM_CODE_AD) + var ukp1_online: int = (status_prd[0] >> 2) & 1 + var ukp2_online = (status_prd[0] >> 3) & 1 + + if ukp1_online: + var tmp_1: int + var temperature_ukp_1: int + for i_temp in 6: + temperature_ukp_1 = status_prd.decode_u16(Constants.TEMPERATURE_UKP_1 + 2 * i_temp) + tmp_1 = round(Constants.CONST_MIN_TEMP + (Constants.MAXIMUM_CODE_ADC - temperature_ukp_1) * TEMP + 3) + power_amplifier[i_temp].value0 = tmp_1 + + if power_amplifier.size() > 12: # Темпуратура от УМ литеры 1 + temperature_ukp_1 = status_prd.decode_u16(Constants.TEMPERATURE_UKP_1 + 2 * 7) + tmp_1 = round(Constants.CONST_MIN_TEMP + (Constants.MAXIMUM_CODE_ADC - temperature_ukp_1) * TEMP + 3) + power_amplifier[6].value0 = tmp_1 + + if ukp2_online: + for i_temp in 6: + var temperature_ukp_2: int = status_prd.decode_u16(Constants.TEMPERATURE_UKP_2 + 2 * i_temp) + var tmp_2: int = round(Constants.CONST_MIN_TEMP + (Constants.MAXIMUM_CODE_ADC - temperature_ukp_2) * TEMP + 3) + if power_amplifier.size() > 12: + power_amplifier[i_temp+7].value0 = tmp_2 + else: + power_amplifier[i_temp+6].value0 = tmp_2 + + + ## Проверка ДКМ + static func check_dkm(status_prd: PackedByteArray, bit_dkm: int, dkm_result: Dictionary) -> Dictionary: + var dkm: int = 28 + var status_dkm = status_prd[dkm] >> bit_dkm & 1 + if bit_dkm == 0: + dkm_result['dkm_1'] = status_dkm + elif bit_dkm == 1: + dkm_result['dkm_2'] = status_dkm + elif bit_dkm == 2: + dkm_result['dkm_3'] = status_dkm + elif bit_dkm == 3: + dkm_result['dkm_4'] = status_dkm + elif bit_dkm == 4: + dkm_result['dkm_5'] = status_dkm + elif bit_dkm == 5: + dkm_result['dkm_6'] = status_dkm + elif bit_dkm == 6: + dkm_result['dkm_7'] = status_dkm + return dkm_result + + + ## + static func _create_fs_mapping(s_name: String) -> Dictionary: + var suffixes: Dictionary = { + 0: '1к', 1: '4к', 2: '3к', 3: '2к', + 4: '1н', 5: '4н', 6: '3н', 7: '2н', + 8: '1н', 9: '4н', 10: '3н', 11: '2н', + 12: '1в', 13: '4в', 14: '3в', 15: '2в', + 16: '1в', 17: '4в', 18: '3в', 19: '2в', + 20: '1к', 21: '4к', 22: '3к', 23: '2к', + 24: '1к', 25: '4к', 26: '3к', 27: '2к', + } + + var mapping: Dictionary = {} + for fs_num in suffixes: + mapping[fs_num] = {'condition': s_name == suffixes[fs_num]} + return mapping + + + ## + static func on_fs_state(packet_type_7: Dictionary, fs_mapping: Dictionary, fs_results: Dictionary) -> Dictionary: + var FS_RULES = [ + {'key': 'fs_1', 'min': 0, 'max': 4}, + {'key': 'fs_2', 'min': 4, 'max': 8}, + {'key': 'fs_3', 'min': 8, 'max': 12}, + {'key': 'fs_4', 'min': 12, 'max': 16}, + {'key': 'fs_5', 'min': 16, 'max': 20}, + {'key': 'fs_6', 'min': 20, 'max': 24}, + {'key': 'fs_7', 'min': 24, 'max': 27} + ] + + var updated_results := fs_results.duplicate() + for fs_num in packet_type_7: + if not (fs_num in fs_mapping and fs_mapping[fs_num]['condition']): + continue + var fs_data = packet_type_7[fs_num] + for rule_key in FS_RULES.size(): + var rule: Dictionary = FS_RULES[rule_key] + if _should_apply_rule(fs_num, rule, updated_results): + updated_results[rule.key] = fs_data.isg + break + return updated_results + + + ## Вспомогательная функция для проверки применения правила + static func _should_apply_rule(fs_num: int, rule: Dictionary, results: Dictionary) -> bool: + return bool(fs_num >= rule.min and fs_num < rule.max) and results.has(rule.key) + + + ## + static func power_um_ukp(status: PackedByteArray, crnt_fs: int, pwr_result: Array) -> Array: + const Constants: Dictionary = {'POWER_UKP_1' : 31, 'POWER_UKP_2': 63} + var power_values: Array = [] + var base_offset = 0 + var iteration: int = 6 + var ug_valid: bool = (status[0] >> 2) & 1 + + match crnt_fs: + 1: + # Обработка для current_fs = 1 (одно значение) + var value = status.decode_u16(Constants.POWER_UKP_1 + 2 * 7) + if ug_valid: + power_values = [value] + 2: + # Обработка для current_fs = 2 (6 значений из УКП1) + base_offset = Constants.POWER_UKP_1 + if ug_valid: + for i in iteration: + power_values.append(status.decode_u16(base_offset + 2 * i)) + 3: + # Обработка для current_fs = 3 (6 значений из УКП2) + base_offset = Constants.POWER_UKP_2 + if ug_valid: + for i in iteration: + power_values.append(status.decode_u16(base_offset + 2 * i)) + 4: + # Обработка для current_fs = 4 (6 значений из УКП1) + base_offset = Constants.POWER_UKP_1 + if ug_valid: + for i in iteration: + power_values.append(status.decode_u16(base_offset + 2 * i)) + 5: + # Обработка для current_fs = 5 (6 значений из УКП2) + base_offset = Constants.POWER_UKP_2 + if ug_valid: + for i in iteration: + power_values.append(status.decode_u16(base_offset + 2 * i)) + 6: + # Обработка для current_fs = 6 (6 значений из УКП1) + base_offset = Constants.POWER_UKP_1 + if ug_valid: + for i in iteration: + power_values.append(status.decode_u16(base_offset + 2 * i)) + 7: + # Обработка для current_fs = 7 (6 значений из УКП2) + base_offset = Constants.POWER_UKP_2 + if ug_valid: + for i in iteration: + power_values.append(status.decode_u16(base_offset + 2 * i)) + + power_values = update_max_power_values(power_values, pwr_result) + return power_values + + + ## Обновление максимальных значений + static func update_max_power_values(power_data: Array, max_power_values: Array) -> Array: + if power_data.size() != 6: + if max_power_values.is_empty(): + max_power_values = power_data.duplicate() + elif power_data[0] > max_power_values[0]: + max_power_values = power_data.duplicate() + return max_power_values + + if max_power_values.is_empty(): + max_power_values = power_data.duplicate() + else: + for i in 6: + if power_data[i] > max_power_values[i]: + max_power_values[i] = power_data[i] + + return max_power_values.duplicate()