#include "xb_HTU21D.h"
#include <xb_board.h>
#include <Wire.h>
#include <xb_sensors.h>
#include <SparkFunHTU21D.h>

void XB_HTU21D_Setup();
uint32_t XB_HTU21D_DoLoop();

TTaskDef XB_HTU21D_DefTask = { &XB_HTU21D_Setup,&XB_HTU21D_DoLoop,NULL,NULL,6 };

HTU21D myHTU21D;

TSensorClass *SensorHTU21D_Hum;
TSensorClass *SensorHTU21D_Temp;



void XB_HTU21D_Setup()
{
	board.Log(FSS("Init HTU21D."),true,true);
	SensorHTU21D_Hum = new TSensorClass(svtHumidity, fcHTU21D, 1);
	SensorHTU21D_Temp = new TSensorClass(svtTemperature, fcHTU21D, 2);
	myHTU21D.begin();
	board.Log(FSS("OK\n"));
}

uint32_t XB_HTU21D_DoLoop()
{

	TValueData valuedata;

	valuedata.Humidity = myHTU21D.readHumidity();
	SensorHTU21D_Hum->SetValue(&valuedata);

	valuedata.Temperature = myHTU21D.readTemperature();
	SensorHTU21D_Temp->SetValue(&valuedata);



	return 1000;
}