#include <iostream>
#include <cmath>
#include "drv/usart.h"
#include "drv/b15f.h"
#include "drv/plottyfile.h"


void kennlinieErsterQuadrant()
{
	B15F& drv = B15F::getInstance();
	PlottyFile pf;
	
	uint16_t ba[1024];
	uint16_t bb[1024];
	
	const uint16_t sample_count = 100;
	const uint16_t delta = 10;
	
	const uint16_t u_gs_start = 440;
	const uint16_t u_gs_delta = 20;
	const uint16_t u_gs_end = 600;
	
	pf.setUnitX("V");
	pf.setUnitY("mA");
	pf.setUnitPara("V");
	pf.setDescX("U_{DS}");
	pf.setDescY("I_D");
	pf.setDescPara("U_{GS}");
	pf.setRefX(5);
	pf.setRefY(50);
	pf.setParaFirstCurve(u_gs_start);
	pf.setParaStepWidth(u_gs_delta);
	
	uint8_t curve = 0;
	for(uint16_t u_gs = u_gs_start; u_gs <= u_gs_end; u_gs += u_gs_delta)
	{
		drv.analogWrite1(u_gs);
		
		drv.analogSequence(0, &ba[0], 0, 1, &bb[0], 0, 0, delta, sample_count);
		drv.delay_ms(10);
		drv.discard();
		drv.delay_ms(10);
		
		for(uint16_t k = 0; k < sample_count+1; k++)
		{
			uint16_t i_d = ba[k] - bb[k];
			uint16_t u_ds = bb[k];
			pf.addDot(Dot(u_ds, i_d, curve));
		}
		
		curve++;
	}
	
	// speichern und plotty starten
	pf.writeToFile("test_plot");	
	pf.startPlotty("test_plot");
}

void kennlinieZweiterQuadrant()
{
	B15F& drv = B15F::getInstance();
	PlottyFile pf;
	
	uint16_t ba[1024];
	uint16_t bb[1024];
	
	const uint16_t sample_count = 1000;
	const uint16_t delta = 1;
	
	const uint16_t u_gs_start = 300;
	const uint16_t u_gs_delta = 25;
	const uint16_t u_gs_end = 700;
	
	pf.setQuadrant(2);
	pf.setUnitX("V");
	pf.setUnitY("mA");
	pf.setUnitPara("V");
	pf.setDescX("U_{GS}");
	pf.setDescY("I_D");
	pf.setDescPara("U_{DS}");
	pf.setRefX(5);
	pf.setRefY(50);
	pf.setParaFirstCurve(u_gs_start);
	pf.setParaStepWidth(u_gs_delta);
	
	uint8_t curve = 0;
	for(uint16_t u_gs = u_gs_start; u_gs <= u_gs_end; u_gs += u_gs_delta)
	{
		drv.analogWrite1(u_gs);
		
		drv.analogSequence(0, &ba[0], 0, 1, &bb[0], 0, 0, delta, sample_count);
		
		curve = 0;
		for(uint16_t k = 0; k < sample_count + 1; k++)
		{
			if(ba[k] > bb[k] && bb[k] % 50 == 0 && bb[k] > 0)
			{
				uint16_t i_d = ba[k] - bb[k];
				pf.addDot(Dot(u_gs, i_d, bb[k] / 50));
			}
			curve++;
		}
		std::cout << "u_gs: " << u_gs << std::endl;
	}
	
	// speichern und plotty starten
	pf.writeToFile("test_plot");	
	pf.startPlotty("test_plot");
}

void beispielFunktionen()
{
	B15F& drv = B15F::getInstance();
	
	
	for(uint16_t i = 0; i < 256; i++)
	{
		drv.digitalWrite0(i);
		drv.delay_ms(100);
	}
	
	
	
	
	while(1)
	{
		for(double d = 0; d < M_PI*2; d += .1)
		{
			uint16_t v = (sin(d) * 511 + 511);
			drv.analogWrite0(v);
		}
		
	}
	
	
	
	
	uint16_t schwelle_unten = 1023;
	for(uint16_t i = 0; i < 1024; i++)
	{
		drv.analogWrite0(i);
		drv.delay_ms(1);
		if(drv.digitalRead0() & 0x01)
		{
			drv.discard();
			uint16_t val = drv.analogRead(0);
			if(val > 1023)
			{
				std::cout << "Fehler: " << val << std::endl;
				continue;
			}
			if(val < schwelle_unten)
				schwelle_unten = val;
		}
	}
	
	std::cout << "OK" << std::endl;
	
	uint16_t schwelle_oben = 0;
	for(uint16_t i = 1023; i > 0; i--)
	{
		drv.analogWrite0(i);
		if(!(drv.digitalRead0() & 0x01))
		{
			drv.discard();
			uint16_t val = drv.analogRead(0);
			if(val > 1023)
			{
				std::cout << "Fehler: " << val << std::endl;
				continue;
			}
			if(val > schwelle_oben)
				schwelle_oben = val;
		}
	}
	
	std::cout << "Schwelle für low: " << schwelle_unten << std::endl;
	std::cout << "Schwelle für high: " << schwelle_oben << std::endl;
	std::cout << "Verbotene Zone: " << (schwelle_oben - schwelle_unten) << std::endl;
}

int main()
{
	
	beispielFunktionen();
	
	//USART usart;
	//usart.openDevice("/dev/ttyUSB0");
	//usart.writeByte(5);
	
	
	std::cout << "Schluss." << std::endl;
}