#include <Arduino.h>
#include "mode.h"



ESignalMode m_mode = eConstant;

double m_amp = 1.0;

int tab_step = 0;



#define MAX_DAC_VALUE 0xFFFF


#define TAB_SIZE   256

const unsigned int sine_tab[TAB_SIZE] = { // 16bit_256
32767,33571,34374,35177,35978,36778,37574,38368,39159,39946,40728,41506,42278,43045,43805,44559,
45306,46045,46776,47499,48213,48917,49612,50297,50971,51634,52286,52926,53554,54169,54771,55361,
55936,56498,57045,57578,58096,58598,59085,59556,60011,60450,60872,61277,61664,62035,62388,62722,
63039,63338,63618,63880,64123,64347,64552,64737,64904,65051,65179,65287,65376,65445,65494,65524,
65534,65524,65494,65445,65376,65287,65179,65051,64904,64737,64552,64347,64123,63880,63618,63338,
63039,62722,62388,62035,61664,61277,60872,60450,60011,59556,59085,58598,58096,57578,57045,56498,
55936,55361,54771,54169,53554,52926,52286,51634,50971,50297,49612,48917,48213,47499,46776,46045,
45306,44559,43805,43045,42278,41506,40728,39946,39159,38368,37574,36778,35978,35177,34374,33571,
32767,31962,31159,30356,29555,28755,27959,27165,26374,25587,24805,24027,23255,22488,21728,20974,
20227,19488,18757,18034,17320,16616,15921,15236,14562,13899,13247,12607,11979,11364,10762,10172,
 9597, 9035, 8488, 7955, 7437, 6935, 6448, 5977, 5522, 5083, 4661, 4256, 3869, 3498, 3145, 2811,
 2494, 2195, 1915, 1653, 1410, 1186,  981,  796,  629,  482,  354,  246,  157,   88,   39,    9,
	0,    9,   39,   88,  157,  246,  354,  482,  629,  796,  981, 1186, 1410, 1653, 1915, 2195,
 2494, 2811, 3145, 3498, 3869, 4256, 4661, 5083, 5522, 5977, 6448, 6935, 7437, 7955, 8488, 9035,
 9597,10172,10762,11364,11979,12607,13247,13899,14562,15236,15921,16616,17320,18034,18757,19488,
20227,20974,21728,22488,23255,24027,24805,25587,26374,27165,27959,28755,29555,30356,31159,31962
};

const unsigned int triangle_tab[TAB_SIZE] = { // 16bit_256
	0,  511, 1023, 1535, 2047, 2559, 3071, 3583, 4095, 4607, 5119, 5631, 6143, 6655, 7167, 7679,
 8191, 8703, 9215, 9727,10239,10751,11263,11775,12287,12799,13311,13823,14335,14847,15359,15871,
16383,16895,17407,17919,18431,18943,19455,19967,20479,20991,21503,22015,22527,23039,23551,24063,
24575,25087,25599,26111,26623,27135,27647,28159,28671,29183,29695,30207,30719,31231,31743,32255,
32767,33279,33791,34303,34815,35327,35839,36351,36863,37375,37887,38399,38911,39423,39935,40447,
40959,41471,41983,42495,43007,43519,44031,44543,45055,45567,46079,46591,47103,47615,48127,48639,
49151,49663,50175,50687,51199,51711,52223,52735,53247,53759,54271,54783,55295,55807,56319,56831,
57343,57855,58367,58879,59391,59903,60415,60927,61439,61951,62463,62975,63487,63999,64511,65023,
65535,65024,64512,64000,63488,62976,62464,61952,61440,60928,60416,59904,59392,58880,58368,57856,
57344,56832,56320,55808,55296,54784,54272,53760,53248,52736,52224,51712,51200,50688,50176,49664,
49152,48640,48128,47616,47104,46592,46080,45568,45056,44544,44032,43520,43008,42496,41984,41472,
40960,40448,39936,39424,38912,38400,37888,37376,36864,36352,35840,35328,34816,34304,33792,33280,
32768,32256,31744,31232,30720,30208,29696,29184,28672,28160,27648,27136,26624,26112,25600,25088,
24576,24064,23552,23040,22528,22016,21504,20992,20480,19968,19456,18944,18432,17920,17408,16896,
16384,15872,15360,14848,14336,13824,13312,12800,12288,11776,11264,10752,10240, 9728, 9216, 8704,
 8192, 7680, 7168, 6656, 6144, 5632, 5120, 4608, 4096, 3584, 3072, 2560, 2048, 1536, 1024,  512
};





int getTabSize()
{
	return TAB_SIZE;
}


void setMode(ESignalMode mode)
{
	m_mode = mode;
}

ESignalMode getMode()
{
	return m_mode;
}


const char* _szConstantModeName = "const";
const char* _szSineModeName = "sine";
const char* _szTriangleModeName = "tri";


void setMode(const char* szMode)
{
	if (strstr(szMode, "?") == NULL)
	{
		ESignalMode mode = m_mode;

		if (strstr(szMode, _szSineModeName) != NULL)
			mode = eSine;
		else if (strstr(szMode, _szConstantModeName) != NULL)
			mode = eConstant;
		else if (strstr(szMode, _szTriangleModeName) != NULL)
			mode = eTriangle;

		setMode(mode);
	}

}

const char* getCurrentModeName()
{
	switch (m_mode)
	{
		case eConstant:		return _szConstantModeName;	break;
		case eSine:			return _szSineModeName;		break;
		case eTriangle:		return _szTriangleModeName;	break;
	}
	return "unknown";
}

double getAmp()
{
	return m_amp;
}

void setAmp(double factor) // 0.0 - 1.0
{
	if (factor < 0) factor = 0;
	if (factor > 1.0) factor = 1.0;

	m_amp = factor;
}




uint32_t getNextDAC()
{
	uint32_t val = 0;

	switch (m_mode)
	{
		case eConstant:		val = MAX_DAC_VALUE * m_amp;			break;
		case eSine:			val = sine_tab[tab_step] * m_amp;		break;
		case eTriangle:		val = triangle_tab[tab_step] * m_amp;	break;
	}


//	if ((tab_step % 16) == 0)
//		Serial.println(val, HEX); // tab_step


	tab_step++;

	if (tab_step >= TAB_SIZE)
		tab_step = 0;

	return val;
}