#include <stdio.h>
  #include <stdlib.h>
  #include <termios.h>
  #include <unistd.h>
  #include <errno.h>
  #include <sys/types.h>
  #include <sys/stat.h>
  #include <fcntl.h>
  #include <strings.h>
  #include <inttypes.h>

  #include <time.h>

  #include "ui.h"
  #include "hvc.h"
  #include "printx.h"
  #include "serial.h"

  #include "heat.h"

  #include "pump.h"

  
  #define	DEVICE1				"/dev/ttyACM1"
  #define	SPEED				B19200

  #define HVC_POLLING_TIME	50000

  #define	WAIT_BEFORE_RETRY	5000
  #define	GET_DEVICE_MODEL	'A'
  #define	DEVICE_MODEL_HVC	'C'
  #define	GET_TEMP			'H'

  #define	SET_HEAT_ON			'E'
  #define	SET_HEAT_OFF		'G'
  #define	SET_PUMP_ON			'B'
  #define	SET_PUMP_OFF		'D'

  #define	PUMP_STATE_HIGH		'I'
  #define	GET_PUMP			'F'

  
  // Globals
  int		hvc_fd = -1;
  bool	hvcStop = false;

  int		pumped = 0;
  bool	previousPumpState;

  bool	sPump = false;
  bool	sHeat = false;

  bool	autoHeat = false;

  struct	termios hvcSaveterm;

  bool	wHeat = false;
  bool	wPump = false;

  time_t	tHeatStart;
  time_t	tHeatStop;
  double	tHeatTimer;
  time_t	tPumpStart;
  double	tPumpTimer;
  time_t	tPumpStop;

  int		tempCons;
  
  void setPumpOn()
  {

  	setPumpWantedState(true);
  }
  
  void setPumpOff()
  {

  	pumped = 0;

  	setPumpWantedState(false);
  }
  
  void setHeatOn()
  {
  	setHeatWantedState(true);
  }
  
  void setHeatOff()
  {
  	setHeatWantedState(false);
  }

  
  void stopHVC()
  {
  	hvcStop = true;
  }
  
  void setPumpWantedState(bool s)
  {

  	tPumpStart = clock();
  	tPumpStop = clock();

  	wPump = s;
  }
  
  void setHeatWantedState(bool s)
  {

  	tHeatStart = clock();
  	tHeatStop = clock();

  	wHeat = s;
  }

  void setPumpTimer(double t)
  {
  	tPumpTimer = t;
  }
  
  void setHeatTimer(double t)
  {
  	tHeatTimer = t;
  }
  

  void setAutoHeat(bool s)
  {
  	autoHeat = s;
  }
  

  bool initHVC()
  {
  	unsigned char data;
  	printx(DEBUG, HVC, "Connecting to interface 1\n");
  	if(init_serial(DEVICE1, SPEED, &hvc_fd, &hvcSaveterm))
  	{
  		printx(DEBUG, HVC, "Connected to an interface\n");
  		sendData(&hvc_fd, GET_DEVICE_MODEL);
  		printx(DEBUG, HVC, "Sended identification request %02x\n", GET_DEVICE_MODEL);
  		data = getData(&hvc_fd);
  		if(data == DEVICE_MODEL_HVC)
  			printx(INFO, HVC, "HVC Arduino connected\n");
  		else
  			printx(DEBUG, HVC, "HVC Arduino not found, response was %02x\n", data);
  	}
  	else
  	{
  		printx(WARNING, HVC, "Unable to connect to such interface\n");
  		return false;
  	}
  

  	sendData(&hvc_fd, GET_PUMP);
  	data = getData(&hvc_fd);
  

  	previousPumpState = (data == PUMP_STATE_HIGH);
  	printf("Data received from HVC for PUMP %02x\n", data);

  	return true;
  }
  
  void* processHVC(void* we)
  {

  	uint8_t	data;
  	bool	pumpState;
  	float	temp;

  
  	while(!hvcStop)
  	{

  		printx(DEBUG, HVC, "Querying data, with prev PUMP %d\n", pumped);

  		sendData(&hvc_fd, GET_TEMP);
  		data = getData(&hvc_fd);
  		setTemp(data);

  		temp = 25 + (((float)(80*data)))/255;

  		actTemp(temp);

  		printx(DEBUG, TEMP, "TEMP %f\n", temp);

  		if(tHeatTimer > 0)
  		{
  			tHeatStop = clock();
  			if(((double)(tHeatStop - tHeatStart) / CLOCKS_PER_SEC) > tHeatTimer)
  			{
  				wHeat = false;
  				tHeatTimer = 0;

  			}

  		}
  
  		if(tPumpTimer > 0)
  		{
  			tPumpStop = clock();
  			if(((double)(tPumpStop - tPumpStart) / CLOCKS_PER_SEC) > tPumpTimer)
  			{
  				wPump = false;
  				tPumpTimer = 0;

  			}
  		}
  

  		if(wHeat ^ sHeat)
  		{
  			sendData(&hvc_fd, wHeat ? SET_HEAT_ON : SET_HEAT_OFF);
  			sHeat = wHeat;
  			setHeat(sHeat);

  			if(sHeat)
  				tHeatStart = clock();

  		}
  
  		if(wPump ^ sPump)
  		{
  			sendData(&hvc_fd, wPump ? SET_PUMP_ON : SET_PUMP_OFF);
  			sPump = wPump;
  			setPump(sPump);

  			if(sPump)
  				tPumpStart = clock();

  		}
  

  		// Querying pump state

  		sendData(&hvc_fd, GET_PUMP);

  		data = getData(&hvc_fd);

  		pumpState = (data == PUMP_STATE_HIGH);
  		printx(DEBUG, HVC, "PUMP %d %d Flow : %d\n", previousPumpState, pumpState, pumped);

  		if(pumpState ^ previousPumpState)
  			pumped++;
  		previousPumpState = pumpState;

  		actDeb(pumped);

  		usleep(HVC_POLLING_TIME);
  	}
  
  	return NULL;
  }