126 lines
2.8 KiB
Python
126 lines
2.8 KiB
Python
# Python Test Scripts for Controlling Kirdy
|
|
# Kirdy is written to be controlled via a json object based on miniconf rust crate
|
|
# Json Field:
|
|
# "laser_diode_cmd / thermostat_cmd": Check cmd_handler.rs for the list of cmds
|
|
# "data_f32": Optional f32 Data field depending on cmd
|
|
# "data_f64": Optional f64 Data field depending on cmd
|
|
|
|
import socket
|
|
import json
|
|
import time
|
|
import signal
|
|
|
|
# Kirdy IP and Port Number
|
|
HOST = "192.168.1.132"
|
|
PORT = 1337
|
|
|
|
dfu_cmd = {
|
|
"device_cmd": "Dfu",
|
|
}
|
|
|
|
ld_cmd = {
|
|
"laser_diode_cmd": "SetI",
|
|
"data_f64": 0.0,
|
|
}
|
|
|
|
tec_power_down = {
|
|
"thermostat_cmd": "PowerDown",
|
|
}
|
|
|
|
tec_set_sh_t0_cmd = {
|
|
"thermostat_cmd": "SetShT0",
|
|
"data_f64": 25.0,
|
|
}
|
|
|
|
tec_set_sh_r0_cmd = {
|
|
"thermostat_cmd": "SetShR0",
|
|
"data_f64": 10.0 * 1000,
|
|
}
|
|
|
|
tec_set_sh_beta_cmd = {
|
|
"thermostat_cmd": "SetShBeta",
|
|
"data_f64": 3900.0,
|
|
}
|
|
|
|
tec_set_temperature_setpoint_cmd = {
|
|
"thermostat_cmd": "SetTemperatureSetpoint",
|
|
"data_f64": 25.0,
|
|
}
|
|
|
|
tec_set_pid_kp_cmd = {
|
|
"thermostat_cmd": "SetPidKp",
|
|
"data_f64": 0.10889684439011593
|
|
}
|
|
|
|
tec_set_pid_ki_cmd = {
|
|
"thermostat_cmd": "SetPidKi",
|
|
"data_f64": 0.0038377132059211646
|
|
}
|
|
|
|
tec_set_pid_kd_cmd = {
|
|
"thermostat_cmd": "SetPidKd",
|
|
"data_f64": 0.22294449514406328
|
|
}
|
|
|
|
tec_set_pid_out_min_cmd = {
|
|
"thermostat_cmd": "SetPidOutMin",
|
|
"data_f64": -1.0,
|
|
}
|
|
|
|
tec_set_pid_out_max_cmd = {
|
|
"thermostat_cmd": "SetPidOutMax",
|
|
"data_f64": 1.0,
|
|
}
|
|
|
|
tec_power_up = {
|
|
"thermostat_cmd": "PowerUp",
|
|
}
|
|
|
|
tec_pid_engage = {
|
|
"thermostat_cmd": "SetPidEngage",
|
|
}
|
|
|
|
tec_get_tec_status = {
|
|
"thermostat_cmd": "GetTecStatus",
|
|
}
|
|
|
|
def send_cmd(input, socket):
|
|
socket.send(bytes(json.dumps(input), "UTF-8"))
|
|
# Give some time for Kirdy to process the cmd
|
|
time.sleep(0.5)
|
|
|
|
def read_cmd(input, socket):
|
|
socket.send(bytes(json.dumps(input), "UTF-8"))
|
|
data = socket.recv(1024).decode('utf8')
|
|
return json.loads(data)
|
|
|
|
s = socket.socket(socket.AF_INET, socket.SOCK_STREAM)
|
|
|
|
def signal_handler(sig, frame):
|
|
ld_cmd["data_f64"] = 0.0
|
|
send_cmd(ld_cmd, s)
|
|
send_cmd(tec_power_down, s)
|
|
s.close()
|
|
exit()
|
|
|
|
signal.signal(signal.SIGINT, signal_handler)
|
|
|
|
with socket.socket(socket.AF_INET, socket.SOCK_STREAM) as s:
|
|
s.connect((HOST, PORT))
|
|
send_cmd(ld_cmd, s)
|
|
send_cmd(tec_power_down, s)
|
|
send_cmd(tec_set_sh_t0_cmd, s)
|
|
send_cmd(tec_set_sh_r0_cmd, s)
|
|
send_cmd(tec_set_sh_beta_cmd, s)
|
|
send_cmd(tec_set_temperature_setpoint_cmd, s)
|
|
send_cmd(tec_set_pid_kp_cmd, s)
|
|
send_cmd(tec_set_pid_ki_cmd, s)
|
|
send_cmd(tec_set_pid_kd_cmd, s)
|
|
send_cmd(tec_pid_engage, s)
|
|
send_cmd(tec_power_up, s)
|
|
|
|
while True:
|
|
tec_status = read_cmd(tec_get_tec_status, s)
|
|
print(f"Ts: {tec_status['ts']} | Temperature: {tec_status['temperature'] - 273.15}")
|
|
s.close()
|