- used on-changed callbacks for heater and pot

This commit is contained in:
jens
2020-12-07 09:52:31 +01:00
parent fcd100ef0e
commit df33398c2d
+30 -27
View File
@@ -9,8 +9,9 @@ from components.pid import kalman, temp_controller
from ws.message import MsgIo, MessageDispatcher from ws.message import MsgIo, MessageDispatcher
from utils.value import Value, ChangedFloat, ChangedInteger from utils.value import Value, ChangedFloat, ChangedInteger
TC_DT = 0.1 DT_CTRL = 0.1
PARAMS_DT = 0.1 DT_PARAMS = 1.0
class ATask: class ATask:
def __init__(self, interval): def __init__(self, interval):
@@ -58,6 +59,12 @@ class HeaterTask(ATask):
def actor(self, y): def actor(self, y):
self.heater.setPower(max(0, 0 + self.heater.get_power_max() * y)) self.heater.setPower(max(0, 0 + self.heater.get_power_max() * y))
def on_changed_activated(self, is_activated):
asyncio.create_task(self.send({'Activate': int(is_activated)}))
def on_changed_power(self, power):
asyncio.create_task(self.send({'Power': power}))
async def recv(self, data): async def recv(self, data):
print(data) print(data)
for pair in data.items(): for pair in data.items():
@@ -73,12 +80,10 @@ class HeaterTask(ATask):
print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval)) print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval))
await self.send({'Capabilities': {'Power': {'Min': self.heater.get_power_min(), 'Max': self.heater.get_power_max()}}}) await self.send({'Capabilities': {'Power': {'Min': self.heater.get_power_min(), 'Max': self.heater.get_power_max()}}})
power = Value() self.heater.set_on_changed('is_activated', ChangedInteger(self.on_changed_activated).set)
self.heater.set_on_changed('power_eff', ChangedInteger(self.on_changed_power).set)
while True: while True:
self.heater.process() self.heater.process()
power.set(round(self.heater.getPower()))
if power.is_changed():
await self.send({'Power': power.get(), 'Activate': int(self.heater.is_activated() != 0)})
await asyncio.sleep(self.interval) await asyncio.sleep(self.interval)
@@ -90,6 +95,12 @@ class PotTask(ATask):
msg_handler.set_recv_handler(self.recv) msg_handler.set_recv_handler(self.recv)
self.plant = pot self.plant = pot
def on_changed_power(self, value):
asyncio.create_task(self.send({'Power': value}))
def on_changed_temp(self, value):
asyncio.create_task(self.send({'Temp': value}))
async def recv(self, data): async def recv(self, data):
print(data) print(data)
for key in data: for key in data:
@@ -100,19 +111,11 @@ class PotTask(ATask):
async def on_process(self): async def on_process(self):
print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval)) print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval))
plant_temp = Value(-1) self.plant.set_on_changed('power_actual', ChangedInteger(self.on_changed_power).set)
plant_power = Value() self.plant.set_on_changed('temp', ChangedFloat(self.on_changed_temp, prec=1).set)
while True: while True:
self.plant.process() self.plant.process()
plant_power.set(round(self.plant.getPower()))
plant_temp.set(round(self.plant.getTemperature(), 1))
if plant_power.is_changed():
await self.send({'Power': plant_power.get()})
if plant_temp.is_changed():
await self.send({'Temp': plant_temp.get()})
await asyncio.sleep(self.interval) await asyncio.sleep(self.interval)
@@ -164,8 +167,8 @@ class TcTask(ATask):
self.tc.set_on_changed('state', self.on_state_changed) self.tc.set_on_changed('state', self.on_state_changed)
self.tc.set_on_changed('theta_ist', ChangedFloat(self.on_temp_ist_changed, prec=1).set) self.tc.set_on_changed('theta_ist', ChangedFloat(self.on_temp_ist_changed, prec=1).set)
self.tc.set_on_changed('heatrate_ist', ChangedFloat(self.on_rate_ist_changed, prec=1).set) self.tc.set_on_changed('heatrate_ist', ChangedFloat(self.on_rate_ist_changed, prec=1).set)
self.tc.set_on_changed('theta_soll_set', self.on_temp_soll_changed) self.tc.set_on_changed('theta_soll_set', ChangedFloat(self.on_temp_soll_changed, prec=1).set)
self.tc.set_on_changed('heatrate_soll_set', self.on_rate_soll_changed) self.tc.set_on_changed('heatrate_soll_set', ChangedFloat(self.on_rate_soll_changed, prec=1).set)
self.tc.set_theta_soll(30.0) self.tc.set_theta_soll(30.0)
self.tc.set_heatrate_soll(1.0) self.tc.set_heatrate_soll(1.0)
@@ -207,11 +210,11 @@ if __name__ == '__main__':
# Sensor # Sensor
sensor = TempSensorSim() sensor = TempSensorSim()
taskmgr.add(TempSensorTask(sensor, TC_DT, dispatcher.msgio_get("Sensor"))) taskmgr.add(TempSensorTask(sensor, DT_CTRL, dispatcher.msgio_get("Sensor")))
# Plant # Plant
pot_params = { pot_params = {
"dt" : PARAMS_DT, "dt" : DT_PARAMS,
"theta" : 20, "theta" : 20,
"C" : 4190, "C" : 4190,
"M" : 20, "M" : 20,
@@ -221,25 +224,25 @@ if __name__ == '__main__':
} }
pot = Pot(pot_params, 20) pot = Pot(pot_params, 20)
pot.set_on_changed("temp", ChangedFloat(sensor.set_fake_temp, prec=3).set) pot.set_on_changed("temp", ChangedFloat(sensor.set_fake_temp, prec=3).set)
taskmgr.add(PotTask(pot, TC_DT, dispatcher.msgio_get("Pot"))) taskmgr.add(PotTask(pot, DT_CTRL, dispatcher.msgio_get("Pot")))
# Heater # Heater
heater = Heater() heater = Heater()
heater.set_on_changed("power_eff", ChangedFloat(pot.setPower, prec=0).set) heater.set_on_changed("power_eff", ChangedFloat(pot.setPower, prec=0).set)
heater_task = HeaterTask(heater, TC_DT, dispatcher.msgio_get("Heater")) heater_task = HeaterTask(heater, DT_CTRL, dispatcher.msgio_get("Heater"))
taskmgr.add(heater_task) taskmgr.add(heater_task)
# Temperature Controller # Temperature Controller
tc_params = { tc_params = {
"Hold": { "Hold": {
"dt": PARAMS_DT, "dt": DT_PARAMS,
"kp": 0.5, "kp": 0.5,
"ki": 0.005, "ki": 0.005,
"kd": 0.0, "kd": 0.0,
"rho": 1.0 "rho": 1.0
}, },
"Heat": { "Heat": {
"dt": PARAMS_DT, "dt": DT_PARAMS,
"kp": 0.1, "kp": 0.1,
"ki": 0.01, "ki": 0.01,
"kd": 0.0, "kd": 0.0,
@@ -249,7 +252,7 @@ if __name__ == '__main__':
# Kalman Filter # Kalman Filter
kalman_params = { kalman_params = {
"dt" : PARAMS_DT, "dt" : DT_PARAMS,
"var_P" : 1, "var_P" : 1,
"var_Q" : 0.0001, "var_Q" : 0.0001,
"var_R" : 1 "var_R" : 1
@@ -257,7 +260,7 @@ if __name__ == '__main__':
tc = temp_controller.TempController(tc_params, kalman_params) tc = temp_controller.TempController(tc_params, kalman_params)
tc.set_on_changed("y", heater_task.actor) tc.set_on_changed("y", heater_task.actor)
tc_task = TcTask(tc, TC_DT, dispatcher.msgio_get("TempCtrl")) tc_task = TcTask(tc, DT_CTRL, dispatcher.msgio_get("TempCtrl"))
taskmgr.add(tc_task) taskmgr.add(tc_task)
sensor.set_on_changed("temp", ChangedFloat(tc.set_theta_ist, prec=2).set) sensor.set_on_changed("temp", ChangedFloat(tc.set_theta_ist, prec=2).set)