175 lines
5.1 KiB
GDScript
175 lines
5.1 KiB
GDScript
extends Node
|
|
|
|
var counter: int = 0
|
|
const INDEX_SIZE = 0xC
|
|
|
|
|
|
func _ready() -> void:
|
|
pass
|
|
|
|
|
|
func _process(_delta: float) -> void:
|
|
pass
|
|
|
|
|
|
func _enter_tree() -> void:
|
|
# Подключаем сигналы к методам
|
|
Network.connect('data_send', _on_data_send)
|
|
Network.connect('data_received', _on_data_received)
|
|
Network.connect('port_opened', _on_port_changed.bind(Color.GREEN))
|
|
Network.connect('port_closed', _on_port_changed.bind(Color.GRAY))
|
|
Network.connect('port_error', _on_port_changed.bind(Color.RED))
|
|
|
|
|
|
func _on_port_changed(port_name: String, color: Color) -> void:
|
|
$manage_panel/con/ip_connect.text = port_name
|
|
$fs_connect.self_modulate = color
|
|
|
|
|
|
func _on_data_send():
|
|
pass
|
|
|
|
|
|
func _on_data_received(data: PackedByteArray):
|
|
var GRP = data.decode_u8(0x0)
|
|
var CMD = data.decode_u8(0x1)
|
|
match CMD:
|
|
Constants.CMD.READ_CARRIER:
|
|
if GRP == Constants.GROUP.BASE:
|
|
$manage_panel/get_freq/freq_ind.text = str(data.decode_u64(0xC)) + ' Гц'
|
|
Constants.CMD.READ_ATT:
|
|
if GRP == Constants.GROUP.RF:
|
|
$manage_panel/get_att/att_ind.text = '-' + str(data.decode_float(0x18)) + ' dB'
|
|
Constants.CMD.READ_GEN_STATUS:
|
|
if GRP == Constants.GROUP.GENERATOR:
|
|
if data.decode_u32(0xC) == 0:
|
|
$manage_panel/get_gen_status/status_ind.text = 'Включен'
|
|
$manage_panel/get_gen_status/status_ind.modulate = Color.GREEN
|
|
else:
|
|
$manage_panel/get_gen_status/status_ind.text = 'Выключен'
|
|
$manage_panel/get_gen_status/status_ind.modulate = Color.RED
|
|
Constants.CMD.BASE_GET_CURRENT_TEMP:
|
|
if GRP == Constants.GROUP.BASE:
|
|
$temp_1.text = '%.2f' % data.decode_float(0xC) + ' °C'
|
|
$temp_2.text = str(data.decode_float(0x10)) + ' °C'
|
|
$temp_3.text = str(data.decode_float(0x14)) + ' °C'
|
|
$read.text = str(data.hex_encode())
|
|
|
|
|
|
const GROUP_OFFSET = 0x0
|
|
const CMD_OFFSET = 0x1
|
|
const COUNTER_OFFSET = 0x4
|
|
const PAYLOAD_OFFSET = 0x8
|
|
|
|
func _form_packet(group, cmd, index_size, data = null):
|
|
var packet = PackedByteArray()
|
|
packet.resize(index_size)
|
|
packet.encode_u8(GROUP_OFFSET, group)
|
|
packet.encode_u8(CMD_OFFSET, cmd)
|
|
packet.encode_u32(COUNTER_OFFSET, counter)
|
|
counter += 1
|
|
if data:
|
|
packet.encode_float(PAYLOAD_OFFSET, data)
|
|
return packet
|
|
|
|
|
|
func _send_packet(packet):
|
|
var crc = crc32(packet)
|
|
packet.resize(packet.size() + 4)
|
|
packet.encode_u32(packet.size() - 4, crc)
|
|
Network.command_stack.append(packet)
|
|
|
|
|
|
func start_session():
|
|
counter = 0
|
|
var packet = _form_packet(Constants.GROUP.BASE, Constants.CMD.START_SESSION, 0xC)
|
|
_send_packet(packet)
|
|
get_gen_state()
|
|
get_att_batch()
|
|
get_carrier()
|
|
|
|
|
|
func set_gen_state(button_state: bool):
|
|
var index_size = 0x1C
|
|
var packet = _form_packet(Constants.GROUP.GENERATOR, Constants.CMD.SET_GEN_STATUS, index_size)
|
|
packet.encode_u16(0x8, 0x0010)
|
|
packet.encode_u32(0xC, button_state) ## MODE GEN STATUS
|
|
_send_packet(packet)
|
|
get_gen_state()
|
|
|
|
|
|
func set_carrier(wr_freq):
|
|
var index_size = 0x1C
|
|
var packet = _form_packet(Constants.GROUP.BASE, Constants.CMD.SET_CARRIER, index_size)
|
|
packet.encode_u16(0x8, 0x10)
|
|
packet.encode_u64(0xC, wr_freq) ## uint64_t freq low dword/high dword
|
|
_send_packet(packet)
|
|
|
|
|
|
func set_att_batch(att):
|
|
var index_size = 0x1C
|
|
var packet = _form_packet(Constants.GROUP.RF, Constants.CMD.SET_ATT, index_size)
|
|
packet.encode_u16(0x8, 0x10)
|
|
packet.encode_float(0x18, att)
|
|
_send_packet(packet)
|
|
|
|
|
|
func get_carrier():
|
|
var packet = _form_packet(Constants.GROUP.BASE, Constants.CMD.READ_CARRIER, INDEX_SIZE)
|
|
_send_packet(packet)
|
|
|
|
|
|
func get_att_batch():
|
|
var packet = _form_packet(Constants.GROUP.RF, Constants.CMD.READ_ATT, INDEX_SIZE)
|
|
_send_packet(packet)
|
|
|
|
|
|
func get_gen_state():
|
|
var packet = _form_packet(Constants.GROUP.GENERATOR, Constants.CMD.READ_GEN_STATUS, INDEX_SIZE)
|
|
_send_packet(packet)
|
|
|
|
|
|
func base_get_current_temp():
|
|
var packet = _form_packet(Constants.GROUP.BASE, Constants.CMD.BASE_GET_CURRENT_TEMP, INDEX_SIZE)
|
|
_send_packet(packet)
|
|
|
|
|
|
func crc32(data: PackedByteArray) -> int:
|
|
var crc = Constants.INIT
|
|
for byte in data:
|
|
var index = (crc ^ byte) & 0xFF
|
|
crc = (Constants.CRC32_TABLE[index] ^ (crc >> 8)) & 0xFFFFFFFF
|
|
# Возвращаем только последние 4 байта в обратном порядке
|
|
var final_crc = crc ^ Constants.FINAL_XOR_VALUE
|
|
return final_crc
|
|
|
|
|
|
func _on_send_pressed() -> void:
|
|
get_carrier()
|
|
|
|
|
|
func _on_get_att() -> void:
|
|
get_att_batch()
|
|
|
|
|
|
func _on_start():
|
|
#if ServerNode.connect_fs():
|
|
start_session()
|
|
base_get_current_temp()
|
|
|
|
|
|
func _on_get_status(toggled_btn):
|
|
var inverted_state = not toggled_btn
|
|
set_gen_state(inverted_state)
|
|
get_gen_state()
|
|
|
|
|
|
func _on_set_ferq():
|
|
var freq = int($set_space/write_to_set_freq.get_text()) * 1_000_000
|
|
set_carrier(freq)
|
|
|
|
|
|
func _on_set_att():
|
|
var att = float($set_space/write_to_set_att.get_text())
|
|
set_att_batch(att)
|