import asyncio
from time import sleep
import abc
from ws.server.ws_server_multi_user import WsServerMultiUser
from components.sensor.tempSensorSim import TempSensorSim, ATemperatureSensor
from components.plant.pot import Pot, APlant
from components.actor.heater import Heater, AHeater
from components.pid import kalman, temp_controller
from ws.message import MsgIo, MessageDispatcher
from utils.value import Value, ChangedFloat, ChangedInteger

TC_DT = 0.1


class ATask:
	def __init__(self, interval):
		self.interval = interval

	@abc.abstractmethod
	def on_process(self):
		pass


class TempSensorTask(ATask):
	def __init__(self, sensor: ATemperatureSensor, interval, msg_handler: MsgIo, kalman: kalman.Kalman):
		ATask.__init__(self, interval)

		self.msg_handler = msg_handler
		msg_handler.set_recv_handler(self.recv)
		self.sensor = sensor
		self.kalman = kalman

	def on_temp_changed(self, value):
		asyncio.create_task(self.send({'Temp': value}))

	async def recv(self, data):
		print(data)

	async def send(self, data):
		await self.msg_handler.send(data)

	async def on_process(self):
		print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval))
		temp = ChangedFloat(self.on_temp_changed, prec=1)
		self.sensor.set_on_changed("temp", temp.set)
		while True:
			self.sensor.process()
			await asyncio.sleep(self.interval)


class HeaterTask(ATask):
	def __init__(self, heater: AHeater, interval, msg_handler: MsgIo):
		ATask.__init__(self, interval)

		self.msg_handler = msg_handler
		msg_handler.set_recv_handler(self.recv)
		self.heater = heater

	def actor(self, y):
		self.heater.setPower(max(0, 0 + self.heater.get_power_max() * y))

	async def recv(self, data):
		print(data)
		for pair in data.items():
			if 'Power' in pair[0]:
				self.heater.setPower(pair[1])
			if 'Activate' in pair[0]:
				self.heater.activate(bool(pair[1]))

	async def send(self, data):
		await self.msg_handler.send(data)

	async def on_process(self):
		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()}}})

		power = Value()
		while True:
			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)


class PotTask(ATask):
	def __init__(self, pot: APlant, interval, msg_handler: MsgIo):
		ATask.__init__(self, interval)

		self.msg_handler = msg_handler
		msg_handler.set_recv_handler(self.recv)
		self.plant = pot

	async def recv(self, data):
		print(data)
		for key in data:
			print(key)

	async def send(self, data):
		await self.msg_handler.send(data)

	async def on_process(self):
		print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval))
		plant_temp = Value(-1)
		plant_power = Value()
		while True:
			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)


class TcTask(ATask):
	def __init__(self, tc: temp_controller.TempController, interval, msg_handler: MsgIo):
		ATask.__init__(self, interval)

		self.tc = tc
		self.msg_handler = msg_handler
		msg_handler.set_recv_handler(self.recv)

	def on_state_changed(self, value):
		print ("State change to {}".format(value))
		asyncio.create_task(self.send({'State': str(value)}))

	def on_temp_soll_changed(self, value):
		print ("Temp soll change to {}".format(value))
		asyncio.create_task(self.send({'Soll': {'Temp': value}}))

	def on_rate_soll_changed(self, value):
		print ("Rate soll change to {}".format(value))
		asyncio.create_task(self.send({'Soll': {'Rate': value}}))

	def on_temp_ist_changed(self, value):
		print ("Temp ist change to {}".format(value))
		asyncio.create_task(self.send({'Ist': {'Temp': value}}))

	def on_rate_ist_changed(self, value):
		print ("Rate ist change to {}".format(value))
		asyncio.create_task(self.send({'Ist': {'Rate': value}}))

	async def recv(self, msg):
		print(msg)
		for key in msg.keys():
			if 'Soll' in key:
				submsg = msg['Soll']
				for subkey in submsg.keys():
					if 'Temp' in subkey:
						self.tc.set_theta_soll(submsg['Temp'])
					if 'Rate' in subkey:
						self.tc.set_heatrate_soll(submsg['Rate'])

	async def send(self, data):
		await self.msg_handler.send(data)

	async def on_process(self):
		print("{}: Started with interval {} s".format(self.msg_handler.get_key(), self.interval))

		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('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('heatrate_soll_set', self.on_rate_soll_changed)

		self.tc.set_theta_soll(30.0)
		self.tc.set_heatrate_soll(1.0)

		while True:
			self.tc.process()
			await asyncio.sleep(self.interval)


class TaskManager:
	def __init__(self):
		self.tasks = []

	def add(self, task: ATask):
		self.tasks.append(task)

	def start(self):
		funcs = []
		for task in self.tasks:
			funcs.append(task.on_process())

		return asyncio.gather(*funcs)


async def asleep(time):
	await asyncio.sleep(time)

if __name__ == '__main__':
	if 0:
		taskmgr = PeriodicUpdaterThreaded()
		taskmgr.start("localhost", 8765)
		bg_thread = Thread(target=taskmgr.loop.run_forever)
		bg_thread.setDaemon(True)
		bg_thread.start()
	else:
		dispatcher = MessageDispatcher()
		server = WsServerMultiUser(listener=dispatcher)
		taskmgr = TaskManager()

		# Kalman Filter
		kalman_params = {
			"dt"		: 1.0,
			"var_P"		: 1,
			"var_Q"		: 0.0001,
			"var_R"		: 1
		}

		# Sensor
		sensor = TempSensorSim()
		taskmgr.add(TempSensorTask(sensor, TC_DT, dispatcher.msgio_get("Sensor"), kalman))

		# Plant
		pot_params = {
			"dt"			: 1.0,
			"theta"			: 20,
			"C"				: 4190,
			"M"				: 20,
			"L"				: 0.05,
			"Td"			: 12,
			"kn"			: 0.2
		}
		pot = Pot(pot_params, 20)
		pot.set_on_changed("temp", ChangedFloat(sensor.set_fake_temp, prec=3).set)
		taskmgr.add(PotTask(pot, TC_DT, dispatcher.msgio_get("Pot")))

		# Heater
		heater = Heater()
		heater.set_on_changed("power_eff", ChangedFloat(pot.setPower, prec=0).set)
		heater_task = HeaterTask(heater, TC_DT, dispatcher.msgio_get("Heater"))
		taskmgr.add(heater_task)

		# Temperature Controller
		tc_params = {
			"Hold": {
				"dt": 1.0,
				"kp": 0.5,
				"ki": 0.005,
				"kd": 0.0,
				"rho": 1.0
			},
			"Heat": {
				"dt": 1.0,
				"kp": 0.1,
				"ki": 0.01,
				"kd": 0.0,
				"rho": 1.0
			}
		}
		tc = temp_controller.TempController(tc_params, kalman_params)
		tc.set_on_changed("y", heater_task.actor)
		tc_task = TcTask(tc, TC_DT, dispatcher.msgio_get("TempCtrl"))
		taskmgr.add(tc_task)
		sensor.set_on_changed("temp", ChangedFloat(tc.set_theta_ist, prec=2).set)

		# Message dispatcher
		h_dispatcher = taskmgr.start()
		h_server = server.listen("localhost", 8765)
		asyncio.gather(h_dispatcher, h_server)
		server.run_forever()

	while True:
		print("Hallo")
		sleep(1)

{"+":"Pot"}
{"+":"Heater"}
{"Heater": {"Power": 2000, "Activate": 1}}